embassy/examples/stm32f7/src/bin/can.rs

74 lines
2.3 KiB
Rust
Raw Normal View History

2023-06-22 17:18:55 +02:00
#![no_std]
#![no_main]
use core::num::{NonZeroU16, NonZeroU8};
2023-06-22 17:18:55 +02:00
use defmt::*;
use embassy_executor::Spawner;
use embassy_stm32::can::filter::Mask32;
2023-07-03 22:57:33 +02:00
use embassy_stm32::can::{
Can, CanTx, Fifo, Frame, Rx0InterruptHandler, Rx1InterruptHandler, SceInterruptHandler, StandardId,
TxInterruptHandler,
2023-07-03 22:57:33 +02:00
};
2023-06-22 17:18:55 +02:00
use embassy_stm32::gpio::{Input, Pull};
use embassy_stm32::peripherals::CAN3;
use embassy_stm32::{bind_interrupts, can};
use static_cell::StaticCell;
2023-06-22 17:18:55 +02:00
use {defmt_rtt as _, panic_probe as _};
bind_interrupts!(struct Irqs {
CAN3_RX0 => Rx0InterruptHandler<CAN3>;
CAN3_RX1 => Rx1InterruptHandler<CAN3>;
CAN3_SCE => SceInterruptHandler<CAN3>;
CAN3_TX => TxInterruptHandler<CAN3>;
});
#[embassy_executor::task]
pub async fn send_can_message(tx: &'static mut CanTx<'static, CAN3>) {
2023-06-22 17:18:55 +02:00
loop {
let frame = Frame::new_data(unwrap!(StandardId::new(0 as _)), &[0]).unwrap();
2023-06-22 17:18:55 +02:00
tx.write(&frame).await;
embassy_time::Timer::after_secs(1).await;
2023-06-22 17:18:55 +02:00
}
}
#[embassy_executor::main]
async fn main(spawner: Spawner) {
info!("Hello World!");
let mut p = embassy_stm32::init(Default::default());
// The next two lines are a workaround for testing without transceiver.
// To synchronise to the bus the RX input needs to see a high level.
// Use `mem::forget()` to release the borrow on the pin but keep the
// pull-up resistor enabled.
let rx_pin = Input::new(&mut p.PA15, Pull::Up);
core::mem::forget(rx_pin);
static CAN: StaticCell<Can<'static, CAN3>> = StaticCell::new();
let can = CAN.init(Can::new(p.CAN3, p.PA8, p.PA15, Irqs));
can.modify_filters().enable_bank(0, Fifo::Fifo0, Mask32::accept_all());
2023-06-22 17:18:55 +02:00
can.modify_config()
.set_bit_timing(can::util::NominalBitTiming {
prescaler: NonZeroU16::new(2).unwrap(),
seg1: NonZeroU8::new(13).unwrap(),
seg2: NonZeroU8::new(2).unwrap(),
sync_jump_width: NonZeroU8::new(1).unwrap(),
}) // http://www.bittiming.can-wiki.info/
.set_loopback(true);
can.enable().await;
2023-06-22 17:18:55 +02:00
2023-07-03 23:48:07 +02:00
let (tx, mut rx) = can.split();
static CAN_TX: StaticCell<CanTx<'static, CAN3>> = StaticCell::new();
let tx = CAN_TX.init(tx);
2023-07-03 23:48:07 +02:00
spawner.spawn(send_can_message(tx)).unwrap();
2023-06-22 17:18:55 +02:00
loop {
let envelope = rx.read().await.unwrap();
println!("Received: {:?}", envelope);
2023-06-22 17:18:55 +02:00
}
}