65 lines
1.8 KiB
Rust
65 lines
1.8 KiB
Rust
use heapless::{String, consts::*};
|
|
use smoltcp as net;
|
|
use embedded_nal as nal;
|
|
use core::str::FromStr;
|
|
|
|
unsafe fn read_record_length(addr: u32) -> u32 {
|
|
core::ptr::read(addr as *const u32)
|
|
}
|
|
|
|
unsafe fn read_byte(addr: u32) -> u8 {
|
|
core::ptr::read(addr as *const u8)
|
|
}
|
|
|
|
fn read_flash_str(addr: &mut u32) -> (String<U32>, String<U64>) {
|
|
let mut key: String<U32> = String::new();
|
|
let mut string: String<U64> = String::new();
|
|
|
|
let record_length = unsafe {
|
|
read_record_length(*addr)
|
|
};
|
|
if record_length == 0xFFFFFFFF {
|
|
return (key, string);
|
|
}
|
|
|
|
let mut key_string_div = false;
|
|
for f_addr in (*addr)+4..((*addr)+record_length) {
|
|
if key_string_div {
|
|
string.push(unsafe {read_byte(f_addr)} as char).unwrap();
|
|
} else {
|
|
let c = unsafe {read_byte(f_addr)};
|
|
if c == 0 {
|
|
key_string_div = true;
|
|
} else {
|
|
key.push(c as char).unwrap();
|
|
}
|
|
}
|
|
}
|
|
*addr += record_length;
|
|
(key, string)
|
|
}
|
|
|
|
pub fn read_flash(addr: &mut u32)
|
|
-> (net::wire::IpCidr, net::wire::EthernetAddress, nal::Ipv4Addr, String<U64>)
|
|
{
|
|
let mut cidr = net::wire::IpCidr::Ipv6(
|
|
net::wire::Ipv6Cidr::SOLICITED_NODE_PREFIX,
|
|
);
|
|
let mut eth = net::wire::EthernetAddress::BROADCAST;
|
|
let mut ip = nal::Ipv4Addr::unspecified();
|
|
let mut name = String::new();
|
|
loop {
|
|
let (key, string) = read_flash_str(addr);
|
|
if key.len() == 0 {
|
|
return (cidr, eth, ip, name);
|
|
}
|
|
match key.as_str() {
|
|
"CIDR" => cidr = net::wire::IpCidr::from_str(&string).unwrap(),
|
|
"MAC" => eth = net::wire::EthernetAddress::from_str(&string).unwrap(),
|
|
"BrokerIP" => ip = nal::Ipv4Addr::from_str(&string).unwrap(),
|
|
"Name" => name = string,
|
|
_ => {},
|
|
}
|
|
}
|
|
}
|