src/main/common/colorconversion.c

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include <stdint.h>
  22
  23 #include "platform.h"
  24
  25 #include "color.h"
  26 #include "colorconversion.h"
  27
  28 /*
  29  * Source below found here: http://www.kasperkamperman.com/blog/arduino/arduino-programming-hsb-to-rgb/
  30  */
  31
  32 rgbColor24bpp_t* hsvToRgb24(const hsvColor_t* c)
  33 {
  34     static rgbColor24bpp_t r;
  35
  36     uint16_t val = c->v;
  37     uint16_t sat = 255 - c->s;
  38     uint32_t base;
  39     uint16_t hue = c->h;
  40
  41     if (sat == 0) { // Acromatic color (gray). Hue doesn't mind.
  42         r.rgb.r = val;
  43         r.rgb.g = val;
  44         r.rgb.b = val;
  45     } else {
  46
  47         base = ((255 - sat) * val) >> 8;
  48
  49         switch (hue / 60) {
  50             case 0:
  51             r.rgb.r = val;
  52             r.rgb.g = (((val - base) * hue) / 60) + base;
  53             r.rgb.b = base;
  54             break;
  55             case 1:
  56             r.rgb.r = (((val - base) * (60 - (hue % 60))) / 60) + base;
  57             r.rgb.g = val;
  58             r.rgb.b = base;
  59             break;
  60
  61             case 2:
  62             r.rgb.r = base;
  63             r.rgb.g = val;
  64             r.rgb.b = (((val - base) * (hue % 60)) / 60) + base;
  65             break;
  66
  67             case 3:
  68             r.rgb.r = base;
  69             r.rgb.g = (((val - base) * (60 - (hue % 60))) / 60) + base;
  70             r.rgb.b = val;
  71             break;
  72
  73             case 4:
  74             r.rgb.r = (((val - base) * (hue % 60)) / 60) + base;
  75             r.rgb.g = base;
  76             r.rgb.b = val;
  77             break;
  78
  79             case 5:
  80             r.rgb.r = val;
  81             r.rgb.g = base;
  82             r.rgb.b = (((val - base) * (60 - (hue % 60))) / 60) + base;
  83             break;
  84
  85         }
  86     }
  87     return &r;
  88 }