- dirx = 0;
- diry = 0;
- dirz = 0;
- sum = 0;
- for (j = 0; j < inIncr; ++j)
- {
- if (j==0) dirx= static_cast<T>(*input);
- if (j==1) diry= static_cast<T>(*input);
- if (j==2) dirz= static_cast<T>(*input);
- tmp = static_cast<T>(*input);
- sum += (tmp * tmp);
- ++input;
- }
- sum=sqrt(sum);
- *output++ = (unsigned char) abs( (255*dirx/sum) );
- *output++ = (unsigned char) abs( (255*diry/sum) );
- *output++ = (unsigned char) abs( (255*dirz/sum) );
- *output++ = 255;
-// printf("%d %d %d ",(int)(255*dirx/sum),(int)(255*diry/sum),(int)(255*dirz/sum));
-// printf(" C %d %f %f %f \n",inIncr,dirx,diry,dirz);
- }
+
+
+ if (1==1){
+ dirx = static_cast<T>(input[0]);
+ diry = static_cast<T>(input[1]);
+ dirz = static_cast<T>(input[2]);
+ input = input+inIncr;
+ sum = sqrt( dirx*dirx + diry*diry + dirz*dirz );
+
+ /*
+ dirx = 0;
+ diry = 0;
+ dirz = 0;
+ sum = 0;
+ for (j = 0; j < inIncr; ++j)
+ {
+ if (j==0) dirx= static_cast<T>(*input);
+ if (j==1) diry= static_cast<T>(*input);
+ if (j==2) dirz= static_cast<T>(*input);
+ tmp = static_cast<T>(*input);
+ sum += (tmp * tmp);
+ ++input;
+ }
+ sum=sqrt(sum);
+ */
+
+ *output++ = (unsigned char) abs( (255*dirx/sum) );
+ *output++ = (unsigned char) abs( (255*diry/sum) );
+ *output++ = (unsigned char) abs( (255*dirz/sum) );
+ *output++ = 255;
+ // printf("%d %d %d ",(int)(255*dirx/sum),(int)(255*diry/sum),(int)(255*dirz/sum));
+ // printf(" C %d %f %f %f \n",inIncr,dirx,diry,dirz);
+
+ } // type 1 color vector by direction
+
+
+ if (2==0){
+ angle = static_cast<T>(input[0]);
+ input = input+inIncr;
+
+ *output++ = (unsigned char) abs( 255*angle/90 );
+ *output++ = (unsigned char) abs( 0 );
+ *output++ = (unsigned char) abs( 0 );
+ *output++ = 255;
+ // printf("%d %d %d ",(int)(255*dirx/sum),(int)(255*diry/sum),(int)(255*dirz/sum));
+ // printf(" C %d %f %f %f \n",inIncr,dirx,diry,dirz);
+
+ }// type 2 color vector by scalar