use crate::{device_id::RawDeviceId, error::*, prelude::*, types::Opaque};
use core::{marker::PhantomData, ptr::addr_of_mut};
pub mod reg;
#[derive(PartialEq, Eq)]
pub enum DeviceState {
Down,
Ready,
Halted,
Error,
Up,
Running,
NoLink,
CableTest,
}
pub enum DuplexMode {
Full,
Half,
Unknown,
}
#[repr(transparent)]
pub struct Device(Opaque<bindings::phy_device>);
impl Device {
unsafe fn from_raw<'a>(ptr: *mut bindings::phy_device) -> &'a mut Self {
let ptr = ptr.cast::<Self>();
unsafe { &mut *ptr }
}
pub fn phy_id(&self) -> u32 {
let phydev = self.0.get();
unsafe { (*phydev).phy_id }
}
pub fn state(&self) -> DeviceState {
let phydev = self.0.get();
let state = unsafe { (*phydev).state };
match state {
bindings::phy_state_PHY_DOWN => DeviceState::Down,
bindings::phy_state_PHY_READY => DeviceState::Ready,
bindings::phy_state_PHY_HALTED => DeviceState::Halted,
bindings::phy_state_PHY_ERROR => DeviceState::Error,
bindings::phy_state_PHY_UP => DeviceState::Up,
bindings::phy_state_PHY_RUNNING => DeviceState::Running,
bindings::phy_state_PHY_NOLINK => DeviceState::NoLink,
bindings::phy_state_PHY_CABLETEST => DeviceState::CableTest,
_ => DeviceState::Error,
}
}
pub fn is_link_up(&self) -> bool {
const LINK_IS_UP: u64 = 1;
let bit_field = unsafe { &(*self.0.get())._bitfield_1 };
bit_field.get(14, 1) == LINK_IS_UP
}
pub fn is_autoneg_enabled(&self) -> bool {
let bit_field = unsafe { &(*self.0.get())._bitfield_1 };
bit_field.get(13, 1) == u64::from(bindings::AUTONEG_ENABLE)
}
pub fn is_autoneg_completed(&self) -> bool {
const AUTONEG_COMPLETED: u64 = 1;
let bit_field = unsafe { &(*self.0.get())._bitfield_1 };
bit_field.get(15, 1) == AUTONEG_COMPLETED
}
pub fn set_speed(&mut self, speed: u32) {
let phydev = self.0.get();
unsafe { (*phydev).speed = speed as c_int };
}
pub fn set_duplex(&mut self, mode: DuplexMode) {
let phydev = self.0.get();
let v = match mode {
DuplexMode::Full => bindings::DUPLEX_FULL,
DuplexMode::Half => bindings::DUPLEX_HALF,
DuplexMode::Unknown => bindings::DUPLEX_UNKNOWN,
};
unsafe { (*phydev).duplex = v as c_int };
}
pub fn read<R: reg::Register>(&mut self, reg: R) -> Result<u16> {
reg.read(self)
}
pub fn write<R: reg::Register>(&mut self, reg: R, val: u16) -> Result {
reg.write(self, val)
}
pub fn read_paged(&mut self, page: u16, regnum: u16) -> Result<u16> {
let phydev = self.0.get();
let ret = unsafe { bindings::phy_read_paged(phydev, page.into(), regnum.into()) };
to_result(ret).map(|()| ret as u16)
}
pub fn resolve_aneg_linkmode(&mut self) {
let phydev = self.0.get();
unsafe { bindings::phy_resolve_aneg_linkmode(phydev) };
}
pub fn genphy_soft_reset(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::genphy_soft_reset(phydev) })
}
pub fn init_hw(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::phy_init_hw(phydev) })
}
pub fn start_aneg(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::_phy_start_aneg(phydev) })
}
pub fn genphy_resume(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::genphy_resume(phydev) })
}
pub fn genphy_suspend(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::genphy_suspend(phydev) })
}
pub fn genphy_read_status<R: reg::Register>(&mut self) -> Result<u16> {
R::read_status(self)
}
pub fn genphy_update_link(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::genphy_update_link(phydev) })
}
pub fn genphy_read_lpa(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::genphy_read_lpa(phydev) })
}
pub fn genphy_read_abilities(&mut self) -> Result {
let phydev = self.0.get();
to_result(unsafe { bindings::genphy_read_abilities(phydev) })
}
}
impl AsRef<kernel::device::Device> for Device {
fn as_ref(&self) -> &kernel::device::Device {
let phydev = self.0.get();
unsafe { kernel::device::Device::from_raw(addr_of_mut!((*phydev).mdio.dev)) }
}
}
pub mod flags {
pub const IS_INTERNAL: u32 = bindings::PHY_IS_INTERNAL;
pub const RST_AFTER_CLK_EN: u32 = bindings::PHY_RST_AFTER_CLK_EN;
pub const POLL_CABLE_TEST: u32 = bindings::PHY_POLL_CABLE_TEST;
pub const ALWAYS_CALL_SUSPEND: u32 = bindings::PHY_ALWAYS_CALL_SUSPEND;
}
struct Adapter<T: Driver> {
_p: PhantomData<T>,
}
impl<T: Driver> Adapter<T> {
unsafe extern "C" fn soft_reset_callback(phydev: *mut bindings::phy_device) -> c_int {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::soft_reset(dev)?;
Ok(0)
})
}
unsafe extern "C" fn probe_callback(phydev: *mut bindings::phy_device) -> c_int {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::probe(dev)?;
Ok(0)
})
}
unsafe extern "C" fn get_features_callback(phydev: *mut bindings::phy_device) -> c_int {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::get_features(dev)?;
Ok(0)
})
}
unsafe extern "C" fn suspend_callback(phydev: *mut bindings::phy_device) -> c_int {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::suspend(dev)?;
Ok(0)
})
}
unsafe extern "C" fn resume_callback(phydev: *mut bindings::phy_device) -> c_int {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::resume(dev)?;
Ok(0)
})
}
unsafe extern "C" fn config_aneg_callback(phydev: *mut bindings::phy_device) -> c_int {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::config_aneg(dev)?;
Ok(0)
})
}
unsafe extern "C" fn read_status_callback(phydev: *mut bindings::phy_device) -> c_int {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::read_status(dev)?;
Ok(0)
})
}
unsafe extern "C" fn match_phy_device_callback(
phydev: *mut bindings::phy_device,
_phydrv: *const bindings::phy_driver,
) -> c_int {
let dev = unsafe { Device::from_raw(phydev) };
T::match_phy_device(dev).into()
}
unsafe extern "C" fn read_mmd_callback(
phydev: *mut bindings::phy_device,
devnum: i32,
regnum: u16,
) -> i32 {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
let ret = T::read_mmd(dev, devnum as u8, regnum)?;
Ok(ret.into())
})
}
unsafe extern "C" fn write_mmd_callback(
phydev: *mut bindings::phy_device,
devnum: i32,
regnum: u16,
val: u16,
) -> i32 {
from_result(|| {
let dev = unsafe { Device::from_raw(phydev) };
T::write_mmd(dev, devnum as u8, regnum, val)?;
Ok(0)
})
}
unsafe extern "C" fn link_change_notify_callback(phydev: *mut bindings::phy_device) {
let dev = unsafe { Device::from_raw(phydev) };
T::link_change_notify(dev);
}
}
#[repr(transparent)]
pub struct DriverVTable(Opaque<bindings::phy_driver>);
unsafe impl Sync for DriverVTable {}
pub const fn create_phy_driver<T: Driver>() -> DriverVTable {
DriverVTable(Opaque::new(bindings::phy_driver {
name: crate::str::as_char_ptr_in_const_context(T::NAME).cast_mut(),
flags: T::FLAGS,
phy_id: T::PHY_DEVICE_ID.id(),
phy_id_mask: T::PHY_DEVICE_ID.mask_as_int(),
soft_reset: if T::HAS_SOFT_RESET {
Some(Adapter::<T>::soft_reset_callback)
} else {
None
},
probe: if T::HAS_PROBE {
Some(Adapter::<T>::probe_callback)
} else {
None
},
get_features: if T::HAS_GET_FEATURES {
Some(Adapter::<T>::get_features_callback)
} else {
None
},
match_phy_device: if T::HAS_MATCH_PHY_DEVICE {
Some(Adapter::<T>::match_phy_device_callback)
} else {
None
},
suspend: if T::HAS_SUSPEND {
Some(Adapter::<T>::suspend_callback)
} else {
None
},
resume: if T::HAS_RESUME {
Some(Adapter::<T>::resume_callback)
} else {
None
},
config_aneg: if T::HAS_CONFIG_ANEG {
Some(Adapter::<T>::config_aneg_callback)
} else {
None
},
read_status: if T::HAS_READ_STATUS {
Some(Adapter::<T>::read_status_callback)
} else {
None
},
read_mmd: if T::HAS_READ_MMD {
Some(Adapter::<T>::read_mmd_callback)
} else {
None
},
write_mmd: if T::HAS_WRITE_MMD {
Some(Adapter::<T>::write_mmd_callback)
} else {
None
},
link_change_notify: if T::HAS_LINK_CHANGE_NOTIFY {
Some(Adapter::<T>::link_change_notify_callback)
} else {
None
},
..unsafe { core::mem::MaybeUninit::<bindings::phy_driver>::zeroed().assume_init() }
}))
}
#[vtable]
pub trait Driver {
const FLAGS: u32 = 0;
const NAME: &'static CStr;
const PHY_DEVICE_ID: DeviceId = DeviceId::new_with_custom_mask(0, 0);
fn soft_reset(_dev: &mut Device) -> Result {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn probe(_dev: &mut Device) -> Result {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn get_features(_dev: &mut Device) -> Result {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn match_phy_device(_dev: &Device) -> bool {
false
}
fn config_aneg(_dev: &mut Device) -> Result {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn read_status(_dev: &mut Device) -> Result<u16> {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn suspend(_dev: &mut Device) -> Result {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn resume(_dev: &mut Device) -> Result {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn read_mmd(_dev: &mut Device, _devnum: u8, _regnum: u16) -> Result<u16> {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn write_mmd(_dev: &mut Device, _devnum: u8, _regnum: u16, _val: u16) -> Result {
build_error!(VTABLE_DEFAULT_ERROR)
}
fn link_change_notify(_dev: &mut Device) {}
}
pub struct Registration {
drivers: Pin<&'static mut [DriverVTable]>,
}
unsafe impl Send for Registration {}
impl Registration {
pub fn register(
module: &'static crate::ThisModule,
drivers: Pin<&'static mut [DriverVTable]>,
) -> Result<Self> {
if drivers.is_empty() {
return Err(code::EINVAL);
}
to_result(unsafe {
bindings::phy_drivers_register(drivers[0].0.get(), drivers.len().try_into()?, module.0)
})?;
Ok(Registration { drivers })
}
}
impl Drop for Registration {
fn drop(&mut self) {
unsafe {
bindings::phy_drivers_unregister(self.drivers[0].0.get(), self.drivers.len() as i32)
};
}
}
#[repr(transparent)]
#[derive(Clone, Copy)]
pub struct DeviceId(bindings::mdio_device_id);
impl DeviceId {
pub const fn new_with_exact_mask(id: u32) -> Self {
Self(bindings::mdio_device_id {
phy_id: id,
phy_id_mask: DeviceMask::Exact.as_int(),
})
}
pub const fn new_with_model_mask(id: u32) -> Self {
Self(bindings::mdio_device_id {
phy_id: id,
phy_id_mask: DeviceMask::Model.as_int(),
})
}
pub const fn new_with_vendor_mask(id: u32) -> Self {
Self(bindings::mdio_device_id {
phy_id: id,
phy_id_mask: DeviceMask::Vendor.as_int(),
})
}
pub const fn new_with_custom_mask(id: u32, mask: u32) -> Self {
Self(bindings::mdio_device_id {
phy_id: id,
phy_id_mask: DeviceMask::Custom(mask).as_int(),
})
}
pub const fn new_with_driver<T: Driver>() -> Self {
T::PHY_DEVICE_ID
}
pub const fn id(&self) -> u32 {
self.0.phy_id
}
pub const fn mask_as_int(&self) -> u32 {
self.0.phy_id_mask
}
#[doc(hidden)]
pub const fn mdio_device_id(&self) -> bindings::mdio_device_id {
self.0
}
}
unsafe impl RawDeviceId for DeviceId {
type RawType = bindings::mdio_device_id;
}
enum DeviceMask {
Exact,
Model,
Vendor,
Custom(u32),
}
impl DeviceMask {
const MASK_EXACT: u32 = !0;
const MASK_MODEL: u32 = !0 << 4;
const MASK_VENDOR: u32 = !0 << 10;
const fn as_int(&self) -> u32 {
match self {
DeviceMask::Exact => Self::MASK_EXACT,
DeviceMask::Model => Self::MASK_MODEL,
DeviceMask::Vendor => Self::MASK_VENDOR,
DeviceMask::Custom(mask) => *mask,
}
}
}
#[macro_export]
macro_rules! module_phy_driver {
(@replace_expr $_t:tt $sub:expr) => {$sub};
(@count_devices $($x:expr),*) => {
0usize $(+ $crate::module_phy_driver!(@replace_expr $x 1usize))*
};
(@device_table [$($dev:expr),+]) => {
const N: usize = $crate::module_phy_driver!(@count_devices $($dev),+);
const TABLE: $crate::device_id::IdArray<$crate::net::phy::DeviceId, (), N> =
$crate::device_id::IdArray::new_without_index([ $(($dev,())),+, ]);
$crate::module_device_table!("mdio", phydev, TABLE);
};
(drivers: [$($driver:ident),+ $(,)?], device_table: [$($dev:expr),+ $(,)?], $($f:tt)*) => {
struct Module {
_reg: $crate::net::phy::Registration,
}
$crate::prelude::module! {
type: Module,
$($f)*
}
const _: () = {
static mut DRIVERS: [$crate::net::phy::DriverVTable;
$crate::module_phy_driver!(@count_devices $($driver),+)] =
[$($crate::net::phy::create_phy_driver::<$driver>()),+];
impl $crate::Module for Module {
fn init(module: &'static $crate::ThisModule) -> Result<Self> {
let drivers = unsafe { &mut DRIVERS };
let mut reg = $crate::net::phy::Registration::register(
module,
::core::pin::Pin::static_mut(drivers),
)?;
Ok(Module { _reg: reg })
}
}
};
$crate::module_phy_driver!(@device_table [$($dev),+]);
}
}