| 1 | |
| 2 |
|
| 3 | |
| 4 |
|
| 5 | |
| 6 | |
| 7 | |
| 8 | |
| 9 | |
| 10 |
|
| 11 | use super::Device;
|
| 12 | use crate::{
|
| 13 | build_assert::build_assert,
|
| 14 | error::*,
|
| 15 | uapi, |
| 16 | };
|
| 17 |
|
| 18 | mod private {
|
| 19 | |
| 20 | pub trait Sealed {}
|
| 21 | }
|
| 22 |
|
| 23 | |
| 24 | |
| 25 | |
| 26 | |
| 27 | |
| 28 | |
| 29 | |
| 30 | |
| 31 | |
| 32 | |
| 33 | |
| 34 | |
| 35 | |
| 36 | |
| 37 | |
| 38 | |
| 39 | |
| 40 | |
| 41 | |
| 42 | |
| 43 | |
| 44 | |
| 45 | pub trait Register: private::Sealed {
|
| 46 | |
| 47 | fn read(&self, dev: &mut Device) -> Result<u16>;
|
| 48 |
|
| 49 | |
| 50 | fn write(&self, dev: &mut Device, val: u16) -> Result;
|
| 51 |
|
| 52 | |
| 53 | fn read_status(dev: &mut Device) -> Result<u16>;
|
| 54 | }
|
| 55 |
|
| 56 | |
| 57 | #[derive(Copy, Clone, Debug)]
|
| 58 | pub struct C22(u8);
|
| 59 |
|
| 60 | impl C22 {
|
| 61 | |
| 62 | pub const BMCR: Self = C22(0x00);
|
| 63 | |
| 64 | pub const BMSR: Self = C22(0x01);
|
| 65 | |
| 66 | pub const PHYSID1: Self = C22(0x02);
|
| 67 | |
| 68 | pub const PHYSID2: Self = C22(0x03);
|
| 69 | |
| 70 | pub const ADVERTISE: Self = C22(0x04);
|
| 71 | |
| 72 | pub const LPA: Self = C22(0x05);
|
| 73 | |
| 74 | pub const EXPANSION: Self = C22(0x06);
|
| 75 | |
| 76 | pub const NEXT_PAGE_TRANSMIT: Self = C22(0x07);
|
| 77 | |
| 78 | pub const LP_RECEIVED_NEXT_PAGE: Self = C22(0x08);
|
| 79 | |
| 80 | pub const MASTER_SLAVE_CONTROL: Self = C22(0x09);
|
| 81 | |
| 82 | pub const MASTER_SLAVE_STATUS: Self = C22(0x0a);
|
| 83 | |
| 84 | pub const PSE_CONTROL: Self = C22(0x0b);
|
| 85 | |
| 86 | pub const PSE_STATUS: Self = C22(0x0c);
|
| 87 | |
| 88 | pub const MMD_CONTROL: Self = C22(0x0d);
|
| 89 | |
| 90 | pub const MMD_DATA: Self = C22(0x0e);
|
| 91 | |
| 92 | pub const EXTENDED_STATUS: Self = C22(0x0f);
|
| 93 |
|
| 94 | |
| 95 | pub const fn vendor_specific<const N: u8>() -> Self {
|
| 96 | build_assert!(
|
| 97 | N > 0x0f && N < 0x20,
|
| 98 | "Vendor-specific register address must be between 16 and 31"
|
| 99 | );
|
| 100 | C22(N)
|
| 101 | }
|
| 102 | }
|
| 103 |
|
| 104 | impl private::Sealed for C22 {}
|
| 105 |
|
| 106 | impl Register for C22 {
|
| 107 | fn read(&self, dev: &mut Device) -> Result<u16> {
|
| 108 | let phydev = dev.0.get();
|
| 109 | |
| 110 | |
| 111 | |
| 112 | let ret = unsafe {
|
| 113 | bindings::mdiobus_read((*phydev).mdio.bus, (*phydev).mdio.addr, self.0.into())
|
| 114 | };
|
| 115 | to_result(ret)?;
|
| 116 | Ok(ret as u16)
|
| 117 | }
|
| 118 |
|
| 119 | fn write(&self, dev: &mut Device, val: u16) -> Result {
|
| 120 | let phydev = dev.0.get();
|
| 121 | |
| 122 | |
| 123 | |
| 124 | to_result(unsafe {
|
| 125 | bindings::mdiobus_write((*phydev).mdio.bus, (*phydev).mdio.addr, self.0.into(), val)
|
| 126 | })
|
| 127 | }
|
| 128 |
|
| 129 | fn read_status(dev: &mut Device) -> Result<u16> {
|
| 130 | let phydev = dev.0.get();
|
| 131 | |
| 132 | |
| 133 | let ret = unsafe { bindings::genphy_read_status(phydev) };
|
| 134 | to_result(ret)?;
|
| 135 | Ok(ret as u16)
|
| 136 | }
|
| 137 | }
|
| 138 |
|
| 139 | |
| 140 | #[derive(Copy, Clone, Debug)]
|
| 141 | pub struct Mmd(u8);
|
| 142 |
|
| 143 | impl Mmd {
|
| 144 | |
| 145 | pub const PMAPMD: Self = Mmd(uapi::MDIO_MMD_PMAPMD as u8);
|
| 146 | |
| 147 | pub const WIS: Self = Mmd(uapi::MDIO_MMD_WIS as u8);
|
| 148 | |
| 149 | pub const PCS: Self = Mmd(uapi::MDIO_MMD_PCS as u8);
|
| 150 | |
| 151 | pub const PHYXS: Self = Mmd(uapi::MDIO_MMD_PHYXS as u8);
|
| 152 | |
| 153 | pub const DTEXS: Self = Mmd(uapi::MDIO_MMD_DTEXS as u8);
|
| 154 | |
| 155 | pub const TC: Self = Mmd(uapi::MDIO_MMD_TC as u8);
|
| 156 | |
| 157 | pub const AN: Self = Mmd(uapi::MDIO_MMD_AN as u8);
|
| 158 | |
| 159 | pub const SEPARATED_PMA1: Self = Mmd(8);
|
| 160 | |
| 161 | pub const SEPARATED_PMA2: Self = Mmd(9);
|
| 162 | |
| 163 | pub const SEPARATED_PMA3: Self = Mmd(10);
|
| 164 | |
| 165 | pub const SEPARATED_PMA4: Self = Mmd(11);
|
| 166 | |
| 167 | pub const OFDM_PMAPMD: Self = Mmd(12);
|
| 168 | |
| 169 | pub const POWER_UNIT: Self = Mmd(13);
|
| 170 | |
| 171 | pub const C22_EXT: Self = Mmd(uapi::MDIO_MMD_C22EXT as u8);
|
| 172 | |
| 173 | pub const VEND1: Self = Mmd(uapi::MDIO_MMD_VEND1 as u8);
|
| 174 | |
| 175 | pub const VEND2: Self = Mmd(uapi::MDIO_MMD_VEND2 as u8);
|
| 176 | }
|
| 177 |
|
| 178 | |
| 179 | |
| 180 | |
| 181 | |
| 182 | |
| 183 | |
| 184 | pub struct C45 {
|
| 185 | devad: Mmd,
|
| 186 | regnum: u16,
|
| 187 | }
|
| 188 |
|
| 189 | impl C45 {
|
| 190 | |
| 191 | pub fn new(devad: Mmd, regnum: u16) -> Self {
|
| 192 | Self { devad, regnum }
|
| 193 | }
|
| 194 | }
|
| 195 |
|
| 196 | impl private::Sealed for C45 {}
|
| 197 |
|
| 198 | impl Register for C45 {
|
| 199 | fn read(&self, dev: &mut Device) -> Result<u16> {
|
| 200 | let phydev = dev.0.get();
|
| 201 | |
| 202 | |
| 203 | let ret =
|
| 204 | unsafe { bindings::phy_read_mmd(phydev, self.devad.0.into(), self.regnum.into()) };
|
| 205 | to_result(ret)?;
|
| 206 | Ok(ret as u16)
|
| 207 | }
|
| 208 |
|
| 209 | fn write(&self, dev: &mut Device, val: u16) -> Result {
|
| 210 | let phydev = dev.0.get();
|
| 211 | |
| 212 | |
| 213 | to_result(unsafe {
|
| 214 | bindings::phy_write_mmd(phydev, self.devad.0.into(), self.regnum.into(), val)
|
| 215 | })
|
| 216 | }
|
| 217 |
|
| 218 | fn read_status(dev: &mut Device) -> Result<u16> {
|
| 219 | let phydev = dev.0.get();
|
| 220 | |
| 221 | |
| 222 | let ret = unsafe { bindings::genphy_c45_read_status(phydev) };
|
| 223 | to_result(ret)?;
|
| 224 | Ok(ret as u16)
|
| 225 | }
|
| 226 | }
|