use lib8tion::{Fract8, qadd8, qsub8, scale8, scale8_video, sqrt16};
use crate::rgb::Crgb;
#[derive(Debug, Default, Clone, Copy, PartialEq, Eq)]
pub struct Chsv {
pub hue: u8,
pub sat: u8,
pub val: u8,
}
impl Chsv {
#[inline]
pub const fn new(hue: u8, sat: u8, val: u8) -> Self {
Self { hue, sat, val }
}
#[inline]
pub const fn from_hue(hue: u8) -> Self {
Self::new(hue, 255, 255)
}
}
impl From<Chsv> for Crgb {
#[inline]
fn from(hsv: Chsv) -> Crgb {
hsv2rgb_rainbow(hsv)
}
}
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
#[repr(u8)]
pub enum HsvHue {
Red = 0,
Orange = 32,
Yellow = 64,
Green = 96,
Aqua = 128,
Blue = 160,
Purple = 192,
Pink = 224,
}
impl From<HsvHue> for u8 {
#[inline]
fn from(hue: HsvHue) -> u8 {
hue as u8
}
}
const K255: u8 = 255;
const K171: u8 = 171;
const K170: u8 = 170;
const K85: u8 = 85;
pub fn hsv2rgb_rainbow(hsv: Chsv) -> Crgb {
const Y1: bool = true;
const Y2: bool = false;
const G2: bool = false;
const GSCALE: u8 = 0;
let hue = hsv.hue;
let sat = hsv.sat;
let val = hsv.val;
let offset = hue & 0x1F;
let offset8 = offset << 3;
let third = scale8(offset8, Fract8((256u16 / 3) as u8));
let (mut r, mut g, mut b);
if hue & 0x80 == 0 {
if hue & 0x40 == 0 {
if hue & 0x20 == 0 {
r = K255 - third;
g = third;
b = 0;
} else {
if Y1 {
r = K171;
g = K85 + third;
b = 0;
} else {
r = 0;
g = 0;
b = 0;
}
if Y2 {
let twothirds = scale8(offset8, Fract8(((256u16 * 2) / 3) as u8)); r = K170 + third;
g = K85 + twothirds;
b = 0;
}
}
} else {
if hue & 0x20 == 0 {
if Y1 {
let twothirds = scale8(offset8, Fract8(((256u16 * 2) / 3) as u8)); r = K171 - twothirds;
g = K170 + third;
b = 0;
} else {
r = 0;
g = 0;
b = 0;
}
if Y2 {
r = K255 - offset8;
g = K255;
b = 0;
}
} else {
r = 0;
g = K255 - third;
b = third;
}
}
} else {
if hue & 0x40 == 0 {
if hue & 0x20 == 0 {
let twothirds = scale8(offset8, Fract8(((256u16 * 2) / 3) as u8)); r = 0;
g = K171 - twothirds;
b = K85 + twothirds;
} else {
r = third;
g = 0;
b = K255 - third;
}
} else if hue & 0x20 == 0 {
r = K85 + third;
g = 0;
b = K171 - third;
} else {
r = K170 + third;
g = 0;
b = K85 - third;
}
}
if G2 {
g >>= 1;
}
if GSCALE != 0 {
g = scale8_video(g, Fract8(GSCALE));
}
if sat != 255 {
if sat == 0 {
r = 255;
g = 255;
b = 255;
} else {
let mut desat = 255 - sat;
desat = scale8_video(desat, Fract8(desat));
let satscale = 255 - desat;
r = scale8(r, Fract8(satscale));
g = scale8(g, Fract8(satscale));
b = scale8(b, Fract8(satscale));
let brightness_floor = desat;
r = r.wrapping_add(brightness_floor);
g = g.wrapping_add(brightness_floor);
b = b.wrapping_add(brightness_floor);
}
}
if val != 255 {
let val = scale8_video(val, Fract8(val));
if val == 0 {
r = 0;
g = 0;
b = 0;
} else {
r = scale8(r, Fract8(val));
g = scale8(g, Fract8(val));
b = scale8(b, Fract8(val));
}
}
Crgb::new(r, g, b)
}
fn hsv2rgb_raw_c(hue: u8, sat: u8, val: u8) -> Crgb {
let value = val;
let saturation = sat;
let invsat = 255 - saturation;
let brightness_floor = ((value as u16 * invsat as u16) / 256) as u8;
let color_amplitude = value.wrapping_sub(brightness_floor);
let section = hue / 0x40; let offset = hue % 0x40;
let rampup = offset; let rampdown = (0x40 - 1) - offset;
let rampup_amp_adj = ((rampup as u16 * color_amplitude as u16) / (256 / 4)) as u8;
let rampdown_amp_adj = ((rampdown as u16 * color_amplitude as u16) / (256 / 4)) as u8;
let rampup_adj_with_floor = rampup_amp_adj.wrapping_add(brightness_floor);
let rampdown_adj_with_floor = rampdown_amp_adj.wrapping_add(brightness_floor);
let (r, g, b);
if section != 0 {
if section == 1 {
r = brightness_floor;
g = rampdown_adj_with_floor;
b = rampup_adj_with_floor;
} else {
r = rampup_adj_with_floor;
g = brightness_floor;
b = rampdown_adj_with_floor;
}
} else {
r = rampdown_adj_with_floor;
g = rampup_adj_with_floor;
b = brightness_floor;
}
Crgb::new(r, g, b)
}
pub fn hsv2rgb_spectrum(hsv: Chsv) -> Crgb {
let hue2 = scale8(hsv.hue, Fract8(191));
hsv2rgb_raw_c(hue2, hsv.sat, hsv.val)
}
const HUE_RED: u8 = 0;
const HUE_ORANGE: u8 = 32;
const HUE_YELLOW: u8 = 64;
const HUE_GREEN: u8 = 96;
const HUE_AQUA: u8 = 128;
const HUE_BLUE: u8 = 160;
const HUE_PURPLE: u8 = 192;
const HUE_PINK: u8 = 224;
const fn fixfrac8(n: u16, d: u16) -> u8 {
((n * 256) / d) as u8
}
pub fn rgb2hsv_approximate(rgb: Crgb) -> Chsv {
let mut r = rgb.r;
let mut g = rgb.g;
let mut b = rgb.b;
let mut desat = 255u8;
if r < desat {
desat = r;
}
if g < desat {
desat = g;
}
if b < desat {
desat = b;
}
r = r.wrapping_sub(desat);
g = g.wrapping_sub(desat);
b = b.wrapping_sub(desat);
let mut s = 255 - desat;
if s != 255 {
s = 255 - sqrt16((255 - s) as u16 * 256);
}
if r as u16 + g as u16 + b as u16 == 0 {
return Chsv::new(0, 0, 255 - s);
}
if s < 255 {
if s == 0 {
s = 1;
}
let scaleup = 65535u32 / s as u32;
r = ((r as u32 * scaleup) / 256) as u8;
g = ((g as u32 * scaleup) / 256) as u8;
b = ((b as u32 * scaleup) / 256) as u8;
}
let mut total = r as u16 + g as u16 + b as u16;
if total < 255 {
if total == 0 {
total = 1;
}
let scaleup = 65535u32 / total as u32;
r = ((r as u32 * scaleup) / 256) as u8;
g = ((g as u32 * scaleup) / 256) as u8;
b = ((b as u32 * scaleup) / 256) as u8;
}
let v = if total > 255 {
255
} else {
let mut v = qadd8(desat, total as u8);
if v != 255 {
v = sqrt16(v as u16 * 256);
}
v
};
let mut highest = r;
if g > highest {
highest = g;
}
if b > highest {
highest = b;
}
let mut h;
if highest == r {
if g == 0 {
h = (HUE_PURPLE as u16 + HUE_PINK as u16) / 2;
h += scale8(qsub8(r, 128), Fract8(fixfrac8(48, 128))) as u16;
} else if (r as i32 - g as i32) > g as i32 {
h = HUE_RED as u16;
h += scale8(g, Fract8(fixfrac8(32, 85))) as u16;
} else {
h = HUE_ORANGE as u16;
let inner = (g as i32 - 85) + (171 - r as i32);
h += scale8(qsub8(inner as u8, 4), Fract8(fixfrac8(32, 85))) as u16;
}
} else if highest == g {
if b == 0 {
h = HUE_YELLOW as u16;
let radj = scale8(qsub8(171, r), Fract8(47));
let gadj = scale8(qsub8(g, 171), Fract8(96));
let rgadj = radj.wrapping_add(gadj);
let hueadv = rgadj / 2;
h += hueadv as u16;
} else if (g as i32 - b as i32) > b as i32 {
h = HUE_GREEN as u16;
h += scale8(b, Fract8(fixfrac8(32, 85))) as u16;
} else {
h = HUE_AQUA as u16;
h += scale8(qsub8(b, 85), Fract8(fixfrac8(8, 42))) as u16;
}
} else {
if r == 0 {
h = HUE_AQUA as u16 + (HUE_BLUE as u16 - HUE_AQUA as u16) / 4;
h += scale8(qsub8(b, 128), Fract8(fixfrac8(24, 128))) as u16;
} else if (b as i32 - r as i32) > r as i32 {
h = HUE_BLUE as u16;
h += scale8(r, Fract8(fixfrac8(32, 85))) as u16;
} else {
h = HUE_PURPLE as u16;
h += scale8(qsub8(r, 85), Fract8(fixfrac8(32, 85))) as u16;
}
}
let h = (h as u8).wrapping_add(1);
Chsv::new(h, s, v)
}