use super::Device;
use crate::build_assert;
use crate::error::*;
use crate::uapi;
mod private {
pub trait Sealed {}
}
pub trait Register: private::Sealed {
fn read(&self, dev: &mut Device) -> Result<u16>;
fn write(&self, dev: &mut Device, val: u16) -> Result;
fn read_status(dev: &mut Device) -> Result<u16>;
}
#[derive(Copy, Clone, Debug)]
pub struct C22(u8);
impl C22 {
pub const BMCR: Self = C22(0x00);
pub const BMSR: Self = C22(0x01);
pub const PHYSID1: Self = C22(0x02);
pub const PHYSID2: Self = C22(0x03);
pub const ADVERTISE: Self = C22(0x04);
pub const LPA: Self = C22(0x05);
pub const EXPANSION: Self = C22(0x06);
pub const NEXT_PAGE_TRANSMIT: Self = C22(0x07);
pub const LP_RECEIVED_NEXT_PAGE: Self = C22(0x08);
pub const MASTER_SLAVE_CONTROL: Self = C22(0x09);
pub const MASTER_SLAVE_STATUS: Self = C22(0x0a);
pub const PSE_CONTROL: Self = C22(0x0b);
pub const PSE_STATUS: Self = C22(0x0c);
pub const MMD_CONTROL: Self = C22(0x0d);
pub const MMD_DATA: Self = C22(0x0e);
pub const EXTENDED_STATUS: Self = C22(0x0f);
pub const fn vendor_specific<const N: u8>() -> Self {
build_assert!(
N > 0x0f && N < 0x20,
"Vendor-specific register address must be between 16 and 31"
);
C22(N)
}
}
impl private::Sealed for C22 {}
impl Register for C22 {
fn read(&self, dev: &mut Device) -> Result<u16> {
let phydev = dev.0.get();
let ret = unsafe {
bindings::mdiobus_read((*phydev).mdio.bus, (*phydev).mdio.addr, self.0.into())
};
to_result(ret)?;
Ok(ret as u16)
}
fn write(&self, dev: &mut Device, val: u16) -> Result {
let phydev = dev.0.get();
to_result(unsafe {
bindings::mdiobus_write((*phydev).mdio.bus, (*phydev).mdio.addr, self.0.into(), val)
})
}
fn read_status(dev: &mut Device) -> Result<u16> {
let phydev = dev.0.get();
let ret = unsafe { bindings::genphy_read_status(phydev) };
to_result(ret)?;
Ok(ret as u16)
}
}
#[derive(Copy, Clone, Debug)]
pub struct Mmd(u8);
impl Mmd {
pub const PMAPMD: Self = Mmd(uapi::MDIO_MMD_PMAPMD as u8);
pub const WIS: Self = Mmd(uapi::MDIO_MMD_WIS as u8);
pub const PCS: Self = Mmd(uapi::MDIO_MMD_PCS as u8);
pub const PHYXS: Self = Mmd(uapi::MDIO_MMD_PHYXS as u8);
pub const DTEXS: Self = Mmd(uapi::MDIO_MMD_DTEXS as u8);
pub const TC: Self = Mmd(uapi::MDIO_MMD_TC as u8);
pub const AN: Self = Mmd(uapi::MDIO_MMD_AN as u8);
pub const SEPARATED_PMA1: Self = Mmd(8);
pub const SEPARATED_PMA2: Self = Mmd(9);
pub const SEPARATED_PMA3: Self = Mmd(10);
pub const SEPARATED_PMA4: Self = Mmd(11);
pub const OFDM_PMAPMD: Self = Mmd(12);
pub const POWER_UNIT: Self = Mmd(13);
pub const C22_EXT: Self = Mmd(uapi::MDIO_MMD_C22EXT as u8);
pub const VEND1: Self = Mmd(uapi::MDIO_MMD_VEND1 as u8);
pub const VEND2: Self = Mmd(uapi::MDIO_MMD_VEND2 as u8);
}
pub struct C45 {
devad: Mmd,
regnum: u16,
}
impl C45 {
pub fn new(devad: Mmd, regnum: u16) -> Self {
Self { devad, regnum }
}
}
impl private::Sealed for C45 {}
impl Register for C45 {
fn read(&self, dev: &mut Device) -> Result<u16> {
let phydev = dev.0.get();
let ret =
unsafe { bindings::phy_read_mmd(phydev, self.devad.0.into(), self.regnum.into()) };
to_result(ret)?;
Ok(ret as u16)
}
fn write(&self, dev: &mut Device, val: u16) -> Result {
let phydev = dev.0.get();
to_result(unsafe {
bindings::phy_write_mmd(phydev, self.devad.0.into(), self.regnum.into(), val)
})
}
fn read_status(dev: &mut Device) -> Result<u16> {
let phydev = dev.0.get();
let ret = unsafe { bindings::genphy_c45_read_status(phydev) };
to_result(ret)?;
Ok(ret as u16)
}
}