adding hardware uart
This commit is contained in:
@@ -17,38 +17,62 @@ use dma_gpio::config::{TX_RING_BYTES, RX_RING_BYTES, PIPE_RX_SIZE};
|
|||||||
use dma_gpio::software_uart::gpio_dma_uart_tx::tx_dma_task;
|
use dma_gpio::software_uart::gpio_dma_uart_tx::tx_dma_task;
|
||||||
use static_cell::StaticCell;
|
use static_cell::StaticCell;
|
||||||
use embassy_futures::yield_now;
|
use embassy_futures::yield_now;
|
||||||
|
use hw_uart_pc::usart1;
|
||||||
|
use embassy_stm32::usart::{BufferedUart, Config, BufferedInterruptHandler};
|
||||||
|
use embassy_stm32::peripherals;
|
||||||
use {defmt_rtt as _, panic_probe as _};
|
use {defmt_rtt as _, panic_probe as _};
|
||||||
|
|
||||||
pub const TIM6_UP_REQ: Request = 4;
|
bind_interrupts!(struct Irqs {
|
||||||
|
USART1 => BufferedInterruptHandler<peripherals::USART1>;
|
||||||
|
});
|
||||||
|
|
||||||
|
// Software uart
|
||||||
|
pub const TIM6_UP_REQ: Request = 4;
|
||||||
static PIPE_RX: Pipe<CriticalSectionRawMutex, PIPE_RX_SIZE> = Pipe::new();
|
static PIPE_RX: Pipe<CriticalSectionRawMutex, PIPE_RX_SIZE> = Pipe::new();
|
||||||
static TX_RING: StaticCell<[u32; TX_RING_BYTES]> = StaticCell::new();
|
static TX_RING: StaticCell<[u32; TX_RING_BYTES]> = StaticCell::new();
|
||||||
static RX_RING: StaticCell<[u8; RX_RING_BYTES]> = StaticCell::new();
|
static RX_RING: StaticCell<[u8; RX_RING_BYTES]> = StaticCell::new();
|
||||||
|
|
||||||
#[embassy_executor::main]
|
#[embassy_executor::main]
|
||||||
async fn main(spawner: Spawner) {
|
async fn main(spawner: Spawner) {
|
||||||
|
info!("boot");
|
||||||
let p = embassy_stm32::init(Default::default());
|
let p = embassy_stm32::init(Default::default());
|
||||||
info!("Hehe");
|
info!("init m8");
|
||||||
|
|
||||||
|
// HARDWARE UART to the PC
|
||||||
|
|
||||||
|
let mut cfg = Config::default();
|
||||||
|
cfg.baudrate = 230_400;
|
||||||
|
static TX_BUF: StaticCell<[u8; 256]> = StaticCell::new();
|
||||||
|
static RX_BUF: StaticCell<[u8; 256]> = StaticCell::new();
|
||||||
|
let uart = BufferedUart::new(
|
||||||
|
p.USART1,
|
||||||
|
p.PA10, // RX pin
|
||||||
|
p.PA9, // TX pin
|
||||||
|
TX_BUF.init([0; 256]),
|
||||||
|
RX_BUF.init([0; 256]),
|
||||||
|
Irqs,
|
||||||
|
cfg,
|
||||||
|
).unwrap();
|
||||||
|
let handle = usart1::setup_and_spawn(&spawner, uart, cfg.baudrate);
|
||||||
|
// END OF HARDWARE UART to the PC
|
||||||
|
|
||||||
|
// SOFTWARE UART
|
||||||
let _rx = Input::new(p.PA3, Pull::Up);
|
let _rx = Input::new(p.PA3, Pull::Up);
|
||||||
let _tx = Output::new(p.PA2, Level::High, Speed::VeryHigh);
|
let _tx = Output::new(p.PA2, Level::High, Speed::VeryHigh);
|
||||||
|
|
||||||
init_tim6_for_uart(p.TIM6, BAUD, TX_OVERSAMPLE);
|
init_tim6_for_uart(p.TIM6, BAUD, TX_OVERSAMPLE);
|
||||||
init_tim7_for_uart(p.TIM7, BAUD, RX_OVERSAMPLE);
|
init_tim7_for_uart(p.TIM7, BAUD, RX_OVERSAMPLE);
|
||||||
|
|
||||||
dump_tim6_regs();
|
dump_tim6_regs();
|
||||||
|
|
||||||
// Safe one-time init from StaticCell
|
// Safe one-time init from StaticCell
|
||||||
let rx_ring: &mut [u8; RX_RING_BYTES] = RX_RING.init([0; RX_RING_BYTES]);
|
let rx_ring: &mut [u8; RX_RING_BYTES] = RX_RING.init([0; RX_RING_BYTES]);
|
||||||
let tx_ring_mem: &mut [u32; TX_RING_BYTES] = TX_RING.init([0; TX_RING_BYTES]);
|
let tx_ring_mem: &mut [u32; TX_RING_BYTES] = TX_RING.init([0; TX_RING_BYTES]);
|
||||||
|
|
||||||
// Spawn tasks
|
|
||||||
spawner.spawn(rx_dma_task(p.GPDMA1_CH1, rx_ring, &PIPE_RX).unwrap());
|
spawner.spawn(rx_dma_task(p.GPDMA1_CH1, rx_ring, &PIPE_RX).unwrap());
|
||||||
|
|
||||||
// Create and start the TX DMA ring in main.
|
// Create and start the TX DMA ring in main.
|
||||||
// let bsrr_ptr = embassy_stm32::pac::GPIOA.bsrr().as_ptr() as *mut u32;
|
// let bsrr_ptr = embassy_stm32::pac::GPIOA.bsrr().as_ptr() as *mut u32;
|
||||||
let odr_ptr = embassy_stm32::pac::GPIOA.odr().as_ptr() as *mut u32;
|
let odr_ptr = embassy_stm32::pac::GPIOA.odr().as_ptr() as *mut u32;
|
||||||
spawner.spawn(tx_dma_task(p.GPDMA1_CH0, odr_ptr, tx_ring_mem, &PIPE_RX).unwrap());
|
spawner.spawn(tx_dma_task(p.GPDMA1_CH0, odr_ptr, tx_ring_mem, &PIPE_RX).unwrap());
|
||||||
|
// EDN OF SOFTWARE UART
|
||||||
|
|
||||||
loop {
|
loop {
|
||||||
info!("tick start");
|
info!("tick start");
|
||||||
|
|||||||
65
semestralka_1/src/hw_uart_pc/driver.rs
Normal file
65
semestralka_1/src/hw_uart_pc/driver.rs
Normal file
@@ -0,0 +1,65 @@
|
|||||||
|
// src/uart/driver.rs
|
||||||
|
use defmt::unwrap;
|
||||||
|
use embassy_executor::Spawner;
|
||||||
|
use embassy_futures::select::{select, Either};
|
||||||
|
use embassy_stm32::usart::BufferedUart;
|
||||||
|
use embassy_sync::blocking_mutex::raw::CriticalSectionRawMutex;
|
||||||
|
use embassy_sync::pipe::Pipe;
|
||||||
|
use embassy_time::Duration;
|
||||||
|
use embedded_io_async::{Read, Write};
|
||||||
|
|
||||||
|
use crate::uart::safety::{RX_PIPE_CAP, TX_PIPE_CAP};
|
||||||
|
|
||||||
|
pub struct UartHandle {
|
||||||
|
pub tx: &'static Pipe<CriticalSectionRawMutex, TX_PIPE_CAP>,
|
||||||
|
pub rx: &'static Pipe<CriticalSectionRawMutex, RX_PIPE_CAP>,
|
||||||
|
pub yield_period: Duration,
|
||||||
|
}
|
||||||
|
|
||||||
|
#[embassy_executor::task]
|
||||||
|
pub async fn uart_task(
|
||||||
|
mut uart: BufferedUart<'static>,
|
||||||
|
tx_pipe: &'static Pipe<CriticalSectionRawMutex, TX_PIPE_CAP>,
|
||||||
|
rx_pipe: &'static Pipe<CriticalSectionRawMutex, RX_PIPE_CAP>,
|
||||||
|
) {
|
||||||
|
let mut rx_byte = [0u8; 1];
|
||||||
|
let mut tx_buf = [0u8; 64];
|
||||||
|
|
||||||
|
loop {
|
||||||
|
let rx_fut = uart.read(&mut rx_byte);
|
||||||
|
let tx_fut = async {
|
||||||
|
let n = tx_pipe.read(&mut tx_buf).await;
|
||||||
|
n
|
||||||
|
};
|
||||||
|
|
||||||
|
match select(rx_fut, tx_fut).await {
|
||||||
|
// Incoming data from UART hardware
|
||||||
|
Either::First(res) => {
|
||||||
|
if let Ok(_) = res {
|
||||||
|
// Forward to RX pipe and echo to TX pipe (same behavior as before)
|
||||||
|
let _ = rx_pipe.write(&rx_byte).await;
|
||||||
|
let _ = tx_pipe.try_write(&rx_byte);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// Outgoing data waiting in TX pipe
|
||||||
|
Either::Second(n) => {
|
||||||
|
unwrap!(uart.write(&tx_buf[..n]).await);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn spawn_for(
|
||||||
|
spawner: &Spawner,
|
||||||
|
uart: BufferedUart<'static>,
|
||||||
|
tx_pipe: &'static Pipe<CriticalSectionRawMutex, TX_PIPE_CAP>,
|
||||||
|
rx_pipe: &'static Pipe<CriticalSectionRawMutex, RX_PIPE_CAP>,
|
||||||
|
yield_period: Duration,
|
||||||
|
) -> UartHandle {
|
||||||
|
spawner.spawn(uart_task(uart, tx_pipe, rx_pipe)).unwrap();
|
||||||
|
UartHandle {
|
||||||
|
tx: tx_pipe,
|
||||||
|
rx: rx_pipe,
|
||||||
|
yield_period,
|
||||||
|
}
|
||||||
|
}
|
||||||
4
semestralka_1/src/hw_uart_pc/mod.rs
Normal file
4
semestralka_1/src/hw_uart_pc/mod.rs
Normal file
@@ -0,0 +1,4 @@
|
|||||||
|
// src/uart/mod.rs
|
||||||
|
pub mod driver;
|
||||||
|
pub mod usart1;
|
||||||
|
pub mod safety;
|
||||||
57
semestralka_1/src/hw_uart_pc/safety.rs
Normal file
57
semestralka_1/src/hw_uart_pc/safety.rs
Normal file
@@ -0,0 +1,57 @@
|
|||||||
|
// src/safety.rs
|
||||||
|
use defmt::info;
|
||||||
|
use embassy_time::Duration;
|
||||||
|
|
||||||
|
// ISR RX ring capacity = RX_BUF len
|
||||||
|
const ISR_RX_BUF_CAP: usize = 256;
|
||||||
|
// Yield 1/2 the time it takes to fill ISR RX ring.
|
||||||
|
const YIELD_MARGIN_NUM: u32 = 1;
|
||||||
|
const YIELD_MARGIN_DEN: u32 = 2;
|
||||||
|
// Ensure RX_PIPE_CAP can hold this.
|
||||||
|
const WORST_MAIN_LATENCY_MS: u32 = 20;
|
||||||
|
|
||||||
|
pub const TX_PIPE_CAP: usize = 1024;
|
||||||
|
pub const RX_PIPE_CAP: usize = 1024;
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/// Perform safety checks and compute yield timing to avoid buffer overflow.
|
||||||
|
///
|
||||||
|
/// # Panics
|
||||||
|
/// Panics if pipe capacities are too small for the configured baud.
|
||||||
|
pub fn preflight_and_suggest_yield_period(baud: u32) -> Duration {
|
||||||
|
// Approx bytes per second for 8N1 (10 bits per byte on the wire)
|
||||||
|
let bytes_per_sec = (baud / 10).max(1);
|
||||||
|
|
||||||
|
// Time until ISR RX ring fills, in microseconds.
|
||||||
|
let t_fill_us = (ISR_RX_BUF_CAP as u64) * 1_000_000u64 / (bytes_per_sec as u64);
|
||||||
|
|
||||||
|
// Choose a yield period as a fraction of t_fill.
|
||||||
|
let yield_us = (t_fill_us as u64)
|
||||||
|
.saturating_mul(YIELD_MARGIN_NUM as u64)
|
||||||
|
/ (YIELD_MARGIN_DEN as u64);
|
||||||
|
|
||||||
|
// Verify RX pipe can absorb a worst-case app latency so uart_task
|
||||||
|
// can always forward without dropping when it runs.
|
||||||
|
let required_rx_pipe = (bytes_per_sec as u64) * (WORST_MAIN_LATENCY_MS as u64) / 1000;
|
||||||
|
|
||||||
|
if (RX_PIPE_CAP as u64) < required_rx_pipe {
|
||||||
|
core::panic!(
|
||||||
|
"RX pipe too small: have {}B, need >= {}B for {}ms at {} bps",
|
||||||
|
RX_PIPE_CAP, required_rx_pipe, WORST_MAIN_LATENCY_MS, baud
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
info!(
|
||||||
|
"Preflight: baud={}, rx_isr={}B, rx_pipe={}B, bytes/s={}, t_fill_us={}, yield_us={}",
|
||||||
|
baud,
|
||||||
|
ISR_RX_BUF_CAP,
|
||||||
|
RX_PIPE_CAP,
|
||||||
|
bytes_per_sec,
|
||||||
|
t_fill_us,
|
||||||
|
yield_us
|
||||||
|
);
|
||||||
|
|
||||||
|
// Never choose zero.
|
||||||
|
Duration::from_micros(yield_us.max(1) as u64)
|
||||||
|
}
|
||||||
23
semestralka_1/src/hw_uart_pc/usart1.rs
Normal file
23
semestralka_1/src/hw_uart_pc/usart1.rs
Normal file
@@ -0,0 +1,23 @@
|
|||||||
|
// src/uart/usart1.rs
|
||||||
|
use defmt::info;
|
||||||
|
use embassy_executor::Spawner;
|
||||||
|
use embassy_sync::blocking_mutex::raw::CriticalSectionRawMutex;
|
||||||
|
use embassy_sync::pipe::Pipe;
|
||||||
|
use embassy_time::Duration;
|
||||||
|
|
||||||
|
use crate::uart::safety::{preflight_and_suggest_yield_period, RX_PIPE_CAP, TX_PIPE_CAP};
|
||||||
|
use crate::uart::driver::{spawn_for, UartHandle};
|
||||||
|
|
||||||
|
// Static pipes and buffers
|
||||||
|
static UART1_TX_PIPE: Pipe<CriticalSectionRawMutex, TX_PIPE_CAP> = Pipe::new();
|
||||||
|
static UART1_RX_PIPE: Pipe<CriticalSectionRawMutex, RX_PIPE_CAP> = Pipe::new();
|
||||||
|
|
||||||
|
pub fn setup_and_spawn(
|
||||||
|
spawner: &Spawner,
|
||||||
|
uart: embassy_stm32::usart::BufferedUart<'static>,
|
||||||
|
baudrate: u32,
|
||||||
|
) -> UartHandle {
|
||||||
|
let yield_period: Duration = preflight_and_suggest_yield_period(baudrate);
|
||||||
|
info!("USART1 initialized");
|
||||||
|
spawn_for(spawner, uart, &UART1_TX_PIPE, &UART1_RX_PIPE, yield_period)
|
||||||
|
}
|
||||||
@@ -2,3 +2,4 @@
|
|||||||
|
|
||||||
pub mod software_uart;
|
pub mod software_uart;
|
||||||
pub mod config;
|
pub mod config;
|
||||||
|
pub mod hw_uart_pc;
|
||||||
|
|||||||
Reference in New Issue
Block a user