Add fmt.rs to improve log/debug and embbed and PC
Also add `defmt` to the features list.
This commit is contained in:
René van Dorst
parent
2c36199dea
commit
5c27265a21
4 changed files with 308 additions and 66 deletions
|
|
@ -21,7 +21,6 @@ embassy-time = { version = "0.1.0" }
|
|||
embassy-futures = { version = "0.1.0", path = "../embassy-futures" }
|
||||
bitfield = "0.14.0"
|
||||
|
||||
|
||||
[dev-dependencies]
|
||||
# reenable when https://github.com/dbrgn/embedded-hal-mock/pull/86 is merged.
|
||||
#embedded-hal-mock = { git = "https://github.com/dbrgn/embedded-hal-mock", branch = "1-alpha", features = ["embedded-hal-async", "eh1"] }] }
|
||||
|
|
@ -33,9 +32,11 @@ futures-test = "0.3.17"
|
|||
|
||||
[features]
|
||||
default = [ ]
|
||||
defmt = [ "dep:defmt" ]
|
||||
defmt = [ "dep:defmt", "embedded-hal-1/defmt-03" ]
|
||||
log = ["dep:log"]
|
||||
|
||||
[package.metadata.embassy_docs]
|
||||
src_base = "https://github.com/embassy-rs/embassy/blob/embassy-net-adin1110-v$VERSION/embassy-net-adin1110/src/"
|
||||
src_base_git = "https://github.com/embassy-rs/embassy/blob/$COMMIT/embassy-net-adin1110/src/"
|
||||
target = "thumbv7em-none-eabi"
|
||||
features = ["defmt"]
|
||||
|
|
|
|||
254
embassy-net-adin1110/src/fmt.rs
Normal file
254
embassy-net-adin1110/src/fmt.rs
Normal file
|
|
@ -0,0 +1,254 @@
|
|||
#![macro_use]
|
||||
#![allow(unused_macros)]
|
||||
|
||||
use core::fmt::{Debug, Display, LowerHex};
|
||||
|
||||
#[cfg(all(feature = "defmt", feature = "log"))]
|
||||
compile_error!("You may not enable both `defmt` and `log` features.");
|
||||
|
||||
macro_rules! assert {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::assert!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::assert!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! assert_eq {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::assert_eq!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::assert_eq!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! assert_ne {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::assert_ne!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::assert_ne!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! debug_assert {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::debug_assert!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::debug_assert!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! debug_assert_eq {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::debug_assert_eq!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::debug_assert_eq!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! debug_assert_ne {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::debug_assert_ne!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::debug_assert_ne!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! todo {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::todo!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::todo!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! unreachable {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::unreachable!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::unreachable!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! panic {
|
||||
($($x:tt)*) => {
|
||||
{
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
::core::panic!($($x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::panic!($($x)*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! trace {
|
||||
($s:literal $(, $x:expr)* $(,)?) => {
|
||||
{
|
||||
#[cfg(feature = "log")]
|
||||
::log::trace!($s $(, $x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::trace!($s $(, $x)*);
|
||||
#[cfg(not(any(feature = "log", feature="defmt")))]
|
||||
let _ignored = ($( & $x ),*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! debug {
|
||||
($s:literal $(, $x:expr)* $(,)?) => {
|
||||
{
|
||||
#[cfg(feature = "log")]
|
||||
::log::debug!($s $(, $x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::debug!($s $(, $x)*);
|
||||
#[cfg(not(any(feature = "log", feature="defmt")))]
|
||||
let _ignored = ($( & $x ),*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! info {
|
||||
($s:literal $(, $x:expr)* $(,)?) => {
|
||||
{
|
||||
#[cfg(feature = "log")]
|
||||
::log::info!($s $(, $x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::info!($s $(, $x)*);
|
||||
#[cfg(not(any(feature = "log", feature="defmt")))]
|
||||
let _ignored = ($( & $x ),*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! warn {
|
||||
($s:literal $(, $x:expr)* $(,)?) => {
|
||||
{
|
||||
#[cfg(feature = "log")]
|
||||
::log::warn!($s $(, $x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::warn!($s $(, $x)*);
|
||||
#[cfg(not(any(feature = "log", feature="defmt")))]
|
||||
let _ignored = ($( & $x ),*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
macro_rules! error {
|
||||
($s:literal $(, $x:expr)* $(,)?) => {
|
||||
{
|
||||
#[cfg(feature = "log")]
|
||||
::log::error!($s $(, $x)*);
|
||||
#[cfg(feature = "defmt")]
|
||||
::defmt::error!($s $(, $x)*);
|
||||
#[cfg(not(any(feature = "log", feature="defmt")))]
|
||||
let _ignored = ($( & $x ),*);
|
||||
}
|
||||
};
|
||||
}
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
macro_rules! unwrap {
|
||||
($($x:tt)*) => {
|
||||
::defmt::unwrap!($($x)*)
|
||||
};
|
||||
}
|
||||
|
||||
#[cfg(not(feature = "defmt"))]
|
||||
macro_rules! unwrap {
|
||||
($arg:expr) => {
|
||||
match $crate::fmt::Try::into_result($arg) {
|
||||
::core::result::Result::Ok(t) => t,
|
||||
::core::result::Result::Err(e) => {
|
||||
::core::panic!("unwrap of `{}` failed: {:?}", ::core::stringify!($arg), e);
|
||||
}
|
||||
}
|
||||
};
|
||||
($arg:expr, $($msg:expr),+ $(,)? ) => {
|
||||
match $crate::fmt::Try::into_result($arg) {
|
||||
::core::result::Result::Ok(t) => t,
|
||||
::core::result::Result::Err(e) => {
|
||||
::core::panic!("unwrap of `{}` failed: {}: {:?}", ::core::stringify!($arg), ::core::format_args!($($msg,)*), e);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
#[derive(Debug, Copy, Clone, Eq, PartialEq)]
|
||||
pub struct NoneError;
|
||||
|
||||
pub trait Try {
|
||||
type Ok;
|
||||
type Error;
|
||||
fn into_result(self) -> Result<Self::Ok, Self::Error>;
|
||||
}
|
||||
|
||||
impl<T> Try for Option<T> {
|
||||
type Ok = T;
|
||||
type Error = NoneError;
|
||||
|
||||
#[inline]
|
||||
fn into_result(self) -> Result<T, NoneError> {
|
||||
self.ok_or(NoneError)
|
||||
}
|
||||
}
|
||||
|
||||
impl<T, E> Try for Result<T, E> {
|
||||
type Ok = T;
|
||||
type Error = E;
|
||||
|
||||
#[inline]
|
||||
fn into_result(self) -> Self {
|
||||
self
|
||||
}
|
||||
}
|
||||
|
||||
pub struct Bytes<'a>(pub &'a [u8]);
|
||||
|
||||
impl<'a> Debug for Bytes<'a> {
|
||||
fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
|
||||
write!(f, "{:#02x?}", self.0)
|
||||
}
|
||||
}
|
||||
|
||||
impl<'a> Display for Bytes<'a> {
|
||||
fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
|
||||
write!(f, "{:#02x?}", self.0)
|
||||
}
|
||||
}
|
||||
|
||||
impl<'a> LowerHex for Bytes<'a> {
|
||||
fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
|
||||
write!(f, "{:#02x?}", self.0)
|
||||
}
|
||||
}
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
impl<'a> defmt::Format for Bytes<'a> {
|
||||
fn format(&self, fmt: defmt::Formatter) {
|
||||
defmt::write!(fmt, "{:02x}", self.0)
|
||||
}
|
||||
}
|
||||
|
|
@ -6,6 +6,9 @@
|
|||
#![allow(clippy::missing_panics_doc)]
|
||||
#![doc = include_str!("../README.md")]
|
||||
|
||||
// must go first!
|
||||
mod fmt;
|
||||
|
||||
mod crc32;
|
||||
mod crc8;
|
||||
mod mdio;
|
||||
|
|
@ -20,12 +23,13 @@ use embassy_net_driver_channel as ch;
|
|||
use embassy_time::{Duration, Timer};
|
||||
use embedded_hal_1::digital::OutputPin;
|
||||
use embedded_hal_async::digital::Wait;
|
||||
use embedded_hal_async::spi::{Operation, SpiDevice};
|
||||
use embedded_hal_async::spi::{Error, Operation, SpiDevice};
|
||||
use heapless::Vec;
|
||||
pub use mdio::MdioBus;
|
||||
pub use phy::{Phy10BaseT1x, RegsC22, RegsC45};
|
||||
pub use regs::{Config0, Config2, SpiRegisters as sr, Status0, Status1};
|
||||
|
||||
use crate::fmt::Bytes;
|
||||
use crate::regs::{LedCntrl, LedFunc, LedPol, LedPolarity, SpiHeader};
|
||||
|
||||
pub const PHYID: u32 = 0x0283_BC91;
|
||||
|
|
@ -153,8 +157,7 @@ impl<SPI: SpiDevice> ADIN1110<SPI> {
|
|||
|
||||
let value = u32::from_be_bytes(rx_buf[0..4].try_into().unwrap());
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::trace!("REG Read {} = {:08x} SPI {:02x}", reg, value, &tx_buf);
|
||||
trace!("REG Read {} = {:08x} SPI {}", reg, value, Bytes(&tx_buf));
|
||||
|
||||
Ok(value)
|
||||
}
|
||||
|
|
@ -181,8 +184,7 @@ impl<SPI: SpiDevice> ADIN1110<SPI> {
|
|||
let _ = tx_buf.push(crc8(val.as_slice()));
|
||||
}
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::trace!("REG Write {} = {:08x} SPI {:02x}", reg, value, &tx_buf);
|
||||
trace!("REG Write {} = {:08x} SPI {}", reg, value, Bytes(&tx_buf));
|
||||
|
||||
self.spi.write(&tx_buf).await.map_err(AdinError::Spi)
|
||||
}
|
||||
|
|
@ -219,8 +221,7 @@ impl<SPI: SpiDevice> ADIN1110<SPI> {
|
|||
let packet_size = fifo_frame_size - FRAME_HEADER_LEN - FCS_LEN;
|
||||
|
||||
if packet_size > frame.len() {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::trace!("MAX: {} WANT: {}", frame.len(), packet_size);
|
||||
trace!("MAX: {} WANT: {}", frame.len(), packet_size);
|
||||
return Err(AdinError::PACKET_TOO_BIG);
|
||||
}
|
||||
|
||||
|
|
@ -333,14 +334,13 @@ impl<SPI: SpiDevice> ADIN1110<SPI> {
|
|||
|
||||
self.write_reg(sr::TX_FSIZE, send_len).await?;
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::trace!(
|
||||
"TX: hdr {} [{}] {:02x}-{:02x}-{:02x} SIZE: {}",
|
||||
trace!(
|
||||
"TX: hdr {} [{}] {}-{}-{} SIZE: {}",
|
||||
head_data.len(),
|
||||
frame.len(),
|
||||
head_data.as_slice(),
|
||||
frame,
|
||||
tail_data.as_slice(),
|
||||
Bytes(head_data.as_slice()),
|
||||
Bytes(frame),
|
||||
Bytes(tail_data.as_slice()),
|
||||
send_len,
|
||||
);
|
||||
|
||||
|
|
@ -445,16 +445,14 @@ impl<'d, SPI: SpiDevice, INT: Wait, RST: OutputPin> Runner<'d, SPI, INT, RST> {
|
|||
let (state_chan, mut rx_chan, mut tx_chan) = self.ch.split();
|
||||
|
||||
loop {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::debug!("Waiting for interrupts");
|
||||
debug!("Waiting for interrupts");
|
||||
match select(self.int.wait_for_low(), tx_chan.tx_buf()).await {
|
||||
Either::First(_) => {
|
||||
let mut status1_clr = Status1(0);
|
||||
let mut status1 = Status1(self.mac.read_reg(sr::STATUS1).await.unwrap());
|
||||
|
||||
while status1.p1_rx_rdy() {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::debug!("alloc RX packet buffer");
|
||||
debug!("alloc RX packet buffer");
|
||||
match select(rx_chan.rx_buf(), tx_chan.tx_buf()).await {
|
||||
// Handle frames that needs to transmit from the wire.
|
||||
// Note: rx_chan.rx_buf() channel don´t accept new request
|
||||
|
|
@ -466,22 +464,18 @@ impl<'d, SPI: SpiDevice, INT: Wait, RST: OutputPin> Runner<'d, SPI, INT, RST> {
|
|||
}
|
||||
Err(e) => match e {
|
||||
AdinError::PACKET_TOO_BIG => {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("RX Packet too big, DROP");
|
||||
error!("RX Packet too big, DROP");
|
||||
self.mac.write_reg(sr::FIFO_CLR, 1).await.unwrap();
|
||||
}
|
||||
AdinError::PACKET_TOO_SMALL => {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("RX Packet too small, DROP");
|
||||
error!("RX Packet too small, DROP");
|
||||
self.mac.write_reg(sr::FIFO_CLR, 1).await.unwrap();
|
||||
}
|
||||
AdinError::Spi(_) => {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("RX Spi error")
|
||||
AdinError::Spi(e) => {
|
||||
error!("RX Spi error {}", e.kind());
|
||||
}
|
||||
_ => {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("RX Error")
|
||||
error!("RX Error");
|
||||
}
|
||||
},
|
||||
},
|
||||
|
|
@ -496,21 +490,18 @@ impl<'d, SPI: SpiDevice, INT: Wait, RST: OutputPin> Runner<'d, SPI, INT, RST> {
|
|||
|
||||
let status0 = Status0(self.mac.read_reg(sr::STATUS0).await.unwrap());
|
||||
if status1.0 & !0x1b != 0 {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("SPE CHIP STATUS 0:{:08x} 1:{:08x}", status0.0, status1.0);
|
||||
error!("SPE CHIP STATUS 0:{:08x} 1:{:08x}", status0.0, status1.0);
|
||||
}
|
||||
|
||||
if status1.tx_rdy() {
|
||||
status1_clr.set_tx_rdy(true);
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::info!("TX_DONE");
|
||||
trace!("TX_DONE");
|
||||
}
|
||||
|
||||
if status1.link_change() {
|
||||
let link = status1.p1_link_status();
|
||||
self.is_link_up = link;
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
if link {
|
||||
let link_status = self
|
||||
.mac
|
||||
|
|
@ -530,9 +521,9 @@ impl<'d, SPI: SpiDevice, INT: Wait, RST: OutputPin> Runner<'d, SPI, INT, RST> {
|
|||
.await
|
||||
.unwrap();
|
||||
|
||||
defmt::info!("LINK Changed: Link Up, Volt: {} V p-p, MSE: {:0004}", volt, mse);
|
||||
info!("LINK Changed: Link Up, Volt: {} V p-p, MSE: {:0004}", volt, mse);
|
||||
} else {
|
||||
defmt::info!("LINK Changed: Link Down");
|
||||
info!("LINK Changed: Link Down");
|
||||
}
|
||||
|
||||
state_chan.set_link_state(if link { LinkState::Up } else { LinkState::Down });
|
||||
|
|
@ -540,50 +531,42 @@ impl<'d, SPI: SpiDevice, INT: Wait, RST: OutputPin> Runner<'d, SPI, INT, RST> {
|
|||
}
|
||||
|
||||
if status1.tx_ecc_err() {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("SPI TX_ECC_ERR error, CLEAR TX FIFO");
|
||||
error!("SPI TX_ECC_ERR error, CLEAR TX FIFO");
|
||||
self.mac.write_reg(sr::FIFO_CLR, 2).await.unwrap();
|
||||
status1_clr.set_tx_ecc_err(true);
|
||||
}
|
||||
|
||||
if status1.rx_ecc_err() {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("SPI RX_ECC_ERR error");
|
||||
error!("SPI RX_ECC_ERR error");
|
||||
status1_clr.set_rx_ecc_err(true);
|
||||
}
|
||||
|
||||
if status1.spi_err() {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("SPI SPI_ERR CRC error");
|
||||
error!("SPI SPI_ERR CRC error");
|
||||
status1_clr.set_spi_err(true);
|
||||
}
|
||||
|
||||
if status0.phyint() {
|
||||
#[cfg_attr(not(feature = "defmt"), allow(unused_variables))]
|
||||
let crsm_irq_st = self
|
||||
.mac
|
||||
.read_cl45(MDIO_PHY_ADDR, RegsC45::DA1E::CRSM_IRQ_STATUS.into())
|
||||
.await
|
||||
.unwrap();
|
||||
|
||||
#[cfg_attr(not(feature = "defmt"), allow(unused_variables))]
|
||||
let phy_irq_st = self
|
||||
.mac
|
||||
.read_cl45(MDIO_PHY_ADDR, RegsC45::DA1F::PHY_SYBSYS_IRQ_STATUS.into())
|
||||
.await
|
||||
.unwrap();
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::warn!(
|
||||
warn!(
|
||||
"SPE CHIP PHY CRSM_IRQ_STATUS {:04x} PHY_SUBSYS_IRQ_STATUS {:04x}",
|
||||
crsm_irq_st,
|
||||
phy_irq_st
|
||||
crsm_irq_st, phy_irq_st
|
||||
);
|
||||
}
|
||||
|
||||
if status0.txfcse() {
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::error!("SPE CHIP PHY TX Frame CRC error");
|
||||
error!("Ethernet Frame FCS and calc FCS don't match!");
|
||||
}
|
||||
|
||||
// Clear status0
|
||||
|
|
@ -613,8 +596,7 @@ pub async fn new<const N_RX: usize, const N_TX: usize, SPI: SpiDevice, INT: Wait
|
|||
) -> (Device<'_>, Runner<'_, SPI, INT, RST>) {
|
||||
use crate::regs::{IMask0, IMask1};
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::info!("INIT ADIN1110");
|
||||
info!("INIT ADIN1110");
|
||||
|
||||
// Reset sequence
|
||||
reset.set_low().unwrap();
|
||||
|
|
@ -634,23 +616,20 @@ pub async fn new<const N_RX: usize, const N_TX: usize, SPI: SpiDevice, INT: Wait
|
|||
let id = mac.read_reg(sr::PHYID).await.unwrap();
|
||||
assert_eq!(id, PHYID);
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::debug!("SPE: CHIP MAC/ID: {:08x}", id);
|
||||
debug!("SPE: CHIP MAC/ID: {:08x}", id);
|
||||
|
||||
#[cfg(feature = "defmt")]
|
||||
let adin_phy = Phy10BaseT1x::default();
|
||||
#[cfg(feature = "defmt")]
|
||||
let phy_id = adin_phy.get_id(&mut mac).await.unwrap();
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::debug!("SPE: CHIP: PHY ID: {:08x}", phy_id);
|
||||
#[cfg(any(feature = "defmt", feature = "log"))]
|
||||
{
|
||||
let adin_phy = Phy10BaseT1x::default();
|
||||
let phy_id = adin_phy.get_id(&mut mac).await.unwrap();
|
||||
debug!("SPE: CHIP: PHY ID: {:08x}", phy_id);
|
||||
}
|
||||
|
||||
let mi_control = mac.read_cl22(MDIO_PHY_ADDR, RegsC22::CONTROL as u8).await.unwrap();
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::println!("SPE CHIP PHY MI_CONTROL {:04x}", mi_control);
|
||||
debug!("SPE CHIP PHY MI_CONTROL {:04x}", mi_control);
|
||||
if mi_control & 0x0800 != 0 {
|
||||
let val = mi_control & !0x0800;
|
||||
#[cfg(feature = "defmt")]
|
||||
defmt::println!("SPE CHIP PHY MI_CONTROL Disable PowerDown");
|
||||
debug!("SPE CHIP PHY MI_CONTROL Disable PowerDown");
|
||||
mac.write_cl22(MDIO_PHY_ADDR, RegsC22::CONTROL as u8, val)
|
||||
.await
|
||||
.unwrap();
|
||||
|
|
|
|||
|
|
@ -1,3 +1,5 @@
|
|||
use core::fmt::{Debug, Display};
|
||||
|
||||
use bitfield::{bitfield, bitfield_bitrange, bitfield_fields};
|
||||
|
||||
#[allow(non_camel_case_types)]
|
||||
|
|
@ -34,6 +36,12 @@ pub enum SpiRegisters {
|
|||
RX = 0x91,
|
||||
}
|
||||
|
||||
impl Display for SpiRegisters {
|
||||
fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
|
||||
write!(f, "{self:?}")
|
||||
}
|
||||
}
|
||||
|
||||
impl From<SpiRegisters> for u16 {
|
||||
fn from(val: SpiRegisters) -> Self {
|
||||
val as u16
|
||||
|
|
@ -68,7 +76,7 @@ impl From<u16> for SpiRegisters {
|
|||
0x73 => Self::ADDR_MSK_UPR1,
|
||||
0x90 => Self::RX_FSIZE,
|
||||
0x91 => Self::RX,
|
||||
e => panic!("Unknown value {e}"),
|
||||
e => panic!("Unknown value {}", e),
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
@ -313,7 +321,7 @@ impl From<u8> for LedFunc {
|
|||
26 => LedFunc::Clk25Ref,
|
||||
27 => LedFunc::TxTCLK,
|
||||
28 => LedFunc::Clk120MHz,
|
||||
e => panic!("Invalid value {e}"),
|
||||
e => panic!("Invalid value {}", e),
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
@ -369,7 +377,7 @@ impl From<u8> for LedPol {
|
|||
0 => LedPol::AutoSense,
|
||||
1 => LedPol::ActiveHigh,
|
||||
2 => LedPol::ActiveLow,
|
||||
e => panic!("Invalid value {e}"),
|
||||
e => panic!("Invalid value {}", e),
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
|
|||
Loading…
Reference in a new issue