From 244c7396d9fdb13da0b9dbf83d89495661482dbf Mon Sep 17 00:00:00 2001 From: occheung Date: Mon, 18 Nov 2024 12:08:44 +0800 Subject: [PATCH] runtime: handle drtio-eem satellite disconnection --- src/libboard_artiq/src/drtio_eem.rs | 19 +++++++++- src/runtime/src/rtio_mgt.rs | 59 +++++++++++++++++++++++------ 2 files changed, 66 insertions(+), 12 deletions(-) diff --git a/src/libboard_artiq/src/drtio_eem.rs b/src/libboard_artiq/src/drtio_eem.rs index 11d2e1f..5961121 100644 --- a/src/libboard_artiq/src/drtio_eem.rs +++ b/src/libboard_artiq/src/drtio_eem.rs @@ -185,6 +185,24 @@ unsafe fn align_comma(timer: &mut GlobalTimer) { } } +pub unsafe fn align_wordslip(timer: &mut GlobalTimer, trx_no: u8) -> bool { + pl::csr::eem_transceiver::transceiver_sel_write(trx_no); + + for slip in 0..=1 { + pl::csr::eem_transceiver::wordslip_write(slip as u8); + timer.delay_us(1); + pl::csr::eem_transceiver::comma_align_reset_write(1); + timer.delay_us(100); + + if pl::csr::eem_transceiver::comma_read() == 1 { + debug!("comma alignment completed with {} wordslip", slip); + return true; + } + } + + false +} + pub fn init(timer: &mut GlobalTimer, cfg: &Config) { for trx_no in 0..pl::csr::CONFIG_EEM_DRTIO_COUNT { unsafe { @@ -222,7 +240,6 @@ pub fn init(timer: &mut GlobalTimer, cfg: &Config) { unsafe { align_comma(timer); - pl::csr::eem_transceiver::rx_ready_write(1); } } } diff --git a/src/runtime/src/rtio_mgt.rs b/src/runtime/src/rtio_mgt.rs index f62fe75..f9c0f9c 100644 --- a/src/runtime/src/rtio_mgt.rs +++ b/src/runtime/src/rtio_mgt.rs @@ -13,9 +13,13 @@ pub mod drtio { use core::fmt; use embedded_hal::blocking::delay::DelayMs; + #[cfg(has_drtio_eem)] + use embedded_hal::blocking::delay::DelayUs; use ksupport::{resolve_channel_name, ASYNC_ERROR_BUSY, ASYNC_ERROR_COLLISION, ASYNC_ERROR_SEQUENCE_ERROR, SEEN_ASYNC_ERRORS}; use libasync::{delay, task}; + #[cfg(has_drtio_eem)] + use libboard_artiq::drtio_eem; use libboard_artiq::{drtioaux::Error as DrtioError, drtioaux_async, drtioaux_async::Packet, @@ -26,6 +30,10 @@ pub mod drtio { use super::*; use crate::{analyzer::remote_analyzer::RemoteBuffer, rtio_dma::remote_dma, subkernel}; + #[cfg(has_drtio_eem)] + const DRTIO_EEM_LINKNOS: core::ops::Range = + (csr::DRTIO.len() - csr::CONFIG_EEM_DRTIO_COUNT as usize)..csr::DRTIO.len(); + #[derive(Debug, PartialEq, Eq, Clone, Copy)] pub enum Error { Timeout, @@ -76,8 +84,18 @@ pub mod drtio { }); } - async fn link_rx_up(linkno: u8) -> bool { + async fn link_rx_up(linkno: u8, _timer: &mut GlobalTimer) -> bool { let linkno = linkno as usize; + #[cfg(has_drtio_eem)] + if DRTIO_EEM_LINKNOS.contains(&linkno) { + let eem_trx_no = linkno - DRTIO_EEM_LINKNOS.start; + unsafe { + csr::eem_transceiver::transceiver_sel_write(eem_trx_no as u8); + csr::eem_transceiver::comma_align_reset_write(1); + } + _timer.delay_us(100); + return unsafe { csr::eem_transceiver::comma_read() == 1 }; + } unsafe { (csr::DRTIO[linkno].rx_up_read)() == 1 } } @@ -152,8 +170,8 @@ pub mod drtio { } } - async fn recv_aux_timeout(linkno: u8, timeout: u64, timer: GlobalTimer) -> Result { - if !link_rx_up(linkno).await { + async fn recv_aux_timeout(linkno: u8, timeout: u64, mut timer: GlobalTimer) -> Result { + if !link_rx_up(linkno, &mut timer).await { return Err(Error::LinkDown); } match drtioaux_async::recv_timeout(linkno, Some(timeout), timer).await { @@ -168,9 +186,9 @@ pub mod drtio { linkno: u8, routing_table: &RoutingTable, request: &Packet, - timer: GlobalTimer, + mut timer: GlobalTimer, ) -> Result { - if !link_rx_up(linkno).await { + if !link_rx_up(linkno, &mut timer).await { return Err(Error::LinkDown); } let _lock = aux_mutex.async_lock().await; @@ -194,11 +212,11 @@ pub mod drtio { aux_mutex: &Rc>, linkno: u8, routing_table: &RoutingTable, - timer: GlobalTimer, + mut timer: GlobalTimer, ) -> u32 { let mut count = 0; loop { - if !link_rx_up(linkno).await { + if !link_rx_up(linkno, &mut timer).await { return 0; } count += 1; @@ -462,7 +480,7 @@ pub mod drtio { aux_mutex: &Rc>, routing_table: &RoutingTable, up_destinations: &Rc>, - timer: GlobalTimer, + mut timer: GlobalTimer, ) { let mut up_links = [false; csr::DRTIO.len()]; loop { @@ -470,16 +488,35 @@ pub mod drtio { let linkno = linkno as u8; if up_links[linkno as usize] { /* link was previously up */ - if link_rx_up(linkno).await { + if link_rx_up(linkno, &mut timer).await { process_unsolicited_aux(aux_mutex, linkno, routing_table).await; process_local_errors(linkno).await; } else { info!("[LINK#{}] link is down", linkno); up_links[linkno as usize] = false; + + #[cfg(has_drtio_eem)] + if DRTIO_EEM_LINKNOS.contains(&(linkno as usize)) { + unsafe { + csr::eem_transceiver::rx_ready_write(0); + } + while !matches!(drtioaux_async::recv(linkno).await, Ok(None)) {} + } } } else { /* link was previously down */ - if link_rx_up(linkno).await { + #[cfg(has_drtio_eem)] + if DRTIO_EEM_LINKNOS.contains(&(linkno as usize)) { + let eem_trx_no = linkno - DRTIO_EEM_LINKNOS.start as u8; + if !unsafe { drtio_eem::align_wordslip(&mut timer, eem_trx_no) } { + continue; + } + unsafe { + csr::eem_transceiver::rx_ready_write(1); + } + } + + if link_rx_up(linkno, &mut timer).await { info!("[LINK#{}] link RX became up, pinging", linkno); let ping_count = ping_remote(aux_mutex, linkno, routing_table, timer).await; if ping_count > 0 { @@ -523,7 +560,7 @@ pub mod drtio { for linkno in 0..csr::DRTIO.len() { let linkno = linkno as u8; - if task::block_on(link_rx_up(linkno)) { + if task::block_on(link_rx_up(linkno, &mut timer)) { let reply = task::block_on(aux_transact( &aux_mutex, linkno, -- 2.47.0