use embedded_graphics_core::pixelcolor::{Rgb565, RgbColor};
#[inline(always)]
pub fn fast_blend_rgb565(bg: Rgb565, fg: Rgb565, alpha: u8) -> Rgb565 {
if alpha == 255 {
return fg;
}
if alpha == 0 {
return bg;
}
let a = alpha as u32;
let inv = 255 - a;
let r = (bg.r() as u32 * inv + fg.r() as u32 * a) / 255;
let g = (bg.g() as u32 * inv + fg.g() as u32 * a) / 255;
let b = (bg.b() as u32 * inv + fg.b() as u32 * a) / 255;
Rgb565::new(r as u8, g as u8, b as u8)
}
#[inline(always)]
pub fn fast_blend_rgba8888(bg: [u8; 4], fg: [u8; 4]) -> [u8; 4] {
let a = fg[3] as u32;
if a == 255 {
return fg;
}
if a == 0 {
return bg;
}
let inv = 255 - a;
let r = (bg[0] as u32 * inv + fg[0] as u32 * a) / 255;
let g = (bg[1] as u32 * inv + fg[1] as u32 * a) / 255;
let b = (bg[2] as u32 * inv + fg[2] as u32 * a) / 255;
let out_a = fg[3] as u32 + (bg[3] as u32 * inv) / 255;
[r as u8, g as u8, b as u8, out_a as u8]
}
#[inline(always)]
pub fn fast_blend_rgba8888_to_rgb565(bg: Rgb565, fg_rgba: [u8; 4]) -> Rgb565 {
let alpha = fg_rgba[3];
if alpha == 0 {
return bg;
}
let fg_r = fg_rgba[0] >> 3;
let fg_g = fg_rgba[1] >> 2;
let fg_b = fg_rgba[2] >> 3;
if alpha == 255 {
return Rgb565::new(fg_r, fg_g, fg_b);
}
let fg_color = Rgb565::new(fg_r, fg_g, fg_b);
fast_blend_rgb565(bg, fg_color, alpha)
}
#[inline(always)]
pub fn reverse_color_rgb565(c: Rgb565) -> Rgb565 {
Rgb565::new(31 - c.r(), 63 - c.g(), 31 - c.b())
}
#[inline(always)]
pub fn reverse_color_rgba8888(rgba: [u8; 4]) -> [u8; 4] {
[255 - rgba[0], 255 - rgba[1], 255 - rgba[2], rgba[3]]
}