Team2890/allwpilib
4
0
Fork 0
mirror of https://github.com/wpilibsuite/allwpilib synced 2026-06-27 02:01:42 +00:00
Code Issues Packages Projects Releases Wiki Activity

[wpilib] Add Color.fromHSV() static helper (#2461)

Browse Source 
Keep AddressableLEDBuffer.setHSV() implementation separate in Java
for performance reasons.
This commit is contained in:
Prateek Machiraju
2020-04-06 02:08:52 -04:00
committed by GitHub
parent e504b3ecbd
commit cb51029335
3 changed files with 75 additions and 33 deletions
Download Patch File Download Diff File Expand all files Collapse all files

36
wpilibc/src/main/native/include/frc/util/Color.h
View File

@@ -755,6 +755,42 @@ class Color {
green(roundAndClamp(g)),
blue(roundAndClamp(b)) {}
/**
* Creates a Color from HSV values.
*
* @param h The h value [0-180]
* @param s The s value [0-255]
* @param v The v value [0-255]
* @return The color
*/
static constexpr Color FromHSV(int h, int s, int v) {
if (s == 0) {
return {v / 255.0, v / 255.0, v / 255.0};
}
int region = h / 30;
int remainder = (h - (region * 30)) * 6;
int p = (v * (255 - s)) >> 8;
int q = (v * (255 - ((s * remainder) >> 8))) >> 8;
int t = (v * (255 - ((s * (255 - remainder)) >> 8))) >> 8;
switch (region) {
case 0:
return Color(v / 255.0, t / 255.0, p / 255.0);
case 1:
return Color(q / 255.0, v / 255.0, p / 255.0);
case 2:
return Color(p / 255.0, v / 255.0, t / 255.0);
case 3:
return Color(p / 255.0, q / 255.0, v / 255.0);
case 4:
return Color(t / 255.0, p / 255.0, v / 255.0);
default:
return Color(v / 255.0, p / 255.0, q / 255.0);
}
}
double red = 0.0;
double green = 0.0;
double blue = 0.0;