HSV/HSL与RGB 的互相转换

void RGB2HSV( uint16_t * h, uint16_t * s, uint16_t * v, uint8_t r, uint8_t g, uint8_t b)
{
	double rr, gg, bb;
	double hh, ss, vv;
	double cmax, cmin, cdes;

	rr = r;
	gg = g;
	bb = b;

	cmax = (rr > gg) ? rr : gg;
	if (bb > cmax) {
	    cmax = bb;
	}

	cmin = (rr < gg) ? rr : gg;
	if (bb < cmin) {
	    cmin = bb;
	}

	cdes = cmax - cmin;
	vv = cmax;
	if (cdes != 0) {
	    ss = cdes * SCALE / cmax;
	    if (cmax == rr) {
	        hh = (gg - bb) * SCALE / cdes;
	    }else if (cmax == gg) {
	        hh = (bb - rr) * SCALE / cdes + 2 * H_SCALE;
	    }else {
	        hh = (rr - gg) * SCALE / cdes + 4 * H_SCALE;
	    }
	}else if (cmax != 0) {
	    ss = cdes * SCALE / cmax;
	    hh = 0;
	}else {
	    ss = 0;
	    hh = 0;
	}
	if (hh < 0) {
	    hh += 6 * H_SCALE;
	}

	*h = hh * H_GETA;
	*s = ss * H_GETA;
	*v = vv * H_GETA;
}

void HSV2RGB( uint8_t *r, uint8_t *g, uint8_t *b, uint16_t h, uint16_t s, uint16_t v)
{
	double rr = 0, gg = 0, bb = 0;
	double hh, ss, vv;

	if (h == 6 * H_GETA * H_SCALE) {
	    h = 0;
	}
	hh = (double)h / H_GETA;
	ss = (double)s / GETA;
	vv = (double)v / GETA;

	switch((int)(hh / H_SCALE)) {
	    case 0:
	        rr = SCALE;
	        gg = hh;
	        bb = 0;
	        break;
	    case 1:
	        rr = 2 * H_SCALE - hh;
	        gg = SCALE;
	        bb = 0;
	        break;
	    case 2:
	        rr = 0;
	        gg = SCALE;
	        bb = hh - 2 * H_SCALE;
	        break;
	    case 3:
	        rr = 0;
	        gg = 4 * H_SCALE - hh;
	        bb = SCALE;
	        break;
	    case 4:
	        rr = hh - 4 * H_SCALE;
	        gg = 0;
	        bb = SCALE;
	        break;
	    case 5:
	        rr = SCALE;
	        gg = 0;
	        bb = 6 * H_SCALE - hh;
	        break;
	}

	rr = (rr + (SCALE - rr) * (SCALE - ss) / SCALE) * vv / SCALE;
	gg = (gg + (SCALE - gg) * (SCALE - ss) / SCALE) * vv / SCALE;
	bb = (bb + (SCALE - bb) * (SCALE - ss) / SCALE) * vv / SCALE;

	*r = rr;
	*g = gg;
	*b = bb;
	if (*r > 255)*r = 255;
	if (*g > 255)*g = 255;
	if (*b > 255)*b = 255;
}

void RGB2HLS( double *h, double *l, double *s, uint8_t r, uint8_t g, uint8_t b)
{
	double dr = (double)r/255;
	double dg = (double)g/255;
	double db = (double)b/255;
	double cmax = MAX(dr, MAX(dg, db));
	double cmin = MIN(dr, MIN(dg, db));
	double cdes = cmax - cmin;
	double hh, ll, ss;

	ll = (cmax+cmin)/2;
	if(cdes){
	    if(ll <= 0.5)
	        ss = (cmax-cmin)/(cmax+cmin);
	    else
	        ss = (cmax-cmin)/(2-cmax-cmin);

	    if(cmax == dr)
	        hh = (0+(dg-db)/cdes)*60;
	    else if(cmax == dg)
	        hh = (2+(db-dr)/cdes)*60;
	    else// if(cmax == b)
	        hh = (4+(dr-dg)/cdes)*60;
	    if(hh<0)
	        hh+=360;
	}else
	    hh = ss = 0;

	*h = hh;
	*l = ll;
	*s = ss;
}

void HLS2RGB( uint8_t *r, uint8_t *g, uint8_t *b, double h, double l, double s)
{
	double cmax,cmin;

	if(l <= 0.5)
		cmax = l*(1+s);
	else
	    cmax = l*(1-s)+s;
	cmin = 2*l-cmax;

	if(s == 0){
	    *r = *g = *b = l*255;
	}else{
	    *r = HLS2RGBvalue(cmin,cmax,h+120)*255;
	    *g = HLS2RGBvalue(cmin,cmax,h)*255;
	    *b = HLS2RGBvalue(cmin,cmax,h-120)*255;
	}
}

double HLS2RGBvalue(double n1,double n2, double hue)
{
	if(hue > 360)
	    hue -= 360;
	else if(hue < 0)
	    hue += 360;
	if(hue < 60)
	    return n1+(n2-n1)*hue/60;
	else if(hue < 180)
	    return n2;
	else if(hue < 240)
	    return n1+(n2-n1)*(240-hue)/60;
	else
	    return n1;
}