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, p, q, t;
  26         uint16_t h, s, v, remainder;
  27
  28         if ( hsv.s == 0 )
  29         {
  30                 rgb.r = hsv.v;
  31                 rgb.g = hsv.v;
  32                 rgb.b = hsv.v;
  33                 return rgb;
  34         }
  35
  36         h = hsv.h;
  37         s = hsv.s;
  38         v = hsv.v;
  39
  40         region = h / 43;
  41         remainder = (h - (region * 43)) * 6;
  42
  43         p = (v * (255 - s)) >> 8;
  44         q = (v * (255 - ((s * remainder) >> 8))) >> 8;
  45         t = (v * (255 - ((s * (255 - remainder)) >> 8))) >> 8;
  46
  47         switch ( region )
  48         {
  49                 case 0:
  50                         rgb.r = v;
  51                         rgb.g = t;
  52                         rgb.b = p;
  53                         break;
  54                 case 1:
  55                         rgb.r = q;
  56                         rgb.g = v;
  57                         rgb.b = p;
  58                         break;
  59                 case 2:
  60                         rgb.r = p;
  61                         rgb.g = v;
  62                         rgb.b = t;
  63                         break;
  64                 case 3:
  65                         rgb.r = p;
  66                         rgb.g = q;
  67                         rgb.b = v;
  68                         break;
  69                 case 4:
  70                         rgb.r = t;
  71                         rgb.g = p;
  72                         rgb.b = v;
  73                         break;
  74                 default:
  75                         rgb.r = v;
  76                         rgb.g = p;
  77                         rgb.b = q;
  78                         break;
  79         }
  80
  81         rgb.r = pgm_read_byte( &CIE1931_CURVE[rgb.r] );
  82         rgb.g = pgm_read_byte( &CIE1931_CURVE[rgb.g] );
  83         rgb.b = pgm_read_byte( &CIE1931_CURVE[rgb.b] );
  84
  85         return rgb;
  86 }
  87