use core::convert::Infallible;
use culvert::{FfeLevels, FrlConfig, FrlRate, Scdc, TmdsConfig, UpdateFlags};
use hdmi_hal::scdc::ScdcTransport;
struct SimulatedScdc {
regs: [u8; 256],
}
impl SimulatedScdc {
fn new() -> Self {
Self { regs: [0u8; 256] }
}
fn set(&mut self, addr: u8, val: u8) {
self.regs[addr as usize] = val;
}
}
impl ScdcTransport for SimulatedScdc {
type Error = Infallible;
fn read(&mut self, reg: u8) -> Result<u8, Infallible> {
Ok(self.regs[reg as usize])
}
fn write(&mut self, reg: u8, value: u8) -> Result<(), Infallible> {
self.regs[reg as usize] = value;
Ok(())
}
}
fn main() {
let mut transport = SimulatedScdc::new();
transport.set(0x01, 0x01);
transport.set(0x21, 0x01);
transport.set(0x40, 0x57);
transport.set(0x41, 0x31);
transport.set(0x10, 0x04);
transport.set(0x11, 0x00);
transport.set(0x50, 0x02); transport.set(0x51, 0x80);
transport.set(0x52, 0x4F); transport.set(0x53, 0x81);
transport.set(0x54, 0x00);
transport.set(0x55, 0x00);
transport.set(0x56, 0x00);
transport.set(0x57, 0x00);
let mut scdc = Scdc::new(transport);
let sink_version = scdc.read_sink_version().unwrap();
println!("Sink_Version: 0x{sink_version:02X}");
let scrambler = scdc.read_scrambler_status().unwrap();
println!("Scrambling active: {}", scrambler.scrambling_active);
let flags = scdc.read_status_flags().unwrap();
println!("Clock detected: {}", flags.clock_detected);
println!("Cable connected: {}", flags.cable_connected);
println!(
"Lane lock: ch0={} ch1={} ch2={} ch3={}",
flags.ch0_locked, flags.ch1_locked, flags.ch2_locked, flags.ch3_locked
);
println!("FLT_Ready: {}", flags.flt_ready);
println!("FRL_Start: {}", flags.frl_start);
println!("LTP_Req: {:?}", flags.ltp_req);
let updates = scdc.read_update_flags().unwrap();
println!(
"Update flags: status={} ced={} frl={} dsc={}",
updates.status_update, updates.ced_update, updates.frl_update, updates.dsc_update
);
let ced = scdc.read_ced().unwrap();
println!("CED lane 0: {:?}", ced.lane0.map(|c| c.value()));
println!("CED lane 1: {:?}", ced.lane1.map(|c| c.value()));
println!("CED lane 2: {:?}", ced.lane2);
println!("CED lane 3: {:?}", ced.lane3);
scdc.write_source_version(0x01).unwrap();
println!("\nWrote Source_Version = 0x01");
scdc.write_tmds_config(TmdsConfig {
scrambling_enable: true,
high_tmds_clock_ratio: true,
})
.unwrap();
println!("Wrote TMDS_Config: scrambling_enable=true, high_tmds_clock_ratio=true");
scdc.write_frl_config(FrlConfig {
frl_rate: FrlRate::Rate6Gbps3Lanes,
dsc_frl_max: false,
ffe_levels: FfeLevels::Ffe2,
})
.unwrap();
println!("Wrote Config_0: frl_rate=6G/3L, dsc_frl_max=false, ffe_levels=Ffe2");
scdc.clear_update_flags(UpdateFlags::new(false, false, true, false))
.unwrap();
println!("Cleared frl_update flag");
}