use embedded_graphics_core::pixelcolor::Rgb565;
use embedded_hal::delay::DelayNs;
use crate::{
dcs::{
BitsPerPixel, ExitSleepMode, InterfaceExt, PixelFormat, SetAddressMode, SetDisplayOn,
SetInvertMode, SetPixelFormat,
},
interface::{Interface, InterfaceKind},
models::{Model, ModelInitError},
options::ModelOptions,
ConfigurationError,
};
pub struct GC9107;
impl Model for GC9107 {
type ColorFormat = Rgb565;
const FRAMEBUFFER_SIZE: (u16, u16) = (128, 160);
fn init<DELAY, DI>(
&mut self,
di: &mut DI,
delay: &mut DELAY,
options: &ModelOptions,
) -> Result<SetAddressMode, ModelInitError<DI::Error>>
where
DELAY: DelayNs,
DI: Interface,
{
if !matches!(
DI::KIND,
InterfaceKind::Serial4Line | InterfaceKind::Parallel8Bit
) {
return Err(ModelInitError::InvalidConfiguration(
ConfigurationError::UnsupportedInterface,
));
}
delay.delay_ms(200);
di.write_raw(0xFE, &[])?;
delay.delay_ms(5);
di.write_raw(0xEF, &[])?;
delay.delay_ms(5);
di.write_raw(0xB0, &[0xC0])?;
di.write_raw(0xB2, &[0x2F])?;
di.write_raw(0xB3, &[0x03])?;
di.write_raw(0xB6, &[0x19])?;
di.write_raw(0xB7, &[0x01])?;
let madctl = SetAddressMode::from(options);
di.write_command(madctl)?;
di.write_raw(0xAC, &[0xCB])?;
di.write_raw(0xAB, &[0x0E])?;
di.write_raw(0xB4, &[0x04])?;
di.write_raw(0xA8, &[0x19])?;
let pf = PixelFormat::with_all(BitsPerPixel::from_rgb_color::<Self::ColorFormat>());
di.write_command(SetPixelFormat::new(pf))?;
di.write_raw(0xB8, &[0x08])?;
di.write_raw(0xE8, &[0x24])?;
di.write_raw(0xE9, &[0x48])?;
di.write_raw(0xEA, &[0x22])?;
di.write_raw(0xC6, &[0x30])?;
di.write_raw(0xC7, &[0x18])?;
di.write_raw(
0xF0,
&[
0x01, 0x2b, 0x23, 0x3c, 0xb7, 0x12, 0x17, 0x60, 0x00, 0x06, 0x0c, 0x17, 0x12, 0x1f,
],
)?;
di.write_raw(
0xF1,
&[
0x05, 0x2e, 0x2d, 0x44, 0xd6, 0x15, 0x17, 0xa0, 0x02, 0x0d, 0x0d, 0x1a, 0x18, 0x1f,
],
)?;
di.write_command(SetInvertMode::new(options.invert_colors))?;
di.write_command(ExitSleepMode)?; delay.delay_ms(120);
di.write_command(SetDisplayOn)?;
Ok(madctl)
}
}