diff --git a/src/eth/mod.rs b/src/eth/mod.rs index fa859ae7..1f51d711 100644 --- a/src/eth/mod.rs +++ b/src/eth/mod.rs @@ -1,6 +1,7 @@ use crate::regs::*; use crate::slcr; +pub mod phy; mod regs; pub struct Eth { @@ -13,6 +14,7 @@ impl Eth { // MDIO slcr.mio_pin_53.write( slcr::MioPin53::zeroed() + .tri_enable(true) .l3_sel(0b100) .io_type(slcr::IoBufferType::Lvcmos18) .pullup(true) @@ -20,7 +22,6 @@ impl Eth { // MDC slcr.mio_pin_52.write( slcr::MioPin52::zeroed() - .tri_enable(true) .l3_sel(0b100) .io_type(slcr::IoBufferType::Lvcmos18) .pullup(true) @@ -220,5 +221,54 @@ impl Eth { .copy_all(true) .mdc_clk_div(0b111) ); + // TODO: mac addr + // TODO: Program the DMA Configuration register (gem.dma_cfg). + + self.regs.net_ctrl.write( + regs::NetCtrl::zeroed() + .mgmt_port_en(true) + .tx_en(true) + .rx_en(true) + ); + } + + fn wait_phy_idle(&self) { + let mut timeout = 5_000_000; + while !self.regs.net_status.read().phy_mgmt_idle() { + timeout -= 1; + if timeout == 0 { + break + } + } + } +} + +impl phy::PhyAccess for Eth { + fn read_phy(&mut self, addr: u8, reg: u8) -> u16 { + self.wait_phy_idle(); + self.regs.phy_maint.write( + regs::PhyMaint::zeroed() + .clause_22(true) + .operation(regs::PhyOperation::Read) + .phy_addr(addr) + .reg_addr(reg) + .must_10(0b10) + ); + self.wait_phy_idle(); + self.regs.phy_maint.read().data() + } + + fn write_phy(&mut self, addr: u8, reg: u8, data: u16) { + self.wait_phy_idle(); + self.regs.phy_maint.write( + regs::PhyMaint::zeroed() + .clause_22(true) + .operation(regs::PhyOperation::Write) + .phy_addr(addr) + .reg_addr(reg) + .must_10(0b10) + .data(data) + ); + self.wait_phy_idle(); } } diff --git a/src/eth/phy/mod.rs b/src/eth/phy/mod.rs new file mode 100644 index 00000000..fe2576c5 --- /dev/null +++ b/src/eth/phy/mod.rs @@ -0,0 +1,8 @@ +pub trait PhyAccess { + fn read_phy(&mut self, addr: u8, reg: u8) -> u16; + fn write_phy(&mut self, addr: u8, reg: u8, data: u16); +} + +pub trait PhyDevice { + fn init() -> Self; +} diff --git a/src/eth/regs.rs b/src/eth/regs.rs index 7dcd9602..60d81e93 100644 --- a/src/eth/regs.rs +++ b/src/eth/regs.rs @@ -124,7 +124,22 @@ impl RegisterBlock { } register!(net_ctrl, NetCtrl, RW, u32); +register_bit!(net_ctrl, loopback_local, 1); +register_bit!(net_ctrl, rx_en, 2); +register_bit!(net_ctrl, tx_en, 3); +register_bit!(net_ctrl, mgmt_port_en, 4); register_bit!(net_ctrl, clear_stat_regs, 5); +register_bit!(net_ctrl, incr_stat_regs, 6); +register_bit!(net_ctrl, wren_stat_regs, 7); +register_bit!(net_ctrl, back_pressure, 8); +register_bit!(net_ctrl, start_tx, 9); +register_bit!(net_ctrl, tx_halt, 10); +register_bit!(net_ctrl, tx_pause_frame, 11); +register_bit!(net_ctrl, tx_zeroq_pause_frame, 12); +register_bit!(net_ctrl, str_rx_timestamp, 15); +register_bit!(net_ctrl, en_pfc_pri_pause_rx, 16); +register_bit!(net_ctrl, tx_pfc_pri_pri_pause_frame, 17); +register_bit!(net_ctrl, flush_next_rx_dpram_pkt, 18); register!(net_cfg, NetCfg, RW, u32); register_bit!(net_cfg,