use anyhow::{bail, ensure, Context, Result};
use once_cell::sync::Lazy;
use regex::Regex;
use serde_annotate::Annotate;
use serialport::TTYPort;
use std::any::Any;
use std::cell::Cell;
use std::cell::RefCell;
use std::collections::hash_map::Entry;
use std::collections::HashMap;
use std::fs;
use std::io::Read;
use std::io::Write;
use std::marker::PhantomData;
use std::path::{Path, PathBuf};
use std::rc::{Rc, Weak};
use std::time::Duration;
use crate::debug::openocd::OpenOcdJtagChain;
use crate::io::gpio::{GpioBitbanging, GpioMonitoring, GpioPin};
use crate::io::i2c::Bus;
use crate::io::jtag::{JtagChain, JtagParams};
use crate::io::spi::Target;
use crate::io::uart::Uart;
use crate::transport::chip_whisperer::board::Board;
use crate::transport::chip_whisperer::ChipWhisperer;
use crate::transport::common::fpga::{ClearBitstream, FpgaProgram};
use crate::transport::common::uart::flock_serial;
use crate::transport::MaintainConnection;
use crate::transport::{
Capabilities, Capability, SetJtagPins, Transport, TransportError, TransportInterfaceType,
UpdateFirmware,
};
use crate::util::usb::UsbBackend;
pub mod c2d2;
pub mod dfu;
pub mod gpio;
pub mod i2c;
pub mod servo_micro;
pub mod spi;
pub mod ti50;
pub mod uart;
pub use c2d2::C2d2Flavor;
pub use dfu::HyperdebugDfu;
pub use servo_micro::ServoMicroFlavor;
pub use ti50::Ti50Flavor;
pub struct Hyperdebug<T: Flavor> {
spi_interface: BulkInterface,
i2c_interface: Option<BulkInterface>,
cmsis_interface: Option<BulkInterface>,
uart_interfaces: HashMap<String, UartInterface>,
cached_io_interfaces: CachedIo,
inner: Rc<Inner>,
current_firmware_version: Option<String>,
cmsis_google_capabilities: Cell<Option<u16>>,
phantom: PhantomData<T>,
}
pub trait Flavor {
fn gpio_pin(inner: &Rc<Inner>, pinname: &str) -> Result<Rc<dyn GpioPin>>;
fn spi_index(_inner: &Rc<Inner>, instance: &str) -> Result<(u8, u8)> {
bail!(TransportError::InvalidInstance(
TransportInterfaceType::Spi,
instance.to_string()
))
}
fn i2c_index(_inner: &Rc<Inner>, instance: &str) -> Result<(u8, i2c::Mode)> {
bail!(TransportError::InvalidInstance(
TransportInterfaceType::I2c,
instance.to_string()
))
}
fn get_default_usb_vid() -> u16;
fn get_default_usb_pid() -> u16;
fn load_bitstream(_fpga_program: &FpgaProgram) -> Result<()> {
Err(TransportError::UnsupportedOperation.into())
}
fn clear_bitstream(_clear: &ClearBitstream) -> Result<()> {
Err(TransportError::UnsupportedOperation.into())
}
fn perform_initial_fw_check() -> bool {
true
}
}
pub const VID_GOOGLE: u16 = 0x18d1;
pub const PID_HYPERDEBUG: u16 = 0x520e;
#[derive(Copy, Clone)]
pub struct BulkInterface {
interface: u8,
in_endpoint: u8,
out_endpoint: u8,
}
pub struct UartInterface {
interface: u8,
tty: PathBuf,
}
impl UartInterface {
pub fn new(interface: u8, tty: PathBuf) -> Self {
Self { interface, tty }
}
}
impl<T: Flavor> Hyperdebug<T> {
const USB_CLASS_VENDOR: u8 = 255;
const USB_SUBCLASS_UART: u8 = 80;
const USB_SUBCLASS_SPI: u8 = 81;
const USB_SUBCLASS_I2C: u8 = 82;
const USB_PROTOCOL_UART: u8 = 1;
const USB_PROTOCOL_SPI: u8 = 2;
const USB_PROTOCOL_I2C: u8 = 1;
const CMSIS_DAP_CUSTOM_COMMAND_GOOGLE_INFO: u8 = 0x80;
const GOOGLE_INFO_CAPABILITIES: u8 = 0x00;
const GOOGLE_CAP_I2C: u16 = 0x0001;
const GOOGLE_CAP_I2C_DEVICE: u16 = 0x0002;
const GOOGLE_CAP_GPIO_MONITORING: u16 = 0x0004;
const GOOGLE_CAP_GPIO_BITBANGING: u16 = 0x0008;
const GOOGLE_CAP_UART_QUEUE_CLEAR: u16 = 0x0010;
const GOOGLE_CAP_TPM_POLL: u16 = 0x0020;
pub fn open(
usb_vid: Option<u16>,
usb_pid: Option<u16>,
usb_serial: Option<&str>,
) -> Result<Self> {
let mut device = UsbBackend::new(
usb_vid.unwrap_or_else(T::get_default_usb_vid),
usb_pid.unwrap_or_else(T::get_default_usb_pid),
usb_serial,
)?;
let path = PathBuf::from("/sys/bus/usb/devices");
let mut console_tty: Option<PathBuf> = None;
let mut spi_interface: Option<BulkInterface> = None;
let mut i2c_interface: Option<BulkInterface> = None;
let mut cmsis_interface: Option<BulkInterface> = None;
let mut uart_interfaces: HashMap<String, UartInterface> = HashMap::new();
let config_desc = device.active_config_descriptor()?;
let current_firmware_version = if let Some(idx) = config_desc.description_string_index() {
if let Ok(current_firmware_version) = device.read_string_descriptor_ascii(idx) {
if let Some(released_firmware_version) = dfu::official_firmware_version()? {
if T::perform_initial_fw_check()
&& current_firmware_version != released_firmware_version
{
log::warn!(
"Current HyperDebug firmware version is {}, newest release is {}, Consider running `opentitantool transport update-firmware`",
current_firmware_version,
released_firmware_version,
);
}
}
Some(current_firmware_version)
} else {
None
}
} else {
None
};
for interface in config_desc.interfaces() {
for interface_desc in interface.descriptors() {
let ports = device
.port_numbers()?
.iter()
.map(|id| id.to_string())
.collect::<Vec<String>>()
.join(".");
let interface_path = path
.join(format!("{}-{}", device.bus_number(), ports))
.join(format!(
"{}-{}:{}.{}",
device.bus_number(),
ports,
config_desc.number(),
interface.number()
));
if interface_desc.class_code() == Self::USB_CLASS_VENDOR
&& interface_desc.sub_class_code() == Self::USB_SUBCLASS_UART
&& interface_desc.protocol_code() == Self::USB_PROTOCOL_UART
{
let idx = match interface_desc.description_string_index() {
Some(idx) => idx,
None => continue,
};
let interface_name = match device.read_string_descriptor_ascii(idx) {
Ok(interface_name) => interface_name,
_ => continue,
};
if !device.kernel_driver_active(interface.number())? {
device.attach_kernel_driver(interface.number())?;
std::thread::sleep(Duration::from_millis(100));
}
if interface_name.ends_with("Shell") {
console_tty = Some(Self::find_tty(&interface_path)?);
} else {
let uart = UartInterface {
interface: interface.number(),
tty: Self::find_tty(&interface_path)?,
};
uart_interfaces.insert(interface_name.to_string(), uart);
}
continue;
}
if interface_desc.class_code() == Self::USB_CLASS_VENDOR
&& interface_desc.sub_class_code() == Self::USB_SUBCLASS_SPI
&& interface_desc.protocol_code() == Self::USB_PROTOCOL_SPI
{
Self::find_endpoints_for_interface(
&mut spi_interface,
&interface,
&interface_desc,
)?;
continue;
}
if interface_desc.class_code() == Self::USB_CLASS_VENDOR
&& interface_desc.sub_class_code() == Self::USB_SUBCLASS_I2C
&& interface_desc.protocol_code() == Self::USB_PROTOCOL_I2C
{
Self::find_endpoints_for_interface(
&mut i2c_interface,
&interface,
&interface_desc,
)?;
continue;
}
if interface_desc.class_code() == Self::USB_CLASS_VENDOR {
let idx = match interface_desc.description_string_index() {
Some(idx) => idx,
None => continue,
};
let interface_name = match device.read_string_descriptor_ascii(idx) {
Ok(interface_name) => interface_name,
_ => continue,
};
if interface_name.ends_with("CMSIS-DAP") {
Self::find_endpoints_for_interface(
&mut cmsis_interface,
&interface,
&interface_desc,
)?;
continue;
}
}
}
}
let result = Hyperdebug::<T> {
spi_interface: spi_interface.ok_or_else(|| {
TransportError::CommunicationError("Missing SPI interface".to_string())
})?,
i2c_interface,
cmsis_interface,
uart_interfaces,
cached_io_interfaces: CachedIo {
gpio: Default::default(),
spis: Default::default(),
i2cs_by_name: Default::default(),
i2cs_by_index: Default::default(),
uarts: Default::default(),
},
inner: Rc::new(Inner {
console_tty: console_tty.ok_or_else(|| {
TransportError::CommunicationError("Missing console interface".to_string())
})?,
conn: RefCell::new(Weak::new()),
usb_device: RefCell::new(device),
selected_spi: Cell::new(0),
}),
current_firmware_version,
cmsis_google_capabilities: Cell::new(None),
phantom: PhantomData,
};
Ok(result)
}
fn find_tty(path: &Path) -> Result<PathBuf> {
for entry in fs::read_dir(path).context(format!("find TTY: read_dir({:?})", path))? {
let entry = entry.context(format!("find TTY: entity {:?}", path))?;
if let Ok(filename) = entry.file_name().into_string() {
if filename.starts_with("tty") {
return Ok(PathBuf::from("/dev").join(entry.file_name()));
}
}
}
Err(TransportError::CommunicationError("Did not find ttyUSBn device".to_string()).into())
}
fn find_endpoints_for_interface(
interface_variable_output: &mut Option<BulkInterface>,
interface: &rusb::Interface,
interface_desc: &rusb::InterfaceDescriptor,
) -> Result<()> {
let mut in_endpoint: Option<u8> = None;
let mut out_endpoint: Option<u8> = None;
for endpoint_desc in interface_desc.endpoint_descriptors() {
if endpoint_desc.transfer_type() != rusb::TransferType::Bulk {
continue;
}
match endpoint_desc.direction() {
rusb::Direction::In => {
ensure!(
in_endpoint.is_none(),
TransportError::CommunicationError("Multiple IN endpoints".to_string())
);
in_endpoint.replace(endpoint_desc.address());
}
rusb::Direction::Out => {
ensure!(
out_endpoint.is_none(),
TransportError::CommunicationError("Multiple OUT endpoints".to_string())
);
out_endpoint.replace(endpoint_desc.address());
}
}
}
match (in_endpoint, out_endpoint) {
(Some(in_endpoint), Some(out_endpoint)) => {
ensure!(
interface_variable_output.is_none(),
TransportError::CommunicationError("Multiple identical interfaces".to_string())
);
interface_variable_output.replace(BulkInterface {
interface: interface.number(),
in_endpoint,
out_endpoint,
});
Ok(())
}
_ => bail!(TransportError::CommunicationError(
"Missing one or more endpoints".to_string()
)),
}
}
fn get_cmsis_google_capabilities(&self) -> Result<u16> {
let Some(cmsis_interface) = self.cmsis_interface else {
return Ok(0);
};
if let Some(capabilities) = self.cmsis_google_capabilities.get() {
return Ok(capabilities);
}
self.inner
.usb_device
.borrow_mut()
.claim_interface(cmsis_interface.interface)?;
let cmd = [
Self::CMSIS_DAP_CUSTOM_COMMAND_GOOGLE_INFO,
Self::GOOGLE_INFO_CAPABILITIES,
];
self.inner
.usb_device
.borrow()
.write_bulk(cmsis_interface.out_endpoint, &cmd)?;
let mut resp = [0u8; 64];
let bytecount = self
.inner
.usb_device
.borrow()
.read_bulk(cmsis_interface.in_endpoint, &mut resp)?;
let resp = &resp[..bytecount];
ensure!(
bytecount >= 4 && resp[0] == Self::CMSIS_DAP_CUSTOM_COMMAND_GOOGLE_INFO && resp[1] >= 2,
TransportError::CommunicationError("Unrecognized CMSIS-DAP response".to_string())
);
let capabilities = u16::from_le_bytes([resp[2], resp[3]]);
self.cmsis_google_capabilities.set(Some(capabilities));
self.inner
.usb_device
.borrow_mut()
.release_interface(cmsis_interface.interface)?;
Ok(capabilities)
}
}
pub struct Inner {
console_tty: PathBuf,
conn: RefCell<Weak<Conn>>,
usb_device: RefCell<UsbBackend>,
selected_spi: Cell<u8>,
}
pub struct CachedIo {
gpio: RefCell<HashMap<String, Rc<dyn GpioPin>>>,
spis: RefCell<HashMap<u8, Rc<dyn Target>>>,
i2cs_by_name: RefCell<HashMap<String, Rc<dyn Bus>>>,
i2cs_by_index: RefCell<HashMap<u8, Rc<dyn Bus>>>,
uarts: RefCell<HashMap<PathBuf, Rc<dyn Uart>>>,
}
pub struct Conn {
console_port: RefCell<TTYPort>,
first_use: Cell<bool>,
}
impl MaintainConnection for Conn {}
impl Inner {
const COMMAND_TIMEOUT: Duration = Duration::from_millis(3000);
pub fn connect(&self) -> Result<Rc<Conn>> {
if let Some(conn) = self.conn.borrow().upgrade() {
return Ok(conn);
}
let port_name = self
.console_tty
.to_str()
.ok_or(TransportError::UnicodePathError)?;
let port =
TTYPort::open(&serialport::new(port_name, 115_200).timeout(Self::COMMAND_TIMEOUT))
.context("Failed to open HyperDebug console")?;
flock_serial(&port, port_name)?;
let conn = Rc::new(Conn {
console_port: RefCell::new(port),
first_use: Cell::new(true),
});
*self.conn.borrow_mut() = Rc::downgrade(&conn);
Ok(conn)
}
pub fn cmd_no_output(&self, cmd: &str) -> Result<()> {
let mut unexpected_output: bool = false;
self.execute_command(cmd, |line| {
log::warn!("Unexpected HyperDebug output: {}", line);
unexpected_output = true;
})?;
if unexpected_output {
bail!(TransportError::CommunicationError(format!(
"Unexpected output to {}",
cmd
)));
}
Ok(())
}
pub fn cmd_one_line_output(&self, cmd: &str) -> Result<String> {
let mut result: Option<String> = None;
let mut unexpected_output: bool = false;
self.execute_command(cmd, |line| {
if unexpected_output {
log::warn!("Unexpected HyperDebug output: {}", line);
} else if result.is_none() {
result = Some(line.to_string());
} else {
log::warn!("Unexpected HyperDebug output: {}", result.as_ref().unwrap());
log::warn!("Unexpected HyperDebug output: {}", line);
unexpected_output = true;
}
})?;
if unexpected_output {
bail!(TransportError::CommunicationError(
"Unexpected output".to_string()
));
}
match result {
None => bail!(TransportError::CommunicationError(format!(
"No response to command {}",
cmd
))),
Some(str) => Ok(str),
}
}
pub fn cmd_one_line_output_match<'a>(
&self,
cmd: &str,
regex: &Regex,
buf: &'a mut String,
) -> Result<regex::Captures<'a>> {
*buf = self.cmd_one_line_output(cmd)?;
let Some(captures) = regex.captures(buf) else {
log::warn!("Unexpected HyperDebug output: {}", buf);
bail!(TransportError::CommunicationError(
"Unexpected output".to_string()
));
};
Ok(captures)
}
fn execute_command(&self, cmd: &str, callback: impl FnMut(&str)) -> Result<()> {
let conn = self.connect()?;
conn.execute_command(cmd, callback)
}
}
impl Conn {
fn execute_command(&self, cmd: &str, mut callback: impl FnMut(&str)) -> Result<()> {
let port: &mut TTYPort = &mut self.console_port.borrow_mut();
if self.first_use.get() {
port.write(format!("\x03{}\n", cmd).as_bytes())
.context("writing to HyperDebug console")?;
self.first_use.set(false);
} else {
port.write(format!("{}\n", cmd).as_bytes())
.context("writing to HyperDebug console")?;
}
let mut buf = [0u8; 128];
let mut seen_echo = false;
let mut len: usize = 0;
loop {
match port.read(&mut buf[len..]) {
Ok(rc) => {
len += rc;
let mut line_start = 0;
for i in 0..len {
if buf[i] == b'\n' {
let mut line_end = i;
while line_end > line_start && buf[line_end - 1] == 13 {
line_end -= 1;
}
let line = std::str::from_utf8(&buf[line_start..line_end])
.context("utf8 decoding from HyperDebug console")?;
if seen_echo {
callback(line);
} else if line.len() >= 2 && line[line.len() - 2..] == *"^C" {
} else if line.len() >= cmd.len()
&& line[line.len() - cmd.len()..] == *cmd
{
seen_echo = true;
} else if !line.is_empty() {
log::info!("Unexpected output: {:?}", line)
}
line_start = i + 1;
}
}
if line_start > 0 {
buf.rotate_left(line_start);
len -= line_start;
}
if seen_echo && buf[0..len] == [b'>', b' '] {
return Ok(());
}
}
Err(error) => return Err(error).context("reading from HyperDebug console"),
}
}
}
}
impl<T: Flavor> Transport for Hyperdebug<T> {
fn capabilities(&self) -> Result<Capabilities> {
Ok(Capabilities::new(
Capability::UART
| Capability::UART_NONBLOCKING
| Capability::GPIO
| Capability::GPIO_MONITORING
| Capability::GPIO_BITBANGING
| Capability::SPI
| Capability::SPI_DUAL
| Capability::SPI_QUAD
| Capability::I2C
| Capability::JTAG,
))
}
fn apply_default_configuration(&self) -> Result<()> {
let mut error: Option<String> = None;
self.inner.execute_command("reinit", |line| {
log::warn!("Unexpected HyperDebug output: {}", line);
if line.starts_with("Error: ") {
error = Some(line.to_string());
}
})?;
if let Some(err) = error {
bail!(TransportError::CommunicationError(err));
}
Ok(())
}
fn spi(&self, instance: &str) -> Result<Rc<dyn Target>> {
let (enable_cmd, idx) = T::spi_index(&self.inner, instance)?;
if let Some(instance) = self.cached_io_interfaces.spis.borrow().get(&idx) {
return Ok(Rc::clone(instance));
}
let instance: Rc<dyn Target> = Rc::new(spi::HyperdebugSpiTarget::open(
&self.inner,
&self.spi_interface,
enable_cmd,
idx,
self.get_cmsis_google_capabilities()? & Self::GOOGLE_CAP_TPM_POLL != 0,
)?);
self.cached_io_interfaces
.spis
.borrow_mut()
.insert(idx, Rc::clone(&instance));
Ok(instance)
}
fn i2c(&self, name: &str) -> Result<Rc<dyn Bus>> {
if let Some(instance) = self.cached_io_interfaces.i2cs_by_name.borrow().get(name) {
return Ok(Rc::clone(instance));
}
let (idx, mode) = T::i2c_index(&self.inner, name)?;
if let Some(instance) = self.cached_io_interfaces.i2cs_by_index.borrow().get(&idx) {
self.cached_io_interfaces
.i2cs_by_name
.borrow_mut()
.insert(name.to_string(), Rc::clone(instance));
return Ok(Rc::clone(instance));
}
let cmsis_google_capabilities = self.get_cmsis_google_capabilities()?;
let instance: Rc<dyn Bus> = Rc::new(
match (
cmsis_google_capabilities & Self::GOOGLE_CAP_I2C != 0,
self.cmsis_interface.as_ref(),
self.i2c_interface.as_ref(),
) {
(true, Some(cmsis_interface), _) => i2c::HyperdebugI2cBus::open(
&self.inner,
cmsis_interface,
true, cmsis_google_capabilities & Self::GOOGLE_CAP_I2C_DEVICE != 0,
idx,
mode,
)?,
(_, _, Some(i2c_interface)) => i2c::HyperdebugI2cBus::open(
&self.inner,
i2c_interface,
false, false, idx,
mode,
)?,
_ => bail!(TransportError::InvalidInstance(
TransportInterfaceType::I2c,
name.to_string()
)),
},
);
self.cached_io_interfaces
.i2cs_by_index
.borrow_mut()
.insert(idx, Rc::clone(&instance));
self.cached_io_interfaces
.i2cs_by_name
.borrow_mut()
.insert(name.to_string(), Rc::clone(&instance));
Ok(instance)
}
fn uart(&self, instance: &str) -> Result<Rc<dyn Uart>> {
match self.uart_interfaces.get(instance) {
Some(uart_interface) => {
if let Some(instance) = self
.cached_io_interfaces
.uarts
.borrow()
.get(&uart_interface.tty)
{
return Ok(Rc::clone(instance));
}
let supports_clearing_queues =
self.get_cmsis_google_capabilities()? & Self::GOOGLE_CAP_UART_QUEUE_CLEAR != 0;
let instance: Rc<dyn Uart> = Rc::new(uart::HyperdebugUart::open(
&self.inner,
uart_interface,
supports_clearing_queues,
)?);
self.cached_io_interfaces
.uarts
.borrow_mut()
.insert(uart_interface.tty.clone(), Rc::clone(&instance));
Ok(instance)
}
_ => Err(TransportError::InvalidInstance(
TransportInterfaceType::Uart,
instance.to_string(),
)
.into()),
}
}
fn gpio_pin(&self, pinname: &str) -> Result<Rc<dyn GpioPin>> {
Ok(
match self
.cached_io_interfaces
.gpio
.borrow_mut()
.entry(pinname.to_string())
{
Entry::Vacant(v) => {
let u = v.insert(T::gpio_pin(&self.inner, pinname)?);
Rc::clone(u)
}
Entry::Occupied(o) => Rc::clone(o.get()),
},
)
}
fn gpio_monitoring(&self) -> Result<Rc<dyn GpioMonitoring>> {
if self.get_cmsis_google_capabilities()? & Self::GOOGLE_CAP_GPIO_MONITORING != 0 {
Ok(Rc::new(gpio::HyperdebugGpioMonitoring::open(
&self.inner,
self.cmsis_interface,
)?))
} else {
Ok(Rc::new(gpio::HyperdebugGpioMonitoring::open(
&self.inner,
None,
)?))
}
}
fn gpio_bitbanging(&self) -> Result<Rc<dyn GpioBitbanging>> {
ensure!(
self.get_cmsis_google_capabilities()? & Self::GOOGLE_CAP_GPIO_BITBANGING != 0,
TransportError::InvalidInterface(TransportInterfaceType::GpioBitbanging),
);
let Some(cmsis_interface) = self.cmsis_interface else {
bail!(TransportError::InvalidInterface(
TransportInterfaceType::GpioBitbanging
));
};
Ok(Rc::new(gpio::HyperdebugGpioBitbanging::open(
&self.inner,
cmsis_interface,
)?))
}
fn dispatch(&self, action: &dyn Any) -> Result<Option<Box<dyn Annotate>>> {
if let Some(update_firmware_action) = action.downcast_ref::<UpdateFirmware>() {
let usb_vid = self.inner.usb_device.borrow().get_vendor_id();
let usb_pid = self.inner.usb_device.borrow().get_product_id();
dfu::update_firmware(
&mut self.inner.usb_device.borrow_mut(),
self.current_firmware_version.as_deref(),
&update_firmware_action.firmware,
update_firmware_action.progress.as_ref(),
update_firmware_action.force,
usb_vid,
usb_pid,
)
} else if let Some(jtag_set_pins) = action.downcast_ref::<SetJtagPins>() {
match (
&jtag_set_pins.tclk,
&jtag_set_pins.tms,
&jtag_set_pins.tdi,
&jtag_set_pins.tdo,
&jtag_set_pins.trst,
) {
(Some(tclk), Some(tms), Some(tdi), Some(tdo), Some(trst)) => {
self.inner.cmd_no_output(&format!(
"jtag set-pins {} {} {} {} {}",
tclk.get_internal_pin_name()
.ok_or(TransportError::InvalidOperation)?,
tms.get_internal_pin_name()
.ok_or(TransportError::InvalidOperation)?,
tdi.get_internal_pin_name()
.ok_or(TransportError::InvalidOperation)?,
tdo.get_internal_pin_name()
.ok_or(TransportError::InvalidOperation)?,
trst.get_internal_pin_name()
.ok_or(TransportError::InvalidOperation)?,
))?;
Ok(None)
}
_ => Err(TransportError::UnsupportedOperation.into()),
}
} else if let Some(fpga_program) = action.downcast_ref::<FpgaProgram>() {
T::load_bitstream(fpga_program).map(|_| None)
} else if let Some(clear) = action.downcast_ref::<ClearBitstream>() {
T::clear_bitstream(clear).map(|_| None)
} else {
Err(TransportError::UnsupportedOperation.into())
}
}
fn jtag(&self, opts: &JtagParams) -> Result<Box<dyn JtagChain + '_>> {
ensure!(
self.cmsis_interface.is_some(),
TransportError::InvalidInterface(TransportInterfaceType::Jtag),
);
let usb_device = self.inner.usb_device.borrow();
let new_jtag = Box::new(OpenOcdJtagChain::new(
&format!(
"{}; cmsis_dap_vid_pid 0x{:04x} 0x{:04x}; adapter serial \"{}\";",
include_str!(env!("openocd_cmsis_dap_adapter_cfg")),
usb_device.get_vendor_id(),
usb_device.get_product_id(),
usb_device.get_serial_number(),
),
opts,
)?);
Ok(new_jtag)
}
fn maintain_connection(&self) -> Result<Rc<dyn MaintainConnection>> {
Ok(self.inner.connect()?)
}
}
pub struct StandardFlavor;
impl Flavor for StandardFlavor {
fn gpio_pin(inner: &Rc<Inner>, pinname: &str) -> Result<Rc<dyn GpioPin>> {
Ok(Rc::new(gpio::HyperdebugGpioPin::open(inner, pinname)?))
}
fn spi_index(inner: &Rc<Inner>, instance: &str) -> Result<(u8, u8)> {
match instance.parse() {
Err(_) => {
let mut buf = String::new();
let captures = inner
.cmd_one_line_output_match(
&format!("spi info {}", instance),
&SPI_REGEX,
&mut buf,
)
.map_err(|_| {
TransportError::InvalidInstance(
TransportInterfaceType::Spi,
instance.to_string(),
)
})?;
Ok((
spi::USB_SPI_REQ_ENABLE,
captures.get(1).unwrap().as_str().parse().unwrap(),
))
}
Ok(n) => Ok((spi::USB_SPI_REQ_ENABLE, n)),
}
}
fn i2c_index(inner: &Rc<Inner>, instance: &str) -> Result<(u8, i2c::Mode)> {
let mut buf = String::new();
let captures = inner
.cmd_one_line_output_match(&format!("i2c info {}", instance), &SPI_REGEX, &mut buf)
.map_err(|_| {
TransportError::InvalidInstance(TransportInterfaceType::I2c, instance.to_string())
})?;
let mode = match captures.get(4) {
Some(c) if c.as_str().starts_with('d') => i2c::Mode::Device,
_ => i2c::Mode::Host,
};
Ok((captures.get(1).unwrap().as_str().parse().unwrap(), mode))
}
fn get_default_usb_vid() -> u16 {
VID_GOOGLE
}
fn get_default_usb_pid() -> u16 {
PID_HYPERDEBUG
}
}
pub struct ChipWhispererFlavor<B: Board> {
_phantom: PhantomData<B>,
}
impl<B: Board> Flavor for ChipWhispererFlavor<B> {
fn gpio_pin(inner: &Rc<Inner>, pinname: &str) -> Result<Rc<dyn GpioPin>> {
StandardFlavor::gpio_pin(inner, pinname)
}
fn spi_index(inner: &Rc<Inner>, instance: &str) -> Result<(u8, u8)> {
StandardFlavor::spi_index(inner, instance)
}
fn i2c_index(inner: &Rc<Inner>, instance: &str) -> Result<(u8, i2c::Mode)> {
StandardFlavor::i2c_index(inner, instance)
}
fn get_default_usb_vid() -> u16 {
StandardFlavor::get_default_usb_vid()
}
fn get_default_usb_pid() -> u16 {
StandardFlavor::get_default_usb_pid()
}
fn load_bitstream(fpga_program: &FpgaProgram) -> Result<()> {
let board = ChipWhisperer::<B>::new(None, None, None, &[])?;
log::info!("Programming the FPGA bitstream.");
let usb = board.device.borrow();
usb.spi1_enable(false)?;
usb.fpga_program(&fpga_program.bitstream, fpga_program.progress.as_ref())?;
Ok(())
}
fn clear_bitstream(_clear: &ClearBitstream) -> Result<()> {
let board = ChipWhisperer::<B>::new(None, None, None, &[])?;
let usb = board.device.borrow();
usb.spi1_enable(false)?;
usb.clear_bitstream()?;
Ok(())
}
}
static SPI_REGEX: Lazy<Regex> =
Lazy::new(|| Regex::new("^ +([0-9]+) ([^ ]+) ([0-9]+) bps(?: ([hd])[^ ]*)?").unwrap());