1 // SPDX-License-Identifier: GPL-2.0
2
3 // Copyright (C) 2023 FUJITA Tomonori <fujita.tomonori@gmail.com>
4
5 //! Network PHY device.
6 //!
7 //! C headers: [`include/linux/phy.h`](srctree/include/linux/phy.h).
8
9 use crate::{device_id::RawDeviceId, error::*, prelude::*, types::Opaque};
10 use core::{marker::PhantomData, ptr::addr_of_mut};
11
12 pub mod reg;
13
14 /// PHY state machine states.
15 ///
16 /// Corresponds to the kernel's [`enum phy_state`].
17 ///
18 /// Some of PHY drivers access to the state of PHY's software state machine.
19 ///
20 /// [`enum phy_state`]: srctree/include/linux/phy.h
21 #[derive(PartialEq, Eq)]
22 pub enum DeviceState {
23 /// PHY device and driver are not ready for anything.
24 Down,
25 /// PHY is ready to send and receive packets.
26 Ready,
27 /// PHY is up, but no polling or interrupts are done.
28 Halted,
29 /// PHY is up, but is in an error state.
30 Error,
31 /// PHY and attached device are ready to do work.
32 Up,
33 /// PHY is currently running.
34 Running,
35 /// PHY is up, but not currently plugged in.
36 NoLink,
37 /// PHY is performing a cable test.
38 CableTest,
39 }
40
41 /// A mode of Ethernet communication.
42 ///
43 /// PHY drivers get duplex information from hardware and update the current state.
44 pub enum DuplexMode {
45 /// PHY is in full-duplex mode.
46 Full,
47 /// PHY is in half-duplex mode.
48 Half,
49 /// PHY is in unknown duplex mode.
50 Unknown,
51 }
52
53 /// An instance of a PHY device.
54 ///
55 /// Wraps the kernel's [`struct phy_device`].
56 ///
57 /// A [`Device`] instance is created when a callback in [`Driver`] is executed. A PHY driver
58 /// executes [`Driver`]'s methods during the callback.
59 ///
60 /// # Invariants
61 ///
62 /// - Referencing a `phy_device` using this struct asserts that you are in
63 /// a context where all methods defined on this struct are safe to call.
64 /// - This struct always has a valid `self.0.mdio.dev`.
65 ///
66 /// [`struct phy_device`]: srctree/include/linux/phy.h
67 // During the calls to most functions in [`Driver`], the C side (`PHYLIB`) holds a lock that is
68 // unique for every instance of [`Device`]. `PHYLIB` uses a different serialization technique for
69 // [`Driver::resume`] and [`Driver::suspend`]: `PHYLIB` updates `phy_device`'s state with
70 // the lock held, thus guaranteeing that [`Driver::resume`] has exclusive access to the instance.
71 // [`Driver::resume`] and [`Driver::suspend`] also are called where only one thread can access
72 // to the instance.
73 #[repr(transparent)]
74 pub struct Device(Opaque<bindings::phy_device>);
75
76 impl Device {
77 /// Creates a new [`Device`] instance from a raw pointer.
78 ///
79 /// # Safety
80 ///
81 /// For the duration of `'a`,
82 /// - the pointer must point at a valid `phy_device`, and the caller
83 /// must be in a context where all methods defined on this struct
84 /// are safe to call.
85 /// - `(*ptr).mdio.dev` must be a valid.
from_raw<'a>(ptr: *mut bindings::phy_device) -> &'a mut Self86 unsafe fn from_raw<'a>(ptr: *mut bindings::phy_device) -> &'a mut Self {
87 // CAST: `Self` is a `repr(transparent)` wrapper around `bindings::phy_device`.
88 let ptr = ptr.cast::<Self>();
89 // SAFETY: by the function requirements the pointer is valid and we have unique access for
90 // the duration of `'a`.
91 unsafe { &mut *ptr }
92 }
93
94 /// Gets the id of the PHY.
phy_id(&self) -> u3295 pub fn phy_id(&self) -> u32 {
96 let phydev = self.0.get();
97 // SAFETY: The struct invariant ensures that we may access
98 // this field without additional synchronization.
99 unsafe { (*phydev).phy_id }
100 }
101
102 /// Gets the state of PHY state machine states.
state(&self) -> DeviceState103 pub fn state(&self) -> DeviceState {
104 let phydev = self.0.get();
105 // SAFETY: The struct invariant ensures that we may access
106 // this field without additional synchronization.
107 let state = unsafe { (*phydev).state };
108 // TODO: this conversion code will be replaced with automatically generated code by bindgen
109 // when it becomes possible.
110 match state {
111 bindings::phy_state_PHY_DOWN => DeviceState::Down,
112 bindings::phy_state_PHY_READY => DeviceState::Ready,
113 bindings::phy_state_PHY_HALTED => DeviceState::Halted,
114 bindings::phy_state_PHY_ERROR => DeviceState::Error,
115 bindings::phy_state_PHY_UP => DeviceState::Up,
116 bindings::phy_state_PHY_RUNNING => DeviceState::Running,
117 bindings::phy_state_PHY_NOLINK => DeviceState::NoLink,
118 bindings::phy_state_PHY_CABLETEST => DeviceState::CableTest,
119 _ => DeviceState::Error,
120 }
121 }
122
123 /// Gets the current link state.
124 ///
125 /// It returns true if the link is up.
126 #[inline]
is_link_up(&self) -> bool127 pub fn is_link_up(&self) -> bool {
128 let phydev = self.0.get().cast_const();
129 // SAFETY: By the type invariant of `Device`, `phydev` points to a valid
130 // `struct phy_device`, and there is no concurrent write to this field.
131 let link = unsafe { bindings::phy_device::link_raw(phydev) };
132 link == 1
133 }
134
135 /// Gets the current auto-negotiation configuration.
136 ///
137 /// It returns true if auto-negotiation is enabled.
138 #[inline]
is_autoneg_enabled(&self) -> bool139 pub fn is_autoneg_enabled(&self) -> bool {
140 let phydev = self.0.get().cast_const();
141 // SAFETY: By the type invariant of `Device`, `phydev` points to a valid
142 // `struct phy_device`, and there is no concurrent write to this field.
143 let autoneg = unsafe { bindings::phy_device::autoneg_raw(phydev) };
144 autoneg == bindings::AUTONEG_ENABLE
145 }
146
147 /// Gets the current auto-negotiation state.
148 ///
149 /// It returns true if auto-negotiation is completed.
150 #[inline]
is_autoneg_completed(&self) -> bool151 pub fn is_autoneg_completed(&self) -> bool {
152 let phydev = self.0.get().cast_const();
153 // SAFETY: By the type invariant of `Device`, `phydev` points to a valid
154 // `struct phy_device`, and there is no concurrent write to this field.
155 let completed = unsafe { bindings::phy_device::autoneg_complete_raw(phydev) };
156 completed == 1
157 }
158
159 /// Sets the speed of the PHY.
set_speed(&mut self, speed: u32)160 pub fn set_speed(&mut self, speed: u32) {
161 let phydev = self.0.get();
162 // SAFETY: The struct invariant ensures that we may access
163 // this field without additional synchronization.
164 unsafe { (*phydev).speed = speed as c_int };
165 }
166
167 /// Sets duplex mode.
set_duplex(&mut self, mode: DuplexMode)168 pub fn set_duplex(&mut self, mode: DuplexMode) {
169 let phydev = self.0.get();
170 let v = match mode {
171 DuplexMode::Full => bindings::DUPLEX_FULL,
172 DuplexMode::Half => bindings::DUPLEX_HALF,
173 DuplexMode::Unknown => bindings::DUPLEX_UNKNOWN,
174 };
175 // SAFETY: The struct invariant ensures that we may access
176 // this field without additional synchronization.
177 unsafe { (*phydev).duplex = v as c_int };
178 }
179
180 /// Reads a PHY register.
181 // This function reads a hardware register and updates the stats so takes `&mut self`.
read<R: reg::Register>(&mut self, reg: R) -> Result<u16>182 pub fn read<R: reg::Register>(&mut self, reg: R) -> Result<u16> {
183 reg.read(self)
184 }
185
186 /// Writes a PHY register.
write<R: reg::Register>(&mut self, reg: R, val: u16) -> Result187 pub fn write<R: reg::Register>(&mut self, reg: R, val: u16) -> Result {
188 reg.write(self, val)
189 }
190
191 /// Reads a paged register.
read_paged(&mut self, page: u16, regnum: u16) -> Result<u16>192 pub fn read_paged(&mut self, page: u16, regnum: u16) -> Result<u16> {
193 let phydev = self.0.get();
194 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
195 // So it's just an FFI call.
196 let ret = unsafe { bindings::phy_read_paged(phydev, page.into(), regnum.into()) };
197
198 to_result(ret).map(|()| ret as u16)
199 }
200
201 /// Resolves the advertisements into PHY settings.
resolve_aneg_linkmode(&mut self)202 pub fn resolve_aneg_linkmode(&mut self) {
203 let phydev = self.0.get();
204 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
205 // So it's just an FFI call.
206 unsafe { bindings::phy_resolve_aneg_linkmode(phydev) };
207 }
208
209 /// Executes software reset the PHY via `BMCR_RESET` bit.
genphy_soft_reset(&mut self) -> Result210 pub fn genphy_soft_reset(&mut self) -> Result {
211 let phydev = self.0.get();
212 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
213 // So it's just an FFI call.
214 to_result(unsafe { bindings::genphy_soft_reset(phydev) })
215 }
216
217 /// Initializes the PHY.
init_hw(&mut self) -> Result218 pub fn init_hw(&mut self) -> Result {
219 let phydev = self.0.get();
220 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
221 // So it's just an FFI call.
222 to_result(unsafe { bindings::phy_init_hw(phydev) })
223 }
224
225 /// Starts auto-negotiation.
start_aneg(&mut self) -> Result226 pub fn start_aneg(&mut self) -> Result {
227 let phydev = self.0.get();
228 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
229 // So it's just an FFI call.
230 to_result(unsafe { bindings::_phy_start_aneg(phydev) })
231 }
232
233 /// Resumes the PHY via `BMCR_PDOWN` bit.
genphy_resume(&mut self) -> Result234 pub fn genphy_resume(&mut self) -> Result {
235 let phydev = self.0.get();
236 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
237 // So it's just an FFI call.
238 to_result(unsafe { bindings::genphy_resume(phydev) })
239 }
240
241 /// Suspends the PHY via `BMCR_PDOWN` bit.
genphy_suspend(&mut self) -> Result242 pub fn genphy_suspend(&mut self) -> Result {
243 let phydev = self.0.get();
244 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
245 // So it's just an FFI call.
246 to_result(unsafe { bindings::genphy_suspend(phydev) })
247 }
248
249 /// Checks the link status and updates current link state.
genphy_read_status<R: reg::Register>(&mut self) -> Result<u16>250 pub fn genphy_read_status<R: reg::Register>(&mut self) -> Result<u16> {
251 R::read_status(self)
252 }
253
254 /// Updates the link status.
genphy_update_link(&mut self) -> Result255 pub fn genphy_update_link(&mut self) -> Result {
256 let phydev = self.0.get();
257 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
258 // So it's just an FFI call.
259 to_result(unsafe { bindings::genphy_update_link(phydev) })
260 }
261
262 /// Reads link partner ability.
genphy_read_lpa(&mut self) -> Result263 pub fn genphy_read_lpa(&mut self) -> Result {
264 let phydev = self.0.get();
265 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
266 // So it's just an FFI call.
267 to_result(unsafe { bindings::genphy_read_lpa(phydev) })
268 }
269
270 /// Reads PHY abilities.
genphy_read_abilities(&mut self) -> Result271 pub fn genphy_read_abilities(&mut self) -> Result {
272 let phydev = self.0.get();
273 // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
274 // So it's just an FFI call.
275 to_result(unsafe { bindings::genphy_read_abilities(phydev) })
276 }
277 }
278
279 impl AsRef<kernel::device::Device> for Device {
as_ref(&self) -> &kernel::device::Device280 fn as_ref(&self) -> &kernel::device::Device {
281 let phydev = self.0.get();
282 // SAFETY: The struct invariant ensures that `mdio.dev` is valid.
283 unsafe { kernel::device::Device::from_raw(addr_of_mut!((*phydev).mdio.dev)) }
284 }
285 }
286
287 /// Defines certain other features this PHY supports (like interrupts).
288 ///
289 /// These flag values are used in [`Driver::FLAGS`].
290 pub mod flags {
291 /// PHY is internal.
292 pub const IS_INTERNAL: u32 = bindings::PHY_IS_INTERNAL;
293 /// PHY needs to be reset after the refclk is enabled.
294 pub const RST_AFTER_CLK_EN: u32 = bindings::PHY_RST_AFTER_CLK_EN;
295 /// Polling is used to detect PHY status changes.
296 pub const POLL_CABLE_TEST: u32 = bindings::PHY_POLL_CABLE_TEST;
297 /// Don't suspend.
298 pub const ALWAYS_CALL_SUSPEND: u32 = bindings::PHY_ALWAYS_CALL_SUSPEND;
299 }
300
301 /// An adapter for the registration of a PHY driver.
302 struct Adapter<T: Driver> {
303 _p: PhantomData<T>,
304 }
305
306 impl<T: Driver> Adapter<T> {
307 /// # Safety
308 ///
309 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
soft_reset_callback(phydev: *mut bindings::phy_device) -> c_int310 unsafe extern "C" fn soft_reset_callback(phydev: *mut bindings::phy_device) -> c_int {
311 from_result(|| {
312 // SAFETY: This callback is called only in contexts
313 // where we hold `phy_device->lock`, so the accessors on
314 // `Device` are okay to call.
315 let dev = unsafe { Device::from_raw(phydev) };
316 T::soft_reset(dev)?;
317 Ok(0)
318 })
319 }
320
321 /// # Safety
322 ///
323 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
probe_callback(phydev: *mut bindings::phy_device) -> c_int324 unsafe extern "C" fn probe_callback(phydev: *mut bindings::phy_device) -> c_int {
325 from_result(|| {
326 // SAFETY: This callback is called only in contexts
327 // where we can exclusively access `phy_device` because
328 // it's not published yet, so the accessors on `Device` are okay
329 // to call.
330 let dev = unsafe { Device::from_raw(phydev) };
331 T::probe(dev)?;
332 Ok(0)
333 })
334 }
335
336 /// # Safety
337 ///
338 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
get_features_callback(phydev: *mut bindings::phy_device) -> c_int339 unsafe extern "C" fn get_features_callback(phydev: *mut bindings::phy_device) -> c_int {
340 from_result(|| {
341 // SAFETY: This callback is called only in contexts
342 // where we hold `phy_device->lock`, so the accessors on
343 // `Device` are okay to call.
344 let dev = unsafe { Device::from_raw(phydev) };
345 T::get_features(dev)?;
346 Ok(0)
347 })
348 }
349
350 /// # Safety
351 ///
352 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
suspend_callback(phydev: *mut bindings::phy_device) -> c_int353 unsafe extern "C" fn suspend_callback(phydev: *mut bindings::phy_device) -> c_int {
354 from_result(|| {
355 // SAFETY: The C core code ensures that the accessors on
356 // `Device` are okay to call even though `phy_device->lock`
357 // might not be held.
358 let dev = unsafe { Device::from_raw(phydev) };
359 T::suspend(dev)?;
360 Ok(0)
361 })
362 }
363
364 /// # Safety
365 ///
366 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
resume_callback(phydev: *mut bindings::phy_device) -> c_int367 unsafe extern "C" fn resume_callback(phydev: *mut bindings::phy_device) -> c_int {
368 from_result(|| {
369 // SAFETY: The C core code ensures that the accessors on
370 // `Device` are okay to call even though `phy_device->lock`
371 // might not be held.
372 let dev = unsafe { Device::from_raw(phydev) };
373 T::resume(dev)?;
374 Ok(0)
375 })
376 }
377
378 /// # Safety
379 ///
380 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
config_aneg_callback(phydev: *mut bindings::phy_device) -> c_int381 unsafe extern "C" fn config_aneg_callback(phydev: *mut bindings::phy_device) -> c_int {
382 from_result(|| {
383 // SAFETY: This callback is called only in contexts
384 // where we hold `phy_device->lock`, so the accessors on
385 // `Device` are okay to call.
386 let dev = unsafe { Device::from_raw(phydev) };
387 T::config_aneg(dev)?;
388 Ok(0)
389 })
390 }
391
392 /// # Safety
393 ///
394 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
read_status_callback(phydev: *mut bindings::phy_device) -> c_int395 unsafe extern "C" fn read_status_callback(phydev: *mut bindings::phy_device) -> c_int {
396 from_result(|| {
397 // SAFETY: This callback is called only in contexts
398 // where we hold `phy_device->lock`, so the accessors on
399 // `Device` are okay to call.
400 let dev = unsafe { Device::from_raw(phydev) };
401 T::read_status(dev)?;
402 Ok(0)
403 })
404 }
405
406 /// # Safety
407 ///
408 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
match_phy_device_callback( phydev: *mut bindings::phy_device, _phydrv: *const bindings::phy_driver, ) -> c_int409 unsafe extern "C" fn match_phy_device_callback(
410 phydev: *mut bindings::phy_device,
411 _phydrv: *const bindings::phy_driver,
412 ) -> c_int {
413 // SAFETY: This callback is called only in contexts
414 // where we hold `phy_device->lock`, so the accessors on
415 // `Device` are okay to call.
416 let dev = unsafe { Device::from_raw(phydev) };
417 T::match_phy_device(dev).into()
418 }
419
420 /// # Safety
421 ///
422 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
read_mmd_callback( phydev: *mut bindings::phy_device, devnum: i32, regnum: u16, ) -> i32423 unsafe extern "C" fn read_mmd_callback(
424 phydev: *mut bindings::phy_device,
425 devnum: i32,
426 regnum: u16,
427 ) -> i32 {
428 from_result(|| {
429 // SAFETY: This callback is called only in contexts
430 // where we hold `phy_device->lock`, so the accessors on
431 // `Device` are okay to call.
432 let dev = unsafe { Device::from_raw(phydev) };
433 // CAST: the C side verifies devnum < 32.
434 let ret = T::read_mmd(dev, devnum as u8, regnum)?;
435 Ok(ret.into())
436 })
437 }
438
439 /// # Safety
440 ///
441 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
write_mmd_callback( phydev: *mut bindings::phy_device, devnum: i32, regnum: u16, val: u16, ) -> i32442 unsafe extern "C" fn write_mmd_callback(
443 phydev: *mut bindings::phy_device,
444 devnum: i32,
445 regnum: u16,
446 val: u16,
447 ) -> i32 {
448 from_result(|| {
449 // SAFETY: This callback is called only in contexts
450 // where we hold `phy_device->lock`, so the accessors on
451 // `Device` are okay to call.
452 let dev = unsafe { Device::from_raw(phydev) };
453 T::write_mmd(dev, devnum as u8, regnum, val)?;
454 Ok(0)
455 })
456 }
457
458 /// # Safety
459 ///
460 /// `phydev` must be passed by the corresponding callback in `phy_driver`.
link_change_notify_callback(phydev: *mut bindings::phy_device)461 unsafe extern "C" fn link_change_notify_callback(phydev: *mut bindings::phy_device) {
462 // SAFETY: This callback is called only in contexts
463 // where we hold `phy_device->lock`, so the accessors on
464 // `Device` are okay to call.
465 let dev = unsafe { Device::from_raw(phydev) };
466 T::link_change_notify(dev);
467 }
468 }
469
470 /// Driver structure for a particular PHY type.
471 ///
472 /// Wraps the kernel's [`struct phy_driver`].
473 /// This is used to register a driver for a particular PHY type with the kernel.
474 ///
475 /// # Invariants
476 ///
477 /// `self.0` is always in a valid state.
478 ///
479 /// [`struct phy_driver`]: srctree/include/linux/phy.h
480 #[repr(transparent)]
481 pub struct DriverVTable(Opaque<bindings::phy_driver>);
482
483 // SAFETY: `DriverVTable` doesn't expose any &self method to access internal data, so it's safe to
484 // share `&DriverVTable` across execution context boundaries.
485 unsafe impl Sync for DriverVTable {}
486
487 /// Creates a [`DriverVTable`] instance from [`Driver`].
488 ///
489 /// This is used by [`module_phy_driver`] macro to create a static array of `phy_driver`.
490 ///
491 /// [`module_phy_driver`]: crate::module_phy_driver
create_phy_driver<T: Driver>() -> DriverVTable492 pub const fn create_phy_driver<T: Driver>() -> DriverVTable {
493 // INVARIANT: All the fields of `struct phy_driver` are initialized properly.
494 DriverVTable(Opaque::new(bindings::phy_driver {
495 name: crate::str::as_char_ptr_in_const_context(T::NAME).cast_mut(),
496 flags: T::FLAGS,
497 phy_id: T::PHY_DEVICE_ID.id(),
498 phy_id_mask: T::PHY_DEVICE_ID.mask_as_int(),
499 soft_reset: if T::HAS_SOFT_RESET {
500 Some(Adapter::<T>::soft_reset_callback)
501 } else {
502 None
503 },
504 probe: if T::HAS_PROBE {
505 Some(Adapter::<T>::probe_callback)
506 } else {
507 None
508 },
509 get_features: if T::HAS_GET_FEATURES {
510 Some(Adapter::<T>::get_features_callback)
511 } else {
512 None
513 },
514 match_phy_device: if T::HAS_MATCH_PHY_DEVICE {
515 Some(Adapter::<T>::match_phy_device_callback)
516 } else {
517 None
518 },
519 suspend: if T::HAS_SUSPEND {
520 Some(Adapter::<T>::suspend_callback)
521 } else {
522 None
523 },
524 resume: if T::HAS_RESUME {
525 Some(Adapter::<T>::resume_callback)
526 } else {
527 None
528 },
529 config_aneg: if T::HAS_CONFIG_ANEG {
530 Some(Adapter::<T>::config_aneg_callback)
531 } else {
532 None
533 },
534 read_status: if T::HAS_READ_STATUS {
535 Some(Adapter::<T>::read_status_callback)
536 } else {
537 None
538 },
539 read_mmd: if T::HAS_READ_MMD {
540 Some(Adapter::<T>::read_mmd_callback)
541 } else {
542 None
543 },
544 write_mmd: if T::HAS_WRITE_MMD {
545 Some(Adapter::<T>::write_mmd_callback)
546 } else {
547 None
548 },
549 link_change_notify: if T::HAS_LINK_CHANGE_NOTIFY {
550 Some(Adapter::<T>::link_change_notify_callback)
551 } else {
552 None
553 },
554 // SAFETY: The rest is zeroed out to initialize `struct phy_driver`,
555 // sets `Option<&F>` to be `None`.
556 ..unsafe { core::mem::MaybeUninit::<bindings::phy_driver>::zeroed().assume_init() }
557 }))
558 }
559
560 /// Driver implementation for a particular PHY type.
561 ///
562 /// This trait is used to create a [`DriverVTable`].
563 #[vtable]
564 pub trait Driver {
565 /// Defines certain other features this PHY supports.
566 /// It is a combination of the flags in the [`flags`] module.
567 const FLAGS: u32 = 0;
568
569 /// The friendly name of this PHY type.
570 const NAME: &'static CStr;
571
572 /// This driver only works for PHYs with IDs which match this field.
573 /// The default id and mask are zero.
574 const PHY_DEVICE_ID: DeviceId = DeviceId::new_with_custom_mask(0, 0);
575
576 /// Issues a PHY software reset.
soft_reset(_dev: &mut Device) -> Result577 fn soft_reset(_dev: &mut Device) -> Result {
578 build_error!(VTABLE_DEFAULT_ERROR)
579 }
580
581 /// Sets up device-specific structures during discovery.
probe(_dev: &mut Device) -> Result582 fn probe(_dev: &mut Device) -> Result {
583 build_error!(VTABLE_DEFAULT_ERROR)
584 }
585
586 /// Probes the hardware to determine what abilities it has.
get_features(_dev: &mut Device) -> Result587 fn get_features(_dev: &mut Device) -> Result {
588 build_error!(VTABLE_DEFAULT_ERROR)
589 }
590
591 /// Returns true if this is a suitable driver for the given phydev.
592 /// If not implemented, matching is based on [`Driver::PHY_DEVICE_ID`].
match_phy_device(_dev: &Device) -> bool593 fn match_phy_device(_dev: &Device) -> bool {
594 false
595 }
596
597 /// Configures the advertisement and resets auto-negotiation
598 /// if auto-negotiation is enabled.
config_aneg(_dev: &mut Device) -> Result599 fn config_aneg(_dev: &mut Device) -> Result {
600 build_error!(VTABLE_DEFAULT_ERROR)
601 }
602
603 /// Determines the negotiated speed and duplex.
read_status(_dev: &mut Device) -> Result<u16>604 fn read_status(_dev: &mut Device) -> Result<u16> {
605 build_error!(VTABLE_DEFAULT_ERROR)
606 }
607
608 /// Suspends the hardware, saving state if needed.
suspend(_dev: &mut Device) -> Result609 fn suspend(_dev: &mut Device) -> Result {
610 build_error!(VTABLE_DEFAULT_ERROR)
611 }
612
613 /// Resumes the hardware, restoring state if needed.
resume(_dev: &mut Device) -> Result614 fn resume(_dev: &mut Device) -> Result {
615 build_error!(VTABLE_DEFAULT_ERROR)
616 }
617
618 /// Overrides the default MMD read function for reading a MMD register.
read_mmd(_dev: &mut Device, _devnum: u8, _regnum: u16) -> Result<u16>619 fn read_mmd(_dev: &mut Device, _devnum: u8, _regnum: u16) -> Result<u16> {
620 build_error!(VTABLE_DEFAULT_ERROR)
621 }
622
623 /// Overrides the default MMD write function for writing a MMD register.
write_mmd(_dev: &mut Device, _devnum: u8, _regnum: u16, _val: u16) -> Result624 fn write_mmd(_dev: &mut Device, _devnum: u8, _regnum: u16, _val: u16) -> Result {
625 build_error!(VTABLE_DEFAULT_ERROR)
626 }
627
628 /// Callback for notification of link change.
link_change_notify(_dev: &mut Device)629 fn link_change_notify(_dev: &mut Device) {}
630 }
631
632 /// Registration structure for PHY drivers.
633 ///
634 /// Registers [`DriverVTable`] instances with the kernel. They will be unregistered when dropped.
635 ///
636 /// # Invariants
637 ///
638 /// The `drivers` slice are currently registered to the kernel via `phy_drivers_register`.
639 pub struct Registration {
640 drivers: Pin<&'static mut [DriverVTable]>,
641 }
642
643 // SAFETY: The only action allowed in a `Registration` instance is dropping it, which is safe to do
644 // from any thread because `phy_drivers_unregister` can be called from any thread context.
645 unsafe impl Send for Registration {}
646
647 impl Registration {
648 /// Registers a PHY driver.
register( module: &'static crate::ThisModule, drivers: Pin<&'static mut [DriverVTable]>, ) -> Result<Self>649 pub fn register(
650 module: &'static crate::ThisModule,
651 drivers: Pin<&'static mut [DriverVTable]>,
652 ) -> Result<Self> {
653 if drivers.is_empty() {
654 return Err(code::EINVAL);
655 }
656 // SAFETY: The type invariants of [`DriverVTable`] ensure that all elements of
657 // the `drivers` slice are initialized properly. `drivers` will not be moved.
658 // So it's just an FFI call.
659 to_result(unsafe {
660 bindings::phy_drivers_register(
661 drivers[0].0.get(),
662 drivers.len().try_into()?,
663 module.as_ptr(),
664 )
665 })?;
666 // INVARIANT: The `drivers` slice is successfully registered to the kernel via `phy_drivers_register`.
667 Ok(Registration { drivers })
668 }
669 }
670
671 impl Drop for Registration {
drop(&mut self)672 fn drop(&mut self) {
673 // SAFETY: The type invariants guarantee that `self.drivers` is valid.
674 // So it's just an FFI call.
675 unsafe {
676 bindings::phy_drivers_unregister(self.drivers[0].0.get(), self.drivers.len() as i32)
677 };
678 }
679 }
680
681 /// An identifier for PHY devices on an MDIO/MII bus.
682 ///
683 /// Represents the kernel's `struct mdio_device_id`. This is used to find an appropriate
684 /// PHY driver.
685 #[repr(transparent)]
686 #[derive(Clone, Copy)]
687 pub struct DeviceId(bindings::mdio_device_id);
688
689 impl DeviceId {
690 /// Creates a new instance with the exact match mask.
new_with_exact_mask(id: u32) -> Self691 pub const fn new_with_exact_mask(id: u32) -> Self {
692 Self(bindings::mdio_device_id {
693 phy_id: id,
694 phy_id_mask: DeviceMask::Exact.as_int(),
695 })
696 }
697
698 /// Creates a new instance with the model match mask.
new_with_model_mask(id: u32) -> Self699 pub const fn new_with_model_mask(id: u32) -> Self {
700 Self(bindings::mdio_device_id {
701 phy_id: id,
702 phy_id_mask: DeviceMask::Model.as_int(),
703 })
704 }
705
706 /// Creates a new instance with the vendor match mask.
new_with_vendor_mask(id: u32) -> Self707 pub const fn new_with_vendor_mask(id: u32) -> Self {
708 Self(bindings::mdio_device_id {
709 phy_id: id,
710 phy_id_mask: DeviceMask::Vendor.as_int(),
711 })
712 }
713
714 /// Creates a new instance with a custom match mask.
new_with_custom_mask(id: u32, mask: u32) -> Self715 pub const fn new_with_custom_mask(id: u32, mask: u32) -> Self {
716 Self(bindings::mdio_device_id {
717 phy_id: id,
718 phy_id_mask: DeviceMask::Custom(mask).as_int(),
719 })
720 }
721
722 /// Creates a new instance from [`Driver`].
new_with_driver<T: Driver>() -> Self723 pub const fn new_with_driver<T: Driver>() -> Self {
724 T::PHY_DEVICE_ID
725 }
726
727 /// Get the MDIO device's PHY ID.
id(&self) -> u32728 pub const fn id(&self) -> u32 {
729 self.0.phy_id
730 }
731
732 /// Get the MDIO device's match mask.
mask_as_int(&self) -> u32733 pub const fn mask_as_int(&self) -> u32 {
734 self.0.phy_id_mask
735 }
736
737 // macro use only
738 #[doc(hidden)]
mdio_device_id(&self) -> bindings::mdio_device_id739 pub const fn mdio_device_id(&self) -> bindings::mdio_device_id {
740 self.0
741 }
742 }
743
744 // SAFETY: `DeviceId` is a `#[repr(transparent)]` wrapper of `struct mdio_device_id`
745 // and does not add additional invariants, so it's safe to transmute to `RawType`.
746 unsafe impl RawDeviceId for DeviceId {
747 type RawType = bindings::mdio_device_id;
748 }
749
750 enum DeviceMask {
751 Exact,
752 Model,
753 Vendor,
754 Custom(u32),
755 }
756
757 impl DeviceMask {
758 const MASK_EXACT: u32 = !0;
759 const MASK_MODEL: u32 = !0 << 4;
760 const MASK_VENDOR: u32 = !0 << 10;
761
as_int(&self) -> u32762 const fn as_int(&self) -> u32 {
763 match self {
764 DeviceMask::Exact => Self::MASK_EXACT,
765 DeviceMask::Model => Self::MASK_MODEL,
766 DeviceMask::Vendor => Self::MASK_VENDOR,
767 DeviceMask::Custom(mask) => *mask,
768 }
769 }
770 }
771
772 /// Declares a kernel module for PHYs drivers.
773 ///
774 /// This creates a static array of kernel's `struct phy_driver` and registers it.
775 /// This also corresponds to the kernel's `MODULE_DEVICE_TABLE` macro, which embeds the information
776 /// for module loading into the module binary file. Every driver needs an entry in `device_table`.
777 ///
778 /// # Examples
779 ///
780 /// ```
781 /// # mod module_phy_driver_sample {
782 /// use kernel::net::phy::{self, DeviceId};
783 /// use kernel::prelude::*;
784 ///
785 /// kernel::module_phy_driver! {
786 /// drivers: [PhySample],
787 /// device_table: [
788 /// DeviceId::new_with_driver::<PhySample>()
789 /// ],
790 /// name: "rust_sample_phy",
791 /// authors: ["Rust for Linux Contributors"],
792 /// description: "Rust sample PHYs driver",
793 /// license: "GPL",
794 /// }
795 ///
796 /// struct PhySample;
797 ///
798 /// #[vtable]
799 /// impl phy::Driver for PhySample {
800 /// const NAME: &'static CStr = c"PhySample";
801 /// const PHY_DEVICE_ID: phy::DeviceId = phy::DeviceId::new_with_exact_mask(0x00000001);
802 /// }
803 /// # }
804 /// ```
805 #[macro_export]
806 macro_rules! module_phy_driver {
807 (@replace_expr $_t:tt $sub:expr) => {$sub};
808
809 (@count_devices $($x:expr),*) => {
810 0usize $(+ $crate::module_phy_driver!(@replace_expr $x 1usize))*
811 };
812
813 (@device_table [$($dev:expr),+]) => {
814 $crate::module_device_table!(
815 "mdio", $crate::net::phy::DeviceId,
816 TABLE, @none, [$($dev),+]
817 );
818 };
819
820 (drivers: [$($driver:ident),+ $(,)?], device_table: [$($dev:expr),+ $(,)?], $($f:tt)*) => {
821 struct Module {
822 _reg: $crate::net::phy::Registration,
823 }
824
825 $crate::prelude::module! {
826 type: Module,
827 $($f)*
828 }
829
830 const _: () = {
831 static mut DRIVERS: [$crate::net::phy::DriverVTable;
832 $crate::module_phy_driver!(@count_devices $($driver),+)] =
833 [$($crate::net::phy::create_phy_driver::<$driver>()),+];
834
835 impl $crate::Module for Module {
836 fn init(module: &'static $crate::ThisModule) -> Result<Self> {
837 // SAFETY: The anonymous constant guarantees that nobody else can access
838 // the `DRIVERS` static. The array is used only in the C side.
839 let drivers = unsafe { &mut DRIVERS };
840 let mut reg = $crate::net::phy::Registration::register(
841 module,
842 ::core::pin::Pin::static_mut(drivers),
843 )?;
844 Ok(Module { _reg: reg })
845 }
846 }
847 };
848
849 $crate::module_phy_driver!(@device_table [$($dev),+]);
850 }
851 }
852