145 lines
3.9 KiB
Rust
145 lines
3.9 KiB
Rust
#![no_std]
|
|
#![no_main]
|
|
#![deny(warnings, unused)]
|
|
|
|
#[cfg(not(feature = "semihosting"))]
|
|
use panic_abort as _;
|
|
#[cfg(feature = "semihosting")]
|
|
use panic_semihosting as _;
|
|
|
|
use log::{info, warn};
|
|
|
|
use core::fmt::Write;
|
|
use cortex_m::asm::wfi;
|
|
use cortex_m_rt::entry;
|
|
use embedded_hal::watchdog::{WatchdogEnable, Watchdog};
|
|
use embedded_hal::digital::OutputPin;
|
|
use stm32f4xx_hal::{
|
|
rcc::RccExt,
|
|
gpio::GpioExt,
|
|
watchdog::IndependentWatchdog,
|
|
time::U32Ext,
|
|
stm32::{CorePeripherals, Peripherals},
|
|
};
|
|
use smoltcp::{
|
|
time::Instant,
|
|
wire::EthernetAddress,
|
|
};
|
|
|
|
mod net;
|
|
mod server;
|
|
use server::Server;
|
|
mod timer;
|
|
|
|
|
|
#[cfg(not(feature = "generate-hwaddr"))]
|
|
const NET_HWADDR: [u8; 6] = [0x02, 0x00, 0xDE, 0xAD, 0xBE, 0xEF];
|
|
|
|
#[cfg(not(feature = "semihosting"))]
|
|
fn init_log() {}
|
|
|
|
#[cfg(feature = "semihosting")]
|
|
fn init_log() {
|
|
use log::LevelFilter;
|
|
use cortex_m_log::log::{Logger, init};
|
|
use cortex_m_log::printer::semihosting::{InterruptOk, hio::HStdout};
|
|
static mut LOGGER: Option<Logger<InterruptOk<HStdout>>> = None;
|
|
let logger = Logger {
|
|
inner: InterruptOk::<_>::stdout().expect("semihosting stdout"),
|
|
level: LevelFilter::Info,
|
|
};
|
|
let logger = unsafe {
|
|
LOGGER.get_or_insert(logger)
|
|
};
|
|
|
|
init(logger).expect("set logger");
|
|
}
|
|
|
|
/// Initialization and main loop
|
|
#[entry]
|
|
fn main() -> ! {
|
|
init_log();
|
|
info!("tnetplug");
|
|
|
|
let mut cp = CorePeripherals::take().unwrap();
|
|
cp.SCB.enable_icache();
|
|
cp.SCB.enable_dcache(&mut cp.CPUID);
|
|
|
|
let dp = Peripherals::take().unwrap();
|
|
stm32_eth::setup(&dp.RCC, &dp.SYSCFG);
|
|
let clocks = dp.RCC.constrain()
|
|
.cfgr
|
|
.sysclk(168.mhz())
|
|
.hclk(168.mhz())
|
|
.pclk1(32.mhz())
|
|
.pclk2(64.mhz())
|
|
.freeze();
|
|
|
|
let mut wd = IndependentWatchdog::new(dp.IWDG);
|
|
wd.start(1000u32.ms());
|
|
wd.feed();
|
|
|
|
let gpioa = dp.GPIOA.split();
|
|
let gpiob = dp.GPIOB.split();
|
|
let gpioc = dp.GPIOC.split();
|
|
let gpioe = dp.GPIOE.split();
|
|
let gpiog = dp.GPIOG.split();
|
|
|
|
let mut relay1 = gpioe.pe11.into_push_pull_output();
|
|
let mut relay2 = gpioe.pe9.into_push_pull_output();
|
|
|
|
info!("Eth setup");
|
|
stm32_eth::setup_pins(
|
|
gpioa.pa1, gpioa.pa2, gpioa.pa7, gpiob.pb13, gpioc.pc1,
|
|
gpioc.pc4, gpioc.pc5, gpiog.pg11, gpiog.pg13
|
|
);
|
|
|
|
info!("Timer setup");
|
|
timer::setup(cp.SYST, clocks);
|
|
|
|
#[cfg(not(feature = "generate-hwaddr"))]
|
|
let hwaddr = EthernetAddress(NET_HWADDR);
|
|
#[cfg(feature = "generate-hwaddr")]
|
|
let hwaddr = {
|
|
let uid = stm32f4xx_hal::signature::Uid::get();
|
|
EthernetAddress(hash2hwaddr::generate_hwaddr(uid))
|
|
};
|
|
info!("Net hwaddr: {}", hwaddr);
|
|
|
|
info!("Net startup");
|
|
net::run(&mut cp.NVIC, dp.ETHERNET_MAC, dp.ETHERNET_DMA, hwaddr, |iface| {
|
|
Server::run(iface, |server| {
|
|
loop {
|
|
let now = timer::now().0;
|
|
let instant = Instant::from_millis(i64::from(now));
|
|
cortex_m::interrupt::free(net::clear_pending);
|
|
let cmd = server.poll(instant)
|
|
.unwrap_or_else(|e| {
|
|
warn!("poll: {:?}", e);
|
|
None
|
|
});
|
|
|
|
match cmd {
|
|
Some(b'a') => { relay1.set_low(); writeln!(server, "A=OFF").unwrap(); },
|
|
Some(b'A') => { relay1.set_high(); writeln!(server, "A=ON").unwrap(); },
|
|
Some(b'b') => { relay2.set_low(); writeln!(server, "B=OFF").unwrap(); },
|
|
Some(b'B') => { relay2.set_high(); writeln!(server, "B=ON").unwrap(); },
|
|
_ => (),
|
|
}
|
|
|
|
// Update watchdog
|
|
wd.feed();
|
|
|
|
cortex_m::interrupt::free(|cs| {
|
|
if !net::is_pending(cs) {
|
|
// Wait for interrupts
|
|
wfi();
|
|
}
|
|
});
|
|
}
|
|
});
|
|
});
|
|
|
|
unreachable!()
|
|
}
|