quantum/color.c

   1 /* Copyright 2017 Jason Williams
   2  *
   3  * This program is free software: you can redistribute it and/or modify
   4  * it under the terms of the GNU General Public License as published by
   5  * the Free Software Foundation, either version 2 of the License, or
   6  * (at your option) any later version.
   7  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15  */
  16
  17
  18 #include "color.h"
  19 #include "led_tables.h"
  20 #include "progmem.h"
  21
  22 RGB hsv_to_rgb( HSV hsv )
  23 {
  24         RGB rgb;
  25         uint8_t region, remainder, p, q, t;
  26         uint16_t h, s, v;
  27
  28         if ( hsv.s == 0 )
  29         {
  30 #ifdef USE_CIE1931_CURVE
  31                 rgb.r = rgb.g = rgb.b = pgm_read_byte( &CIE1931_CURVE[hsv.v] );
  32 #else
  33                 rgb.r = hsv.v;
  34                 rgb.g = hsv.v;
  35                 rgb.b = hsv.v;
  36 #endif
  37                 return rgb;
  38         }
  39
  40         h = hsv.h;
  41         s = hsv.s;
  42         v = hsv.v;
  43
  44         region = h * 6 / 255;
  45         remainder = (h * 2 - region * 85) * 3;
  46
  47         p = (v * (255 - s)) >> 8;
  48         q = (v * (255 - ((s * remainder) >> 8))) >> 8;
  49         t = (v * (255 - ((s * (255 - remainder)) >> 8))) >> 8;
  50
  51         switch ( region )
  52         {
  53                 case 6:
  54                 case 0:
  55                         rgb.r = v;
  56                         rgb.g = t;
  57                         rgb.b = p;
  58                         break;
  59                 case 1:
  60                         rgb.r = q;
  61                         rgb.g = v;
  62                         rgb.b = p;
  63                         break;
  64                 case 2:
  65                         rgb.r = p;
  66                         rgb.g = v;
  67                         rgb.b = t;
  68                         break;
  69                 case 3:
  70                         rgb.r = p;
  71                         rgb.g = q;
  72                         rgb.b = v;
  73                         break;
  74                 case 4:
  75                         rgb.r = t;
  76                         rgb.g = p;
  77                         rgb.b = v;
  78                         break;
  79                 default:
  80                         rgb.r = v;
  81                         rgb.g = p;
  82                         rgb.b = q;
  83                         break;
  84         }
  85
  86 #ifdef USE_CIE1931_CURVE
  87         rgb.r = pgm_read_byte( &CIE1931_CURVE[rgb.r] );
  88         rgb.g = pgm_read_byte( &CIE1931_CURVE[rgb.g] );
  89         rgb.b = pgm_read_byte( &CIE1931_CURVE[rgb.b] );
  90 #endif
  91
  92         return rgb;
  93 }
  94