use crate::device::{Em100, HwVersion};
use crate::error::Result;
use byteorder::{ByteOrder, LittleEndian};
const FD_SIGNATURE: u32 = 0x0FF0A55A;
#[derive(Debug, Clone, Copy, PartialEq)]
enum IfdVersion {
V1,
V2,
}
#[derive(Debug, Clone, Copy)]
#[repr(u8)]
#[allow(dead_code, clippy::enum_variant_names)]
enum SpiFrequency {
Freq20MHz = 0,
Freq33MHz = 1,
Freq48MHz = 2,
Freq50MHz30MHz = 4,
Freq17MHz = 6,
}
fn find_fd(image: &[u8]) -> Option<usize> {
(0..image.len().saturating_sub(4))
.step_by(4)
.find(|&i| LittleEndian::read_u32(&image[i..]) == FD_SIGNATURE)
}
fn get_ifd_version(flcomp: u32) -> IfdVersion {
let read_freq = (flcomp >> 17) & 7;
match read_freq {
0 => IfdVersion::V1, 4 | 6 => IfdVersion::V2, _ => {
eprintln!("Unknown descriptor version: {}", read_freq);
IfdVersion::V2
}
}
}
fn set_spi_frequency(flcomp: &mut u32, freq: SpiFrequency) {
*flcomp &= !0x7fe00000;
*flcomp |= (freq as u32) << 27;
*flcomp |= (freq as u32) << 24;
*flcomp |= (freq as u32) << 21;
}
fn set_em100_mode(image: &mut [u8], fcba_offset: usize, em100: &Em100) {
if em100.hw_version == HwVersion::Em100ProG2 {
println!("Warning: EM100Pro-G2 can run at full speed.");
}
let flcomp = LittleEndian::read_u32(&image[fcba_offset..]);
let ifd_version = get_ifd_version(flcomp);
let (freq, freq_name) = match ifd_version {
IfdVersion::V1 => (SpiFrequency::Freq20MHz, "20MHz"),
IfdVersion::V2 => (SpiFrequency::Freq17MHz, "17MHz"),
};
println!("Limit SPI frequency to {}.", freq_name);
let mut new_flcomp = flcomp;
set_spi_frequency(&mut new_flcomp, freq);
LittleEndian::write_u32(&mut image[fcba_offset..], new_flcomp);
}
pub fn autocorrect_image(em100: &Em100, image: &mut [u8]) -> Result<bool> {
print!("Auto-detecting image type ... ");
if let Some(fd_offset) = find_fd(image) {
println!("IFD");
let flmap0 = LittleEndian::read_u32(&image[fd_offset + 4..]);
let fcba_offset = ((flmap0 & 0xff) as usize) << 4;
if fcba_offset >= image.len() {
println!("Inconsistent image.");
return Ok(false);
}
set_em100_mode(image, fcba_offset, em100);
Ok(true)
} else {
println!("<unknown>");
Ok(false)
}
}