forked from M-Labs/kirdy
Load & Config IP Settings from Flash at StartUp
This commit is contained in:
parent
111d9a4226
commit
911d9a7bc9
@ -4,7 +4,7 @@ use crate::laser_diode::ld_ctrl::{*};
|
|||||||
use crate::laser_diode::laser_diode::LdDrive;
|
use crate::laser_diode::laser_diode::LdDrive;
|
||||||
use crate::thermostat::max1968::MAX1968;
|
use crate::thermostat::max1968::MAX1968;
|
||||||
use crate::thermostat::thermostat::Thermostat;
|
use crate::thermostat::thermostat::Thermostat;
|
||||||
use crate::net::net::ServerHandle;
|
use crate::net::net::{IpSettings, ServerHandle};
|
||||||
use stm32_eth;
|
use stm32_eth;
|
||||||
use fugit::ExtU32;
|
use fugit::ExtU32;
|
||||||
use log::{info, debug};
|
use log::{info, debug};
|
||||||
@ -15,7 +15,7 @@ use stm32f4xx_hal::{
|
|||||||
time::MegaHertz,
|
time::MegaHertz,
|
||||||
watchdog::IndependentWatchdog,
|
watchdog::IndependentWatchdog,
|
||||||
};
|
};
|
||||||
|
use crate::DeviceSettings;
|
||||||
use uom::si::electric_current::milliampere;
|
use uom::si::electric_current::milliampere;
|
||||||
use uom::si::{electric_current::ampere, f32::ElectricCurrent};
|
use uom::si::{electric_current::ampere, f32::ElectricCurrent};
|
||||||
|
|
||||||
@ -83,6 +83,22 @@ pub fn bootup(
|
|||||||
debug!("Setting up Internal Flash Driver");
|
debug!("Setting up Internal Flash Driver");
|
||||||
let flash_store = flash_store::store(perif.FLASH);
|
let flash_store = flash_store::store(perif.FLASH);
|
||||||
|
|
||||||
|
let mut ip_settings: IpSettings = IpSettings::default();
|
||||||
|
let device_settings : DeviceSettings;
|
||||||
|
match flash_store.read_value("Device") {
|
||||||
|
Ok(Some(config)) => {
|
||||||
|
device_settings = config;
|
||||||
|
ip_settings = device_settings.ip_settings;
|
||||||
|
debug!("Found Device Settings");
|
||||||
|
}
|
||||||
|
Ok(None) => {
|
||||||
|
debug!("Flash does not have IP Settings");
|
||||||
|
}
|
||||||
|
Err(e) => {
|
||||||
|
debug!("Cannot Store Flash: {:?}", e);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
debug!("Setting up ETH");
|
debug!("Setting up ETH");
|
||||||
let mac_addr = hw_rev.get_mac_address();
|
let mac_addr = hw_rev.get_mac_address();
|
||||||
let ethernet_parts_in = stm32_eth::PartsIn {
|
let ethernet_parts_in = stm32_eth::PartsIn {
|
||||||
@ -91,7 +107,7 @@ pub fn bootup(
|
|||||||
mmc: perif.ETHERNET_MMC,
|
mmc: perif.ETHERNET_MMC,
|
||||||
ptp: perif.ETHERNET_PTP,
|
ptp: perif.ETHERNET_PTP,
|
||||||
};
|
};
|
||||||
ServerHandle::new(eth_pins, eth_mgmt_pins, ethernet_parts_in, clocks, mac_addr);
|
ServerHandle::new(eth_pins, eth_mgmt_pins, ethernet_parts_in, clocks, mac_addr, ip_settings);
|
||||||
|
|
||||||
debug!("Setting Watchdog");
|
debug!("Setting Watchdog");
|
||||||
let mut wd = IndependentWatchdog::new(perif.IWDG);
|
let mut wd = IndependentWatchdog::new(perif.IWDG);
|
||||||
|
@ -10,6 +10,7 @@ mod thermostat;
|
|||||||
mod net;
|
mod net;
|
||||||
|
|
||||||
use device::{boot::bootup, log_setup, sys_timer};
|
use device::{boot::bootup, log_setup, sys_timer};
|
||||||
|
use crate::net::net::IpSettings;
|
||||||
use serde::{Deserialize, Serialize};
|
use serde::{Deserialize, Serialize};
|
||||||
use stm32f4xx_hal::pac::SCB;
|
use stm32f4xx_hal::pac::SCB;
|
||||||
|
|
||||||
@ -31,6 +32,7 @@ static mut ETH_DATA_BUFFER: [u8; 1024] = [0; 1024];
|
|||||||
#[derive(Deserialize, Serialize, Clone, Copy, Debug)]
|
#[derive(Deserialize, Serialize, Clone, Copy, Debug)]
|
||||||
pub struct DeviceSettings{
|
pub struct DeviceSettings{
|
||||||
report_readings: bool,
|
report_readings: bool,
|
||||||
|
ip_settings: IpSettings,
|
||||||
}
|
}
|
||||||
|
|
||||||
const CONFIG_KEY: [&str; 3] = ["Device", "Laser_0", "Thermostat_0"];
|
const CONFIG_KEY: [&str; 3] = ["Device", "Laser_0", "Thermostat_0"];
|
||||||
@ -57,6 +59,7 @@ fn main() -> ! {
|
|||||||
|
|
||||||
let mut device_settings = DeviceSettings {
|
let mut device_settings = DeviceSettings {
|
||||||
report_readings: false,
|
report_readings: false,
|
||||||
|
ip_settings: IpSettings::default()
|
||||||
};
|
};
|
||||||
|
|
||||||
let mut state = State::default();
|
let mut state = State::default();
|
||||||
|
@ -21,21 +21,24 @@ use stm32f4xx_hal::{
|
|||||||
rcc::Clocks,
|
rcc::Clocks,
|
||||||
interrupt,
|
interrupt,
|
||||||
};
|
};
|
||||||
|
use serde::{Deserialize, Serialize};
|
||||||
|
|
||||||
const IPV4_ADDR: (u8, u8, u8, u8) = (192, 168, 1, 132);
|
#[derive(Debug, Clone, Copy, Deserialize, Serialize)]
|
||||||
const IP_INIT: IpCidr = IpCidr::Ipv4(Ipv4Cidr::new(
|
pub struct IpSettings {
|
||||||
Ipv4Address::new(IPV4_ADDR.0, IPV4_ADDR.1, IPV4_ADDR.2, IPV4_ADDR.3),
|
addr: [u8; 4],
|
||||||
24,
|
port: u16,
|
||||||
));
|
prefix_len: u8,
|
||||||
const ADDRESS: (IpAddress, u16) = (
|
}
|
||||||
IpAddress::Ipv4(Ipv4Address::new(
|
|
||||||
IPV4_ADDR.0,
|
impl Default for IpSettings {
|
||||||
IPV4_ADDR.1,
|
fn default() -> Self {
|
||||||
IPV4_ADDR.2,
|
IpSettings {
|
||||||
IPV4_ADDR.3,
|
addr: [192, 168, 1, 132],
|
||||||
)),
|
port: 1337,
|
||||||
1337,
|
prefix_len: 24,
|
||||||
);
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
/// Interrupt pending flag: set by the `ETH` interrupt handler, should
|
/// Interrupt pending flag: set by the `ETH` interrupt handler, should
|
||||||
/// be cleared before polling the interface.
|
/// be cleared before polling the interface.
|
||||||
@ -44,6 +47,7 @@ static NET_PENDING: Mutex<RefCell<bool>> = Mutex::new(RefCell::new(false));
|
|||||||
pub struct ServerHandle {
|
pub struct ServerHandle {
|
||||||
socket_handle: SocketHandle,
|
socket_handle: SocketHandle,
|
||||||
socket_set: SocketSet<'static>,
|
socket_set: SocketSet<'static>,
|
||||||
|
socket_addr: (IpAddress, u16),
|
||||||
iface: EthInterface,
|
iface: EthInterface,
|
||||||
dma: EthernetDMA<'static, 'static>,
|
dma: EthernetDMA<'static, 'static>,
|
||||||
}
|
}
|
||||||
@ -87,7 +91,8 @@ impl ServerHandle {
|
|||||||
eth_mgmt_pins: EthernetMgmtPins,
|
eth_mgmt_pins: EthernetMgmtPins,
|
||||||
ethernet_parts_in: PartsIn,
|
ethernet_parts_in: PartsIn,
|
||||||
clocks: Clocks,
|
clocks: Clocks,
|
||||||
mac_addr: [u8; 6]
|
mac_addr: [u8; 6],
|
||||||
|
ip_settings: IpSettings,
|
||||||
) {
|
) {
|
||||||
let rx_ring = unsafe { RX_RING.get_or_insert(Default::default()) };
|
let rx_ring = unsafe { RX_RING.get_or_insert(Default::default()) };
|
||||||
let tx_ring = unsafe { TX_RING.get_or_insert(Default::default()) };
|
let tx_ring = unsafe { TX_RING.get_or_insert(Default::default()) };
|
||||||
@ -109,6 +114,20 @@ impl ServerHandle {
|
|||||||
eth_mgmt_pins.mdc
|
eth_mgmt_pins.mdc
|
||||||
).unwrap();
|
).unwrap();
|
||||||
|
|
||||||
|
let ip_init = IpCidr::Ipv4(Ipv4Cidr::new(
|
||||||
|
Ipv4Address::new(ip_settings.addr[0], ip_settings.addr[1], ip_settings.addr[2], ip_settings.addr[3]),
|
||||||
|
ip_settings.prefix_len,
|
||||||
|
));
|
||||||
|
let socket_addr: (IpAddress, u16) = (
|
||||||
|
IpAddress::Ipv4(Ipv4Address::new(
|
||||||
|
ip_settings.addr[0],
|
||||||
|
ip_settings.addr[1],
|
||||||
|
ip_settings.addr[2],
|
||||||
|
ip_settings.addr[3],
|
||||||
|
)),
|
||||||
|
ip_settings.port,
|
||||||
|
);
|
||||||
|
|
||||||
let mut routes = smoltcp::iface::Routes::new();
|
let mut routes = smoltcp::iface::Routes::new();
|
||||||
routes
|
routes
|
||||||
.add_default_ipv4_route(Ipv4Address::new(192, 168, 1, 1))
|
.add_default_ipv4_route(Ipv4Address::new(192, 168, 1, 1))
|
||||||
@ -123,20 +142,21 @@ impl ServerHandle {
|
|||||||
let mut iface = Interface::new(config, &mut &mut dma, smoltcp::time::Instant::ZERO);
|
let mut iface = Interface::new(config, &mut &mut dma, smoltcp::time::Instant::ZERO);
|
||||||
iface.set_hardware_addr(EthernetAddress(mac_addr).into());
|
iface.set_hardware_addr(EthernetAddress(mac_addr).into());
|
||||||
debug!("MAC ADDRESS: {:02X?}", EthernetAddress(mac_addr));
|
debug!("MAC ADDRESS: {:02X?}", EthernetAddress(mac_addr));
|
||||||
debug!("IP: {:?}", IP_INIT);
|
debug!("IP Settings: {:?}", ip_settings);
|
||||||
iface.update_ip_addrs(|addr| {
|
iface.update_ip_addrs(|addr| {
|
||||||
addr.push(IP_INIT).unwrap();
|
addr.push(ip_init).unwrap();
|
||||||
});
|
});
|
||||||
|
|
||||||
let mut sockets = SocketSet::new(&mut socket_storage[..]);
|
let mut sockets = SocketSet::new(&mut socket_storage[..]);
|
||||||
let tcp_handle = sockets.add(socket);
|
let tcp_handle = sockets.add(socket);
|
||||||
let socket = sockets.get_mut::<Socket>(tcp_handle);
|
let socket = sockets.get_mut::<Socket>(tcp_handle);
|
||||||
socket.listen(ADDRESS).ok();
|
socket.listen(socket_addr).ok();
|
||||||
iface.poll(Instant::from_millis(i64::from(sys_timer::now())), &mut &mut dma, &mut sockets);
|
iface.poll(Instant::from_millis(i64::from(sys_timer::now())), &mut &mut dma, &mut sockets);
|
||||||
|
|
||||||
let server = ServerHandle {
|
let server = ServerHandle {
|
||||||
socket_handle: tcp_handle,
|
socket_handle: tcp_handle,
|
||||||
socket_set: sockets,
|
socket_set: sockets,
|
||||||
|
socket_addr: socket_addr,
|
||||||
iface: iface,
|
iface: iface,
|
||||||
dma: dma,
|
dma: dma,
|
||||||
};
|
};
|
||||||
@ -193,7 +213,7 @@ impl ServerHandle {
|
|||||||
let socket = self.socket_set.get_mut::<Socket>(self.socket_handle);
|
let socket = self.socket_set.get_mut::<Socket>(self.socket_handle);
|
||||||
if !socket.is_listening() && !socket.is_open() || socket.state() == State::CloseWait {
|
if !socket.is_listening() && !socket.is_open() || socket.state() == State::CloseWait {
|
||||||
socket.abort();
|
socket.abort();
|
||||||
socket.listen(ADDRESS).ok();
|
socket.listen(self.socket_addr).ok();
|
||||||
info!("Disconnected... Reopening listening socket.");
|
info!("Disconnected... Reopening listening socket.");
|
||||||
return false;
|
return false;
|
||||||
} else if socket.state() == State::Closed || socket.state() == State::Closing {
|
} else if socket.state() == State::Closed || socket.state() == State::Closing {
|
||||||
|
Loading…
Reference in New Issue
Block a user