[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20240415104701.4772-3-fujita.tomonori@gmail.com>
Date: Mon, 15 Apr 2024 19:46:59 +0900
From: FUJITA Tomonori <fujita.tomonori@...il.com>
To: netdev@...r.kernel.org
Cc: andrew@...n.ch,
rust-for-linux@...r.kernel.org,
tmgross@...ch.edu
Subject: [PATCH net-next v1 2/4] rust: net::phy support C45 helpers
This patch adds the following helper functions for Clause 45:
- mdiobus_c45_read
- mdiobus_c45_write
- genphy_c45_read_status
Signed-off-by: FUJITA Tomonori <fujita.tomonori@...il.com>
---
rust/kernel/net/phy.rs | 50 ++++++++++++++++++++++++++++++++++++++++++
1 file changed, 50 insertions(+)
diff --git a/rust/kernel/net/phy.rs b/rust/kernel/net/phy.rs
index 44b59bbf1a52..421a231421f5 100644
--- a/rust/kernel/net/phy.rs
+++ b/rust/kernel/net/phy.rs
@@ -203,6 +203,43 @@ pub fn write(&mut self, regnum: u16, val: u16) -> Result {
})
}
+ /// Reads a given C45 PHY register.
+ /// This function reads a hardware register and updates the stats so takes `&mut self`.
+ pub fn c45_read(&mut self, devad: u8, regnum: u16) -> Result<u16> {
+ let phydev = self.0.get();
+ // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
+ // So it's just an FFI call.
+ let ret = unsafe {
+ bindings::mdiobus_c45_read(
+ (*phydev).mdio.bus,
+ (*phydev).mdio.addr,
+ devad as i32,
+ regnum.into(),
+ )
+ };
+ if ret < 0 {
+ Err(Error::from_errno(ret))
+ } else {
+ Ok(ret as u16)
+ }
+ }
+
+ /// Writes a given C45 PHY register.
+ pub fn c45_write(&mut self, devad: u8, regnum: u16, val: u16) -> Result {
+ let phydev = self.0.get();
+ // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
+ // So it's just an FFI call.
+ to_result(unsafe {
+ bindings::mdiobus_c45_write(
+ (*phydev).mdio.bus,
+ (*phydev).mdio.addr,
+ devad as i32,
+ regnum.into(),
+ val,
+ )
+ })
+ }
+
/// Reads a paged register.
pub fn read_paged(&mut self, page: u16, regnum: u16) -> Result<u16> {
let phydev = self.0.get();
@@ -277,6 +314,19 @@ pub fn genphy_read_status(&mut self) -> Result<u16> {
}
}
+ /// Checks the link status and updates current link state via C45 registers.
+ pub fn genphy_c45_read_status(&mut self) -> Result<u16> {
+ let phydev = self.0.get();
+ // SAFETY: `phydev` is pointing to a valid object by the type invariant of `Self`.
+ // So it's just an FFI call.
+ let ret = unsafe { bindings::genphy_c45_read_status(phydev) };
+ if ret < 0 {
+ Err(Error::from_errno(ret))
+ } else {
+ Ok(ret as u16)
+ }
+ }
+
/// Updates the link status.
pub fn genphy_update_link(&mut self) -> Result {
let phydev = self.0.get();
--
2.34.1
Powered by blists - more mailing lists