Arduino.ru

Может кто подсказать пример, как можно отсортировать набор цветов RGB565, находящиеся в случайном порядке что бы он соответсвовал спектру? Я находил и пробовал применить способы преобразования в HSL (HSV) и сортировку по hue и более менее что-то приближенное получалось, но все равно с третью цветов разбросанных как попало. Проблема в том, что все примеры рассчитаны на преобразование RGB888, и мне достаточно сложно на текущий момент понять, как можно примеры адаптировать под RGB565.

typedef struct RgbColor{
	unsigned char r;
	unsigned char g;
	unsigned char b;
} RgbColor;

typedef struct HsvColor{
	unsigned char h;
	unsigned char s;
	unsigned char v;
} HsvColor;

RgbColor HsvToRgb(HsvColor hsv){
	RgbColor rgb;
	unsigned char region, p, q, t;
	unsigned int h, s, v, remainder;

	if(hsv.s == 0){
		rgb.r = hsv.v;
		rgb.g = hsv.v;
		rgb.b = hsv.v;
		return rgb;
	}

	// converting to 16 bit to prevent overflow
	h = hsv.h;
	s = hsv.s;
	v = hsv.v;

	region = h / 43;
	remainder = (h - (region * 43)) * 6; 

	p = (v * (255 - s)) >> 8;
	q = (v * (255 - ((s * remainder) >> 8))) >> 8;
	t = (v * (255 - ((s * (255 - remainder)) >> 8))) >> 8;

	switch(region){
		case 0:
			rgb.r = v;
			rgb.g = t;
			rgb.b = p;
			break;
		case 1:
			rgb.r = q;
			rgb.g = v;
			rgb.b = p;
			break;
		case 2:
			rgb.r = p;
			rgb.g = v;
			rgb.b = t;
			break;
		case 3:
			rgb.r = p;
			rgb.g = q;
			rgb.b = v;
			break;
		case 4:
			rgb.r = t;
			rgb.g = p;
			rgb.b = v;
			break;
		default:
			rgb.r = v;
			rgb.g = p;
			rgb.b = q;
			break;
	}

	return rgb;
}

HsvColor RgbToHsv(RgbColor rgb){
	HsvColor hsv;
	unsigned char rgbMin, rgbMax;

	rgbMin = rgb.r < rgb.g ? (rgb.r < rgb.b ? rgb.r : rgb.b) : (rgb.g < rgb.b ? rgb.g : rgb.b);
	rgbMax = rgb.r > rgb.g ? (rgb.r > rgb.b ? rgb.r : rgb.b) : (rgb.g > rgb.b ? rgb.g : rgb.b);

	hsv.v = rgbMax;
	if(hsv.v == 0){
		hsv.h = 0;
		hsv.s = 0;
		return hsv;
	}

	hsv.s = 255 * ((long)(rgbMax - rgbMin)) / hsv.v;
	if(hsv.s == 0){
		hsv.h = 0;
		return hsv;
	}

	if(rgbMax == rgb.r)
		hsv.h = 0 + 43 * (rgb.g - rgb.b) / (rgbMax - rgbMin);
	else if (rgbMax == rgb.g)
		hsv.h = 85 + 43 * (rgb.b - rgb.r) / (rgbMax - rgbMin);
	else
		hsv.h = 171 + 43 * (rgb.r - rgb.g) / (rgbMax - rgbMin);

	return hsv;
}

void				sort(uint16_t a[], int size,	uint16_t a2[]){
	for(int i=0; i<(size-1); i++){
		for(int o=0; o<(size-(i+1)); o++){
			if(a[o] > a[o+1]){
				int	t		=	a[o];
				a[o]			=	a[o+1];
				a[o+1]		=	t;
				
				int	t2		=	a2[o];
				a2[o]			=	a2[o+1];
				a2[o+1]		=	t2;
			}
		}
	}
}

void		colorsSort(){
	//randomSeed(analogRead(0));
	int		len			=	112;	//16, 112
	uint16_t	arr[len]		=	{0};
	uint16_t	arr2[len]	=	{0};
	byte		bb[]			=	{5,6,5};
	
	byte		x				=	0;
	byte		y				=	0;
	
	RgbColor rgb;
	
	for(byte a=0; a<2; a++){
		if(a)	sort(arr2,len,arr);
		
		for(int b=0; b<len; b++){
			if(!a){
				arr[b]		=	random(0,65536);
				
				for(byte c=0, e=0; c<3; c++){
					byte	z				=	0;
					for(byte d=0; d<bb[c]; d++, e++){
						bitWrite(z,d,bitRead(arr[b],e));
					}
					
					switch(c){
						case	0	:		rgb.r	=	z;	break;	//z << 3;	break;	//(z << 3) | (z >> 2);	break;	//z;	break;
						case	1	:		rgb.g	=	z;	break;	//z << 2;	break;	//(z << 2) | (z >> 4);	break;	//z;	break;
						case	2	:		rgb.b	=	z;	break;	//z << 3;	break;	//(z << 3) | (z >> 2);	break;	//z;	break;
					}
				}
				
				
				HsvColor hsv			=	RgbToHsv(rgb);
				arr2[b]					=	hsv.h;
			}
			
			tft.fillRect(x,y,6,6,arr[b]);
			
			x						+=	8;
			if(x >= 122){
				x						=	0;
				y						+=	8;
			}
		}
		
		x						=	0;
		y						+=	8;
	}
}