use crate::device::Em100;
use crate::error::{Error, Result};
use crate::usb;
use std::thread;
use std::time::Duration;
pub const FPGA_REG_DEVID: u8 = 0x40;
pub const FPGA_REG_VENDID: u8 = 0x42;
pub fn reconfig_fpga(em100: &Em100) -> Result<()> {
let cmd = [0x20u8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0];
usb::send_cmd(em100, &cmd)?;
thread::sleep(Duration::from_secs(2));
Ok(())
}
pub fn check_fpga_status(em100: &Em100) -> Result<bool> {
let cmd = [0x21u8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0];
usb::send_cmd(em100, &cmd)?;
let data = usb::get_response(em100, 512)?;
if data.len() == 1 {
Ok(data[0] == 1)
} else {
Err(Error::InvalidResponse)
}
}
pub fn read_fpga_register(em100: &Em100, reg: u8) -> Result<u16> {
let cmd = [0x22u8, reg, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0];
usb::send_cmd(em100, &cmd)?;
let data = usb::get_response(em100, 3)?;
if data.len() == 3 && data[0] == 2 {
let val = ((data[1] as u16) << 8) | (data[2] as u16);
Ok(val)
} else {
Err(Error::InvalidResponse)
}
}
pub fn write_fpga_register(em100: &Em100, reg: u8, val: u16) -> Result<()> {
let cmd = [
0x23u8,
reg,
(val >> 8) as u8,
(val & 0xff) as u8,
0,
0,
0,
0,
0,
0,
0,
0,
0,
0,
0,
0,
];
usb::send_cmd(em100, &cmd)?;
Ok(())
}
pub fn fpga_set_voltage(em100: &Em100, voltage_code: u8) -> Result<()> {
let mut cmd = [0u8; 16];
cmd[0] = 0x24;
if voltage_code == 18 {
cmd[2] = 7;
cmd[3] = 0x80;
}
usb::send_cmd(em100, &cmd)?;
Ok(())
}
pub fn fpga_get_voltage(em100: &Em100) -> Result<u8> {
Ok(if em100.fpga & 0x8000 != 0 { 18 } else { 33 })
}
pub fn fpga_reconfigure(em100: &Em100) -> Result<()> {
let cmd = [0x20u8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0];
usb::send_cmd(em100, &cmd)?;
Ok(())
}