颜色提取.cpp

颜色提取 WAVE编译 利用霍尔效应

#include <stdio.h>
#include <stdlib.h>
#include <math.h>

void main()
{
   float	       x, y, z, X = 0, Y = 0, Z = 0; 
   int		       r, g, b, n = 0;
   FILE	       *InputFile,*OutputFile,*MFile;
   InputFile=fopen("out.pts","r");
   OutputFile=fopen("outputfile.pts","w+");
   MFile=fopen("mfile.pts","w+");
   while(!feof(InputFile))
   {
	   fscanf(InputFile,"%f %f %f %d %d %d\n", &x, &y, &z, &r, &g, &b );
	   if(r > 150 && g<80 && b<80)
	   {
		   X = X + x; Y = Y + y; Z = Z + z;
		   n = n + 1;
	   fprintf(MFile, "%f %f %f %d %d %d\n", x, y, z, r, g, b );
	   }
   }
   X = X / n; Y = Y / n; Z = Z / n;
   printf("%f %f %f %d\n",X, Y, Z, n);
   n = 0;
   rewind(MFile);
   while(!feof(MFile))
   {
	   fscanf(MFile,"%f %f %f %d %d %d\n", &x, &y, &z, &r, &g, &b );
	   if((sqrt((x-X)*(x-X)+(y-Y)*(y-Y)+(z-Z)*(z-Z)))<0.3)
	   {
	       fprintf(OutputFile, "%f %f %f %d %d %d\n", x, y, z, r, g, b );
           n = n + 1;
	   }
   }
   printf("%d\n",n);
   fclose(InputFile);fclose(OutputFile);fclose(MFile);
}