mirror of
https://github.com/coolsnowwolf/lede.git
synced 2025-04-16 14:23:38 +00:00
rockchip: add yt8531c driver from net-next
This commit is contained in:
AmadeusGhost
parent
b98efa18fd
commit
2a911a7e00
@ -0,0 +1,141 @@
|
||||
From cfb1aa4c805e58287dd0ce292b5c64309e3dba2f Mon Sep 17 00:00:00 2001
|
||||
From: Furkan Kardame <f.kardame@manjaro.org>
|
||||
Date: Sun, 9 Oct 2022 22:24:05 +0300
|
||||
Subject: [PATCH] net: phy: add support for Motorcomm yt8531C phy
|
||||
|
||||
This patch adds support for Motorcomm YT8531C which is
|
||||
used in OrangePi 3 LTS, OrangePi 4 LTS and OrangePi 800
|
||||
Currently being used by Manjaro Arm kernel
|
||||
|
||||
Signed-off-by: Peter Geis <pgwipeout@gmail.com>
|
||||
Signed-off-by: Furkan Kardame <f.kardame@manjaro.org>
|
||||
---
|
||||
drivers/net/phy/motorcomm.c | 90 +++++++++++++++++++++++++++++++++++++
|
||||
1 file changed, 90 insertions(+)
|
||||
|
||||
--- a/drivers/net/phy/motorcomm.c
|
||||
+++ b/drivers/net/phy/motorcomm.c
|
||||
@@ -10,6 +10,7 @@
|
||||
#include <linux/phy.h>
|
||||
|
||||
#define PHY_ID_YT8511 0x0000010a
|
||||
+#define PHY_ID_YT8531 0x4f51e91b
|
||||
|
||||
#define YT8511_PAGE_SELECT 0x1e
|
||||
#define YT8511_PAGE 0x1f
|
||||
@@ -38,6 +39,38 @@
|
||||
#define YT8511_DELAY_FE_TX_EN (0xf << 12)
|
||||
#define YT8511_DELAY_FE_TX_DIS (0x2 << 12)
|
||||
|
||||
+#define YT8531_RGMII_CONFIG1 0xa003
|
||||
+
|
||||
+/* TX Gig-E Delay is bits 3:0, default 0x1
|
||||
+ * TX Fast-E Delay is bits 7:4, default 0xf
|
||||
+ * RX Delay is bits 13:10, default 0x0
|
||||
+ * Delay = 150ps * N
|
||||
+ * On = 2000ps, off = 50ps
|
||||
+ */
|
||||
+#define YT8531_DELAY_GE_TX_EN (0xd << 0)
|
||||
+#define YT8531_DELAY_GE_TX_DIS (0x0 << 0)
|
||||
+#define YT8531_DELAY_FE_TX_EN (0xd << 4)
|
||||
+#define YT8531_DELAY_FE_TX_DIS (0x0 << 4)
|
||||
+#define YT8531_DELAY_RX_EN (0xd << 10)
|
||||
+#define YT8531_DELAY_RX_DIS (0x0 << 10)
|
||||
+#define YT8531_DELAY_MASK (GENMASK(13, 10) | GENMASK(7, 0))
|
||||
+
|
||||
+#define YT8531_SYNCE_CFG 0xa012
|
||||
+
|
||||
+/* Clk src config is bits 3:1
|
||||
+ * 3b000 src from pll
|
||||
+ * 3b001 src from rx_clk
|
||||
+ * 3b010 src from serdes
|
||||
+ * 3b011 src from ptp_in
|
||||
+ * 3b100 src from 25mhz refclk *default*
|
||||
+ * 3b101 src from 25mhz ssc
|
||||
+ * Clk rate select is bit 4
|
||||
+ * 1b0 25mhz clk output *default*
|
||||
+ * 1b1 125mhz clk output
|
||||
+ * Clkout enable is bit 6
|
||||
+ */
|
||||
+#define YT8531_CLKCFG_125M (BIT(6) | BIT(4) | (0x0 < 1))
|
||||
+
|
||||
static int yt8511_read_page(struct phy_device *phydev)
|
||||
{
|
||||
return __phy_read(phydev, YT8511_PAGE_SELECT);
|
||||
@@ -111,6 +145,51 @@ static int yt8511_config_init(struct phy_device *phydev)
|
||||
return phy_restore_page(phydev, oldpage, ret);
|
||||
}
|
||||
|
||||
+static int yt8531_config_init(struct phy_device *phydev)
|
||||
+{
|
||||
+ int oldpage, ret = 0;
|
||||
+ unsigned int val;
|
||||
+
|
||||
+ oldpage = phy_select_page(phydev, YT8531_RGMII_CONFIG1);
|
||||
+ if (oldpage < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+ /* set rgmii delay mode */
|
||||
+ switch (phydev->interface) {
|
||||
+ case PHY_INTERFACE_MODE_RGMII:
|
||||
+ val = YT8531_DELAY_RX_DIS | YT8531_DELAY_GE_TX_DIS | YT8531_DELAY_FE_TX_DIS;
|
||||
+ break;
|
||||
+ case PHY_INTERFACE_MODE_RGMII_RXID:
|
||||
+ val = YT8531_DELAY_RX_EN | YT8531_DELAY_GE_TX_DIS | YT8531_DELAY_FE_TX_DIS;
|
||||
+ break;
|
||||
+ case PHY_INTERFACE_MODE_RGMII_TXID:
|
||||
+ val = YT8531_DELAY_RX_DIS | YT8531_DELAY_GE_TX_EN | YT8531_DELAY_FE_TX_EN;
|
||||
+ break;
|
||||
+ case PHY_INTERFACE_MODE_RGMII_ID:
|
||||
+ val = YT8531_DELAY_RX_EN | YT8531_DELAY_GE_TX_EN | YT8531_DELAY_FE_TX_EN;
|
||||
+ break;
|
||||
+ default: /* do not support other modes */
|
||||
+ ret = -EOPNOTSUPP;
|
||||
+ goto err_restore_page;
|
||||
+ }
|
||||
+
|
||||
+ ret = __phy_modify(phydev, YT8511_PAGE, YT8531_DELAY_MASK, val);
|
||||
+ if (ret < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+ /* set clock mode to 125mhz */
|
||||
+ ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8531_SYNCE_CFG);
|
||||
+ if (ret < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+ ret = __phy_write(phydev, YT8511_PAGE, YT8531_CLKCFG_125M);
|
||||
+ if (ret < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+err_restore_page:
|
||||
+ return phy_restore_page(phydev, oldpage, ret);
|
||||
+}
|
||||
+
|
||||
static struct phy_driver motorcomm_phy_drvs[] = {
|
||||
{
|
||||
PHY_ID_MATCH_EXACT(PHY_ID_YT8511),
|
||||
@@ -120,7 +200,16 @@ static struct phy_driver motorcomm_phy_drvs[] = {
|
||||
.resume = genphy_resume,
|
||||
.read_page = yt8511_read_page,
|
||||
.write_page = yt8511_write_page,
|
||||
+ }, {
|
||||
+ PHY_ID_MATCH_EXACT(PHY_ID_YT8531),
|
||||
+ .name = "YT8531 Gigabit Ethernet",
|
||||
+ .config_init = yt8531_config_init,
|
||||
+ .suspend = genphy_suspend,
|
||||
+ .resume = genphy_resume,
|
||||
+ .read_page = yt8511_read_page,
|
||||
+ .write_page = yt8511_write_page,
|
||||
},
|
||||
+
|
||||
};
|
||||
|
||||
module_phy_driver(motorcomm_phy_drvs);
|
||||
@@ -131,6 +220,7 @@ MODULE_LICENSE("GPL");
|
||||
|
||||
static const struct mdio_device_id __maybe_unused motorcomm_tbl[] = {
|
||||
{ PHY_ID_MATCH_EXACT(PHY_ID_YT8511) },
|
||||
+ { PHY_ID_MATCH_EXACT(PHY_ID_YT8531) },
|
||||
{ /* sentinal */ }
|
||||
};
|
||||
|
||||
@ -0,0 +1,141 @@
|
||||
From cfb1aa4c805e58287dd0ce292b5c64309e3dba2f Mon Sep 17 00:00:00 2001
|
||||
From: Furkan Kardame <f.kardame@manjaro.org>
|
||||
Date: Sun, 9 Oct 2022 22:24:05 +0300
|
||||
Subject: [PATCH] net: phy: add support for Motorcomm yt8531C phy
|
||||
|
||||
This patch adds support for Motorcomm YT8531C which is
|
||||
used in OrangePi 3 LTS, OrangePi 4 LTS and OrangePi 800
|
||||
Currently being used by Manjaro Arm kernel
|
||||
|
||||
Signed-off-by: Peter Geis <pgwipeout@gmail.com>
|
||||
Signed-off-by: Furkan Kardame <f.kardame@manjaro.org>
|
||||
---
|
||||
drivers/net/phy/motorcomm.c | 90 +++++++++++++++++++++++++++++++++++++
|
||||
1 file changed, 90 insertions(+)
|
||||
|
||||
--- a/drivers/net/phy/motorcomm.c
|
||||
+++ b/drivers/net/phy/motorcomm.c
|
||||
@@ -10,6 +10,7 @@
|
||||
#include <linux/phy.h>
|
||||
|
||||
#define PHY_ID_YT8511 0x0000010a
|
||||
+#define PHY_ID_YT8531 0x4f51e91b
|
||||
|
||||
#define YT8511_PAGE_SELECT 0x1e
|
||||
#define YT8511_PAGE 0x1f
|
||||
@@ -38,6 +39,38 @@
|
||||
#define YT8511_DELAY_FE_TX_EN (0xf << 12)
|
||||
#define YT8511_DELAY_FE_TX_DIS (0x2 << 12)
|
||||
|
||||
+#define YT8531_RGMII_CONFIG1 0xa003
|
||||
+
|
||||
+/* TX Gig-E Delay is bits 3:0, default 0x1
|
||||
+ * TX Fast-E Delay is bits 7:4, default 0xf
|
||||
+ * RX Delay is bits 13:10, default 0x0
|
||||
+ * Delay = 150ps * N
|
||||
+ * On = 2000ps, off = 50ps
|
||||
+ */
|
||||
+#define YT8531_DELAY_GE_TX_EN (0xd << 0)
|
||||
+#define YT8531_DELAY_GE_TX_DIS (0x0 << 0)
|
||||
+#define YT8531_DELAY_FE_TX_EN (0xd << 4)
|
||||
+#define YT8531_DELAY_FE_TX_DIS (0x0 << 4)
|
||||
+#define YT8531_DELAY_RX_EN (0xd << 10)
|
||||
+#define YT8531_DELAY_RX_DIS (0x0 << 10)
|
||||
+#define YT8531_DELAY_MASK (GENMASK(13, 10) | GENMASK(7, 0))
|
||||
+
|
||||
+#define YT8531_SYNCE_CFG 0xa012
|
||||
+
|
||||
+/* Clk src config is bits 3:1
|
||||
+ * 3b000 src from pll
|
||||
+ * 3b001 src from rx_clk
|
||||
+ * 3b010 src from serdes
|
||||
+ * 3b011 src from ptp_in
|
||||
+ * 3b100 src from 25mhz refclk *default*
|
||||
+ * 3b101 src from 25mhz ssc
|
||||
+ * Clk rate select is bit 4
|
||||
+ * 1b0 25mhz clk output *default*
|
||||
+ * 1b1 125mhz clk output
|
||||
+ * Clkout enable is bit 6
|
||||
+ */
|
||||
+#define YT8531_CLKCFG_125M (BIT(6) | BIT(4) | (0x0 < 1))
|
||||
+
|
||||
static int yt8511_read_page(struct phy_device *phydev)
|
||||
{
|
||||
return __phy_read(phydev, YT8511_PAGE_SELECT);
|
||||
@@ -111,6 +145,51 @@ static int yt8511_config_init(struct phy_device *phydev)
|
||||
return phy_restore_page(phydev, oldpage, ret);
|
||||
}
|
||||
|
||||
+static int yt8531_config_init(struct phy_device *phydev)
|
||||
+{
|
||||
+ int oldpage, ret = 0;
|
||||
+ unsigned int val;
|
||||
+
|
||||
+ oldpage = phy_select_page(phydev, YT8531_RGMII_CONFIG1);
|
||||
+ if (oldpage < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+ /* set rgmii delay mode */
|
||||
+ switch (phydev->interface) {
|
||||
+ case PHY_INTERFACE_MODE_RGMII:
|
||||
+ val = YT8531_DELAY_RX_DIS | YT8531_DELAY_GE_TX_DIS | YT8531_DELAY_FE_TX_DIS;
|
||||
+ break;
|
||||
+ case PHY_INTERFACE_MODE_RGMII_RXID:
|
||||
+ val = YT8531_DELAY_RX_EN | YT8531_DELAY_GE_TX_DIS | YT8531_DELAY_FE_TX_DIS;
|
||||
+ break;
|
||||
+ case PHY_INTERFACE_MODE_RGMII_TXID:
|
||||
+ val = YT8531_DELAY_RX_DIS | YT8531_DELAY_GE_TX_EN | YT8531_DELAY_FE_TX_EN;
|
||||
+ break;
|
||||
+ case PHY_INTERFACE_MODE_RGMII_ID:
|
||||
+ val = YT8531_DELAY_RX_EN | YT8531_DELAY_GE_TX_EN | YT8531_DELAY_FE_TX_EN;
|
||||
+ break;
|
||||
+ default: /* do not support other modes */
|
||||
+ ret = -EOPNOTSUPP;
|
||||
+ goto err_restore_page;
|
||||
+ }
|
||||
+
|
||||
+ ret = __phy_modify(phydev, YT8511_PAGE, YT8531_DELAY_MASK, val);
|
||||
+ if (ret < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+ /* set clock mode to 125mhz */
|
||||
+ ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8531_SYNCE_CFG);
|
||||
+ if (ret < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+ ret = __phy_write(phydev, YT8511_PAGE, YT8531_CLKCFG_125M);
|
||||
+ if (ret < 0)
|
||||
+ goto err_restore_page;
|
||||
+
|
||||
+err_restore_page:
|
||||
+ return phy_restore_page(phydev, oldpage, ret);
|
||||
+}
|
||||
+
|
||||
static struct phy_driver motorcomm_phy_drvs[] = {
|
||||
{
|
||||
PHY_ID_MATCH_EXACT(PHY_ID_YT8511),
|
||||
@@ -120,7 +200,16 @@ static struct phy_driver motorcomm_phy_drvs[] = {
|
||||
.resume = genphy_resume,
|
||||
.read_page = yt8511_read_page,
|
||||
.write_page = yt8511_write_page,
|
||||
+ }, {
|
||||
+ PHY_ID_MATCH_EXACT(PHY_ID_YT8531),
|
||||
+ .name = "YT8531 Gigabit Ethernet",
|
||||
+ .config_init = yt8531_config_init,
|
||||
+ .suspend = genphy_suspend,
|
||||
+ .resume = genphy_resume,
|
||||
+ .read_page = yt8511_read_page,
|
||||
+ .write_page = yt8511_write_page,
|
||||
},
|
||||
+
|
||||
};
|
||||
|
||||
module_phy_driver(motorcomm_phy_drvs);
|
||||
@@ -131,6 +220,7 @@ MODULE_LICENSE("GPL");
|
||||
|
||||
static const struct mdio_device_id __maybe_unused motorcomm_tbl[] = {
|
||||
{ PHY_ID_MATCH_EXACT(PHY_ID_YT8511) },
|
||||
+ { PHY_ID_MATCH_EXACT(PHY_ID_YT8531) },
|
||||
{ /* sentinal */ }
|
||||
};
|
||||
|
||||
Loading…
Reference in New Issue
Block a user