mirror of
https://github.com/hanwckf/immortalwrt-mt798x.git
synced 2025-01-10 03:09:08 +08:00
631 lines
23 KiB
Diff
631 lines
23 KiB
Diff
Index: drivers/net/phy/Kconfig
|
|
===================================================================
|
|
--- a/drivers/net/phy/Kconfig
|
|
+++ b/drivers/net/phy/Kconfig
|
|
@@ -345,6 +345,11 @@ config SFP
|
|
depends on HWMON || HWMON=n
|
|
select MDIO_I2C
|
|
|
|
+config AIROHA_EN8801S_PHY
|
|
+ tristate "Drivers for Airoha EN8801S Gigabit PHYs"
|
|
+ ---help---
|
|
+ Currently supports the Airoha EN8801S PHY.
|
|
+
|
|
config ADIN_PHY
|
|
tristate "Analog Devices Industrial Ethernet PHYs"
|
|
help
|
|
Index: drivers/net/phy/Makefile
|
|
===================================================================
|
|
--- a/drivers/net/phy/Makefile
|
|
+++ b/drivers/net/phy/Makefile
|
|
@@ -67,6 +67,7 @@ aquantia-objs += aquantia_main.o
|
|
ifdef CONFIG_HWMON
|
|
aquantia-objs += aquantia_hwmon.o
|
|
endif
|
|
+obj-$(CONFIG_AIROHA_EN8801S_PHY) += en8801s.o
|
|
obj-$(CONFIG_AQUANTIA_PHY) += aquantia.o
|
|
obj-$(CONFIG_AX88796B_PHY) += ax88796b.o
|
|
obj-$(CONFIG_AT803X_PHY) += at803x.o
|
|
Index: drivers/net/phy/en8801s.c
|
|
===================================================================
|
|
--- /dev/null
|
|
+++ b/drivers/net/phy/en8801s.c
|
|
@@ -0,0 +1,434 @@
|
|
+// SPDX-License-Identifier: GPL-2.0
|
|
+/* FILE NAME: en8801s.c
|
|
+ * PURPOSE:
|
|
+ * EN8801S phy driver for Linux
|
|
+ * NOTES:
|
|
+ *
|
|
+ */
|
|
+
|
|
+/* INCLUDE FILE DECLARATIONS
|
|
+ */
|
|
+
|
|
+#include <linux/kernel.h>
|
|
+#include <linux/string.h>
|
|
+#include <linux/errno.h>
|
|
+#include <linux/unistd.h>
|
|
+#include <linux/interrupt.h>
|
|
+#include <linux/init.h>
|
|
+#include <linux/delay.h>
|
|
+#include <linux/netdevice.h>
|
|
+#include <linux/etherdevice.h>
|
|
+#include <linux/skbuff.h>
|
|
+#include <linux/spinlock.h>
|
|
+#include <linux/mm.h>
|
|
+#include <linux/module.h>
|
|
+#include <linux/mii.h>
|
|
+#include <linux/ethtool.h>
|
|
+#include <linux/phy.h>
|
|
+#include <linux/delay.h>
|
|
+
|
|
+#include <linux/uaccess.h>
|
|
+#include <linux/version.h>
|
|
+
|
|
+#include "en8801s.h"
|
|
+
|
|
+MODULE_DESCRIPTION("Airoha EN8801S PHY drivers");
|
|
+MODULE_AUTHOR("Airoha");
|
|
+MODULE_LICENSE("GPL");
|
|
+
|
|
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 5, 0))
|
|
+#define phydev_mdio_bus(dev) ((dev)->bus)
|
|
+#else
|
|
+#define phydev_mdio_bus(dev) ((dev)->mdio.bus)
|
|
+#endif
|
|
+
|
|
+enum {
|
|
+ PHY_STATE_DONE = 0,
|
|
+ PHY_STATE_INIT = 1,
|
|
+ PHY_STATE_PROCESS = 2,
|
|
+};
|
|
+
|
|
+/************************************************************************
|
|
+* F U N C T I O N S
|
|
+************************************************************************/
|
|
+static unsigned int airoha_cl45_write(struct mii_bus *bus, u32 port, u32 devad, u32 reg, u16 val)
|
|
+{
|
|
+ mdiobus_write(bus, port, MII_MMD_ACC_CTL_REG, devad);
|
|
+ mdiobus_write(bus, port, MII_MMD_ADDR_DATA_REG, reg);
|
|
+ mdiobus_write(bus, port, MII_MMD_ACC_CTL_REG, MMD_OP_MODE_DATA | devad);
|
|
+ mdiobus_write(bus, port, MII_MMD_ADDR_DATA_REG, val);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static unsigned int airoha_cl45_read(struct mii_bus *bus, u32 port, u32 devad, u32 reg, u32 *read_data)
|
|
+{
|
|
+ mdiobus_write(bus, port, MII_MMD_ACC_CTL_REG, devad);
|
|
+ mdiobus_write(bus, port, MII_MMD_ADDR_DATA_REG, reg);
|
|
+ mdiobus_write(bus, port, MII_MMD_ACC_CTL_REG, MMD_OP_MODE_DATA | devad);
|
|
+ *read_data = mdiobus_read(bus, port, MII_MMD_ADDR_DATA_REG);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static unsigned int airoha_cl22_read(struct mii_bus *ebus, unsigned int phy_addr, unsigned int phy_register, unsigned int *read_data)
|
|
+{
|
|
+ *read_data = mdiobus_read(ebus, phy_addr, phy_register);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static unsigned int airoha_cl22_write(struct mii_bus *ebus, unsigned int phy_addr, unsigned int phy_register, unsigned int write_data)
|
|
+{
|
|
+ mdiobus_write(ebus, phy_addr, phy_register, write_data);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static void airoha_pbus_write(struct mii_bus *ebus, unsigned long pbus_id, unsigned long pbus_address, unsigned long pbus_data)
|
|
+{
|
|
+ airoha_cl22_write(ebus, pbus_id, 0x1F, (unsigned int)(pbus_address >> 6));
|
|
+ airoha_cl22_write(ebus, pbus_id, (unsigned int)((pbus_address >> 2) & 0xf), (unsigned int)(pbus_data & 0xFFFF));
|
|
+ airoha_cl22_write(ebus, pbus_id, 0x10, (unsigned int)(pbus_data >> 16));
|
|
+ return;
|
|
+}
|
|
+
|
|
+static unsigned long airoha_pbus_read(struct mii_bus *ebus, unsigned long pbus_id, unsigned long pbus_address)
|
|
+{
|
|
+ unsigned long pbus_data;
|
|
+ unsigned int pbus_data_low, pbus_data_high;
|
|
+
|
|
+ airoha_cl22_write(ebus, pbus_id, 0x1F, (unsigned int)(pbus_address >> 6));
|
|
+ airoha_cl22_read(ebus, pbus_id, (unsigned int)((pbus_address >> 2) & 0xf), &pbus_data_low);
|
|
+ airoha_cl22_read(ebus, pbus_id, 0x10, &pbus_data_high);
|
|
+ pbus_data = (pbus_data_high << 16) + pbus_data_low;
|
|
+ return pbus_data;
|
|
+}
|
|
+
|
|
+/* Airoha Token Ring Write function */
|
|
+static void airoha_tr_reg_write(struct mii_bus *ebus, unsigned long tr_address, unsigned long tr_data)
|
|
+{
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x1F, 0x52b5); /* page select */
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x11, (unsigned int)(tr_data & 0xffff));
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x12, (unsigned int)(tr_data >> 16));
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x10, (unsigned int)(tr_address | TrReg_WR));
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x1F, 0x0); /* page resetore */
|
|
+ return;
|
|
+}
|
|
+
|
|
+/* Airoha Token Ring Read function */
|
|
+static unsigned long airoha_tr_reg_read(struct mii_bus *ebus, unsigned long tr_address)
|
|
+{
|
|
+ unsigned long tr_data;
|
|
+ unsigned int tr_data_low, tr_data_high;
|
|
+
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x1F, 0x52b5); /* page select */
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x10, (unsigned int)(tr_address | TrReg_RD));
|
|
+ airoha_cl22_read(ebus, EN8801S_MDIO_PHY_ID, 0x11, &tr_data_low);
|
|
+ airoha_cl22_read(ebus, EN8801S_MDIO_PHY_ID, 0x12, &tr_data_high);
|
|
+ airoha_cl22_write(ebus, EN8801S_MDIO_PHY_ID, 0x1F, 0x0); /* page resetore */
|
|
+ tr_data = (tr_data_high << 16) + tr_data_low;
|
|
+ return tr_data;
|
|
+}
|
|
+
|
|
+static void en8801s_led_init(struct phy_device *phydev)
|
|
+{
|
|
+ struct mii_bus *mbus = phydev_mdio_bus(phydev);
|
|
+ u32 reg_value;
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x186c, 0x3);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0X1870, 0x100);
|
|
+ reg_value = (airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1880) & ~(0x3));
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1880, reg_value);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1f, 0x21, 0x8008);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1f, 0x22, 0x600);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1f, 0x23, 0xc00);
|
|
+ /* LED0: 10M/100M */
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1f, 0x24, 0x8006);
|
|
+ /* LED0: blink 10M/100M Tx/Rx */
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1f, 0x25, 0x3c);
|
|
+ /* LED1: 1000M */
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1f, 0x26, 0x8001);
|
|
+ /* LED1: blink 1000M Tx/Rx */
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1f, 0x27, 0x3);
|
|
+}
|
|
+
|
|
+static int en8801s_phy_process(struct phy_device *phydev)
|
|
+{
|
|
+ struct mii_bus *mbus = phydev_mdio_bus(phydev);
|
|
+ u32 reg_value = 0;
|
|
+
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x19e0);
|
|
+ reg_value |= (1 << 0);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x19e0, reg_value);
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x19e0);
|
|
+ reg_value &= ~(1 << 0);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x19e0, reg_value);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int en8801s_phase1_init(struct phy_device *phydev)
|
|
+{
|
|
+ unsigned long pbus_data;
|
|
+ unsigned int pbusAddress;
|
|
+ u32 reg_value;
|
|
+ int retry;
|
|
+ struct mii_bus *mbus = phydev_mdio_bus(phydev);
|
|
+
|
|
+ msleep(1500);
|
|
+
|
|
+ pbusAddress = EN8801S_PBUS_DEFAULT_ID;
|
|
+ retry = MAX_OUI_CHECK;
|
|
+ while (1) {
|
|
+ pbus_data = airoha_pbus_read(mbus, pbusAddress, EN8801S_RG_ETHER_PHY_OUI); /* PHY OUI */
|
|
+ if (EN8801S_PBUS_OUI == pbus_data) {
|
|
+ pbus_data = airoha_pbus_read(mbus, pbusAddress, EN8801S_RG_SMI_ADDR); /* SMI ADDR */
|
|
+ pbus_data = (pbus_data & 0xffff0000) | (unsigned long)(EN8801S_PBUS_PHY_ID << 8) | (unsigned long)(EN8801S_MDIO_PHY_ID);
|
|
+ phydev_info(phydev, "SMI_ADDR=%lx (renew)\n", pbus_data);
|
|
+ airoha_pbus_write(mbus, pbusAddress, EN8801S_RG_SMI_ADDR, pbus_data);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, EN8801S_RG_BUCK_CTL, 0x03);
|
|
+ mdelay(10);
|
|
+ break;
|
|
+ } else {
|
|
+ pbusAddress = EN8801S_PBUS_PHY_ID;
|
|
+ }
|
|
+ retry --;
|
|
+ if (0 == retry) {
|
|
+ phydev_err(phydev, "Probe fail !\n");
|
|
+ return 0;
|
|
+ }
|
|
+ }
|
|
+
|
|
+ reg_value = (airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, EN8801S_RG_LTR_CTL) & 0xfffffffc) | 0x10 | (EN8801S_RX_POLARITY << 1) | EN8801S_TX_POLARITY;
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, EN8801S_RG_LTR_CTL, reg_value);
|
|
+ mdelay(10);
|
|
+ reg_value &= 0xffffffef;
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, EN8801S_RG_LTR_CTL, reg_value);
|
|
+
|
|
+ retry = MAX_RETRY;
|
|
+ while (1) {
|
|
+ mdelay(10);
|
|
+ reg_value = phy_read(phydev, MII_PHYSID2);
|
|
+ if (reg_value == EN8801S_PHY_ID2) {
|
|
+ break; /* wait GPHY ready */
|
|
+ }
|
|
+ retry--;
|
|
+ if (0 == retry) {
|
|
+ phydev_err(phydev, "Initialize fail !\n");
|
|
+ return 0;
|
|
+ }
|
|
+ }
|
|
+ /* Software Reset PHY */
|
|
+ reg_value = phy_read(phydev, MII_BMCR);
|
|
+ reg_value |= BMCR_RESET;
|
|
+ phy_write(phydev, MII_BMCR, reg_value);
|
|
+ retry = MAX_RETRY;
|
|
+ do {
|
|
+ mdelay(10);
|
|
+ reg_value = phy_read(phydev, MII_BMCR);
|
|
+ retry--;
|
|
+ if (0 == retry) {
|
|
+ phydev_err(phydev, "Reset fail !\n");
|
|
+ return 0;
|
|
+ }
|
|
+ } while (reg_value & BMCR_RESET);
|
|
+
|
|
+ phydev->dev_flags = PHY_STATE_INIT;
|
|
+
|
|
+ phydev_info(phydev, "Phase1 initialize OK ! (%s)\n", EN8801S_DRIVER_VERSION);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int en8801s_phase2_init(struct phy_device *phydev)
|
|
+{
|
|
+ gephy_all_REG_LpiReg1Ch GPHY_RG_LPI_1C;
|
|
+ gephy_all_REG_dev1Eh_reg324h GPHY_RG_1E_324;
|
|
+ gephy_all_REG_dev1Eh_reg012h GPHY_RG_1E_012;
|
|
+ gephy_all_REG_dev1Eh_reg017h GPHY_RG_1E_017;
|
|
+ unsigned long pbus_data;
|
|
+ u32 reg_value;
|
|
+ int retry;
|
|
+ struct mii_bus *mbus = phydev_mdio_bus(phydev);
|
|
+
|
|
+ reg_value = (airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, EN8801S_RG_LTR_CTL) & 0xfffffffc) | 0x10 | (EN8801S_RX_POLARITY << 1) | EN8801S_TX_POLARITY;
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, EN8801S_RG_LTR_CTL, reg_value);
|
|
+ mdelay(10);
|
|
+ reg_value &= 0xffffffef;
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, EN8801S_RG_LTR_CTL, reg_value);
|
|
+
|
|
+ pbus_data = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1690);
|
|
+ pbus_data |= (1 << 31);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1690, pbus_data);
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0600, 0x0c000c00);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x10, 0xD801);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0, 0x9140);
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0A14, 0x0003);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0600, 0x0c000c00);
|
|
+ /* Set FCM control */
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1404, 0x004b);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x140c, 0x0007);
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x142c, 0x05050505);
|
|
+ pbus_data = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1440);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1440, pbus_data & ~(1 << 11));
|
|
+ /* Set GPHY Perfomance*/
|
|
+ /* Token Ring */
|
|
+ airoha_tr_reg_write(mbus, RgAddr_PMA_01h, 0x6FB90A);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_PMA_18h, 0x0E2F00);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_06h, 0x2EBAEF);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_11h, 0x040001);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_03h, 0x000004);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_1Ch, 0x003210);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_14h, 0x00024A);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_0Ch, 0x00704D);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_0Dh, 0x02314F);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_10h, 0x005010);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_DSPF_0Fh, 0x003028);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_TR_26h, 0x444444);
|
|
+ airoha_tr_reg_write(mbus, RgAddr_R1000DEC_15h, 0x0055A0);
|
|
+ /* CL22 & CL45 */
|
|
+ phy_write(phydev, 0x1f, 0x03);
|
|
+ GPHY_RG_LPI_1C.DATA = phy_read(phydev, RgAddr_LpiReg1Ch);
|
|
+ GPHY_RG_LPI_1C.DataBitField.smi_deton_th = 0x0C;
|
|
+ phy_write(phydev, RgAddr_LpiReg1Ch, GPHY_RG_LPI_1C.DATA);
|
|
+ phy_write(phydev, 0x1f, 0x0);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x122, 0xffff);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x234, 0x0180);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x238, 0x0120);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x120, 0x9014);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x239, 0x0117);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x14A, 0xEE20);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x19B, 0x0111);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1F, 0x268, 0x07F4);
|
|
+
|
|
+ airoha_cl45_read(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x324, ®_value);
|
|
+ GPHY_RG_1E_324.DATA = (u16)reg_value;
|
|
+ GPHY_RG_1E_324.DataBitField.smi_det_deglitch_off = 0;
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x324, (u32)GPHY_RG_1E_324.DATA);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x19E, 0xC2);
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x013, 0x0);
|
|
+
|
|
+ /* EFUSE */
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1C08, 0x40000040);
|
|
+ retry = MAX_RETRY;
|
|
+ while (0 != retry) {
|
|
+ mdelay(1);
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1C08);
|
|
+ if ((reg_value & (1 << 30)) == 0) {
|
|
+ break;
|
|
+ }
|
|
+ retry--;
|
|
+ }
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1C38); /* RAW#2 */
|
|
+ GPHY_RG_1E_012.DataBitField.da_tx_i2mpb_a_tbt = reg_value & 0x03f;
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x12, (u32)GPHY_RG_1E_012.DATA);
|
|
+ GPHY_RG_1E_017.DataBitField.da_tx_i2mpb_b_tbt = (reg_value >> 8) & 0x03f;
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x12, (u32)GPHY_RG_1E_017.DATA);
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1C08, 0x40400040);
|
|
+ retry = MAX_RETRY;
|
|
+ while (0 != retry) {
|
|
+ mdelay(1);
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1C08);
|
|
+ if ((reg_value & (1 << 30)) == 0) {
|
|
+ break;
|
|
+ }
|
|
+ retry--;
|
|
+ }
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1C30); /* RAW#16 */
|
|
+ GPHY_RG_1E_324.DataBitField.smi_det_deglitch_off = (reg_value >> 12) & 0x01;
|
|
+ airoha_cl45_write(mbus, EN8801S_MDIO_PHY_ID, 0x1E, 0x324, (u32)GPHY_RG_1E_324.DATA);
|
|
+
|
|
+ en8801s_led_init(phydev);
|
|
+
|
|
+ phydev_info(phydev, "Phase2 initialize OK !\n");
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int en8801s_read_status(struct phy_device *phydev)
|
|
+{
|
|
+ int ret, preSpeed = phydev->speed;
|
|
+ struct mii_bus *mbus = phydev_mdio_bus(phydev);
|
|
+ u32 reg_value;
|
|
+
|
|
+ ret = genphy_read_status(phydev);
|
|
+ if (LINK_DOWN == phydev->link) preSpeed = phydev->speed = 0;
|
|
+
|
|
+ if (phydev->dev_flags == PHY_STATE_PROCESS) {
|
|
+ en8801s_phy_process(phydev);
|
|
+ phydev->dev_flags = PHY_STATE_DONE;
|
|
+ }
|
|
+
|
|
+ if ((preSpeed != phydev->speed) && (LINK_UP == phydev->link)) {
|
|
+ preSpeed = phydev->speed;
|
|
+
|
|
+ if (phydev->dev_flags == PHY_STATE_INIT) {
|
|
+ en8801s_phase2_init(phydev);
|
|
+ phydev->dev_flags = PHY_STATE_PROCESS;
|
|
+ }
|
|
+
|
|
+ if (preSpeed == SPEED_10) {
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1694);
|
|
+ reg_value |= (1 << 31);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1694, reg_value);
|
|
+ phydev->dev_flags = PHY_STATE_PROCESS;
|
|
+ } else {
|
|
+ reg_value = airoha_pbus_read(mbus, EN8801S_PBUS_PHY_ID, 0x1694);
|
|
+ reg_value &= ~(1 << 31);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1694, reg_value);
|
|
+ phydev->dev_flags = PHY_STATE_PROCESS;
|
|
+ }
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0600, 0x0c000c00);
|
|
+ if (SPEED_1000 == preSpeed) {
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x10, 0xD801);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0, 0x9140);
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0A14, 0x0003);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0600, 0x0c000c00);
|
|
+ mdelay(2); /* delay 2 ms */
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1404, 0x004b);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x140c, 0x0007);
|
|
+ } else if (SPEED_100 == preSpeed) {
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x10, 0xD401);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0, 0x9140);
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0A14, 0x0007);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0600, 0x0c11);
|
|
+ mdelay(2); /* delay 2 ms */
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1404, 0x0027);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x140c, 0x0007);
|
|
+ } else if (SPEED_10 == preSpeed) {
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x10, 0xD001);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0, 0x9140);
|
|
+
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0A14, 0x000b);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x0600, 0x0c11);
|
|
+ mdelay(2); /* delay 2 ms */
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x1404, 0x0027);
|
|
+ airoha_pbus_write(mbus, EN8801S_PBUS_PHY_ID, 0x140c, 0x0007);
|
|
+ }
|
|
+ }
|
|
+ return ret;
|
|
+}
|
|
+
|
|
+static struct phy_driver Airoha_driver[] = {
|
|
+ {
|
|
+ .phy_id = EN8801S_PHY_ID,
|
|
+ .name = "Airoha EN8801S",
|
|
+ .phy_id_mask = 0x0ffffff0,
|
|
+ .features = PHY_GBIT_FEATURES,
|
|
+ .config_init = en8801s_phase1_init,
|
|
+ .config_aneg = genphy_config_aneg,
|
|
+ .read_status = en8801s_read_status,
|
|
+ .suspend = genphy_suspend,
|
|
+ .resume = genphy_resume,
|
|
+ }
|
|
+};
|
|
+
|
|
+module_phy_driver(Airoha_driver);
|
|
+
|
|
+static struct mdio_device_id __maybe_unused Airoha_tbl[] = {
|
|
+ { EN8801S_PHY_ID, 0x0ffffff0 },
|
|
+ { }
|
|
+};
|
|
+
|
|
+MODULE_DEVICE_TABLE(mdio, Airoha_tbl);
|
|
Index: drivers/net/phy/en8801s.h
|
|
===================================================================
|
|
--- /dev/null
|
|
+++ b/drivers/net/phy/en8801s.h
|
|
@@ -0,0 +1,158 @@
|
|
+// SPDX-License-Identifier: GPL-2.0
|
|
+/* FILE NAME: en8801s.h
|
|
+ * PURPOSE:
|
|
+ * Define EN8801S driver function
|
|
+ *
|
|
+ * NOTES:
|
|
+ *
|
|
+ */
|
|
+
|
|
+#ifndef __EN8801S_H
|
|
+#define __EN8801S_H
|
|
+
|
|
+/* NAMING DECLARATIONS
|
|
+ */
|
|
+#define EN8801S_DRIVER_VERSION "1.1.0"
|
|
+
|
|
+#define PHY_ADDRESS_RANGE 0x18
|
|
+#define EN8801S_PBUS_DEFAULT_ID 0x1e
|
|
+#define EN8801S_MDIO_PHY_ID 0x18 /* Range PHY_ADDRESS_RANGE .. 0x1e */
|
|
+#define EN8801S_PBUS_PHY_ID (EN8801S_MDIO_PHY_ID + 1)
|
|
+
|
|
+#define EN8801S_RG_ETHER_PHY_OUI 0x19a4
|
|
+#define EN8801S_RG_SMI_ADDR 0x19a8
|
|
+#define EN8801S_RG_BUCK_CTL 0x1a20
|
|
+#define EN8801S_RG_LTR_CTL 0x0cf8
|
|
+
|
|
+#define EN8801S_PBUS_OUI 0x17a5
|
|
+#define EN8801S_PHY_ID1 0x03a2
|
|
+#define EN8801S_PHY_ID2 0x9461
|
|
+#define EN8801S_PHY_ID (unsigned long)((EN8801S_PHY_ID1 << 16) | EN8801S_PHY_ID2)
|
|
+
|
|
+#define DEV1E_REG013_VALUE 0
|
|
+#define DEV1E_REG19E_VALUE 0xC2
|
|
+#define DEV1E_REG324_VALUE 0x200
|
|
+
|
|
+#define TRUE 1
|
|
+#define FALSE 0
|
|
+#define LINK_UP 1
|
|
+#define LINK_DOWN 0
|
|
+
|
|
+//#define TEST_BOARD
|
|
+#if defined(TEST_BOARD)
|
|
+/* SFP sample for verification */
|
|
+#define EN8801S_TX_POLARITY 1
|
|
+#define EN8801S_RX_POLARITY 0
|
|
+#else
|
|
+/* chip on board */
|
|
+#define EN8801S_TX_POLARITY 0
|
|
+#define EN8801S_RX_POLARITY 1 /* The pin default assignment is set to 1 */
|
|
+#endif
|
|
+
|
|
+#define MAX_RETRY 5
|
|
+#define MAX_OUI_CHECK 2
|
|
+/* CL45 MDIO control */
|
|
+#define MII_MMD_ACC_CTL_REG 0x0d
|
|
+#define MII_MMD_ADDR_DATA_REG 0x0e
|
|
+#define MMD_OP_MODE_DATA BIT(14)
|
|
+
|
|
+#define MAX_TRG_COUNTER 5
|
|
+
|
|
+/* CL22 Reg Support Page Select */
|
|
+#define RgAddr_Reg1Fh 0x1f
|
|
+#define CL22_Page_Reg 0x0000
|
|
+#define CL22_Page_ExtReg 0x0001
|
|
+#define CL22_Page_MiscReg 0x0002
|
|
+#define CL22_Page_LpiReg 0x0003
|
|
+#define CL22_Page_tReg 0x02A3
|
|
+#define CL22_Page_TrReg 0x52B5
|
|
+
|
|
+/* CL45 Reg Support DEVID */
|
|
+#define DEVID_03 0x03
|
|
+#define DEVID_07 0x07
|
|
+#define DEVID_1E 0x1E
|
|
+#define DEVID_1F 0x1F
|
|
+
|
|
+/* TokenRing Reg Access */
|
|
+#define TrReg_PKT_XMT_STA 0x8000
|
|
+#define TrReg_WR 0x8000
|
|
+#define TrReg_RD 0xA000
|
|
+
|
|
+#define RgAddr_LpiReg1Ch 0x1c
|
|
+#define RgAddr_PMA_01h 0x0f82
|
|
+#define RgAddr_PMA_18h 0x0fb0
|
|
+#define RgAddr_DSPF_03h 0x1686
|
|
+#define RgAddr_DSPF_06h 0x168c
|
|
+#define RgAddr_DSPF_0Ch 0x1698
|
|
+#define RgAddr_DSPF_0Dh 0x169a
|
|
+#define RgAddr_DSPF_0Fh 0x169e
|
|
+#define RgAddr_DSPF_10h 0x16a0
|
|
+#define RgAddr_DSPF_11h 0x16a2
|
|
+#define RgAddr_DSPF_14h 0x16a8
|
|
+#define RgAddr_DSPF_1Ch 0x16b8
|
|
+#define RgAddr_TR_26h 0x0ecc
|
|
+#define RgAddr_R1000DEC_15h 0x03aa
|
|
+
|
|
+/* DATA TYPE DECLARATIONS
|
|
+ */
|
|
+typedef struct
|
|
+{
|
|
+ u16 DATA_Lo;
|
|
+ u16 DATA_Hi;
|
|
+}TR_DATA_T;
|
|
+
|
|
+typedef union
|
|
+{
|
|
+ struct
|
|
+ {
|
|
+ /* b[15:00] */
|
|
+ u16 smi_deton_wt : 3;
|
|
+ u16 smi_det_mdi_inv : 1;
|
|
+ u16 smi_detoff_wt : 3;
|
|
+ u16 smi_sigdet_debouncing_en : 1;
|
|
+ u16 smi_deton_th : 6;
|
|
+ u16 rsv_14 : 2;
|
|
+ } DataBitField;
|
|
+ u16 DATA;
|
|
+} gephy_all_REG_LpiReg1Ch, *Pgephy_all_REG_LpiReg1Ch;
|
|
+
|
|
+typedef union
|
|
+{
|
|
+ struct
|
|
+ {
|
|
+ /* b[15:00] */
|
|
+ u16 rg_smi_detcnt_max : 6;
|
|
+ u16 rsv_6 : 2;
|
|
+ u16 rg_smi_det_max_en : 1;
|
|
+ u16 smi_det_deglitch_off : 1;
|
|
+ u16 rsv_10 : 6;
|
|
+ } DataBitField;
|
|
+ u16 DATA;
|
|
+} gephy_all_REG_dev1Eh_reg324h, *Pgephy_all_REG_dev1Eh_reg324h;
|
|
+
|
|
+typedef union
|
|
+{
|
|
+ struct
|
|
+ {
|
|
+ /* b[15:00] */
|
|
+ u16 da_tx_i2mpb_a_tbt : 6;
|
|
+ u16 rsv_6 : 4;
|
|
+ u16 da_tx_i2mpb_a_gbe : 6;
|
|
+ } DataBitField;
|
|
+ u16 DATA;
|
|
+} gephy_all_REG_dev1Eh_reg012h, *Pgephy_all_REG_dev1Eh_reg012h;
|
|
+
|
|
+typedef union
|
|
+{
|
|
+ struct
|
|
+ {
|
|
+ /* b[15:00] */
|
|
+ u16 da_tx_i2mpb_b_tbt : 6;
|
|
+ u16 rsv_6 : 2;
|
|
+ u16 da_tx_i2mpb_b_gbe : 6;
|
|
+ u16 rsv_14 : 2;
|
|
+ } DataBitField;
|
|
+ u16 DATA;
|
|
+} gephy_all_REG_dev1Eh_reg017h, *Pgephy_all_REG_dev1Eh_reg017h;
|
|
+
|
|
+#endif /* End of __EN8801S_H */
|