From 94e0c0bf6941bb9b34859a3548df2d054041fc0b Mon Sep 17 00:00:00 2001 From: afaulkner420 Date: Fri, 25 Mar 2022 20:20:34 +0000 Subject: [PATCH 05/11] net: phy: Support yt8531c --- .../net/ethernet/stmicro/stmmac/stmmac_main.c | 60 + drivers/net/phy/motorcomm.c | 1561 ++++++++++++++++- drivers/net/phy/yt8614-phy.h | 491 ++++++ include/linux/motorcomm_phy.h | 119 ++ 4 files changed, 2152 insertions(+), 79 deletions(-) create mode 100644 drivers/net/phy/yt8614-phy.h create mode 100644 include/linux/motorcomm_phy.h diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c index 9376c4e28..9e72e480c 100644 --- a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c +++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c @@ -141,6 +141,9 @@ static void stmmac_exit_fs(struct net_device *dev); #define STMMAC_COAL_TIMER(x) (ns_to_ktime((x) * NSEC_PER_USEC)) +#define RTL_8211E_PHY_ID 0x001cc915 +#define RTL_8211F_PHY_ID 0x001cc916 + int stmmac_bus_clks_config(struct stmmac_priv *priv, bool enabled) { int ret = 0; @@ -6959,6 +6962,54 @@ void stmmac_fpe_handshake(struct stmmac_priv *priv, bool enable) } } +static int phy_rtl8211e_led_fixup(struct phy_device *phydev) +{ + //int val; + + printk("%s in\n", __func__); + + /*switch to extension page44*/ + phy_write(phydev, 31, 0x07); + phy_write(phydev, 30, 0x2c); + + /*set led1(yellow) act + val = phy_read(phydev, 26); + val &= (~(1<<4));// bit4=0 + val |= (1<<5);// bit5=1 + val &= (~(1<<6));// bit6=0*/ + phy_write(phydev, 26, 0x20); + + /*set led0(green) link + val = phy_read(phydev, 28); + val |= (7<<0);// bit0,1,2=1 + val &= (~(7<<4));// bit4,5,6=0 + val &= (~(7<<8));// bit8,9,10=0*/ + phy_write(phydev, 28, 0x07); + + /*switch back to page0*/ + phy_write(phydev,31,0x00); + + return 0; +} + +static int phy_rtl8211f_led_fixup(struct phy_device *phydev) +{ + printk("%s in\n", __func__); + + /*switch to extension page44*/ + phy_write(phydev, 31, 0xd04); + + /*set led1(yellow) act */ + /*set led2(green) link*/ + phy_write(phydev, 16, 0xae00); + + phy_write(phydev, 17, 0); + /*switch back to page0*/ + phy_write(phydev,31,0x00); + + return 0; +} + /** * stmmac_dvr_probe * @device: device pointer @@ -7217,6 +7268,15 @@ int stmmac_dvr_probe(struct device *device, goto error_phy_setup; } + /* register the PHY board fixup */ + ret = phy_register_fixup_for_uid(RTL_8211E_PHY_ID, 0xffffffff, phy_rtl8211e_led_fixup); + if (ret) + pr_warn("Cannot register PHY board fixup.\n"); + + ret = phy_register_fixup_for_uid(RTL_8211F_PHY_ID, 0xffffffff, phy_rtl8211f_led_fixup); + if (ret) + pr_warn("Cannot register PHY board fixup.\n"); + ret = register_netdev(ndev); if (ret) { dev_err(priv->device, "%s: ERROR %i registering the device\n", diff --git a/drivers/net/phy/motorcomm.c b/drivers/net/phy/motorcomm.c index 7e6ac2c5e..c6876bd08 100644 --- a/drivers/net/phy/motorcomm.c +++ b/drivers/net/phy/motorcomm.c @@ -1,137 +1,1540 @@ -// SPDX-License-Identifier: GPL-2.0+ /* + * drivers/net/phy/motorcomm.c + * * Driver for Motorcomm PHYs * - * Author: Peter Geis + * Author: Leilei Zhao + * + * Copyright (c) 2019 Motorcomm, Inc. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License as published by the + * Free Software Foundation; either version 2 of the License, or (at your + * option) any later version. + * + * Support : Motorcomm Phys: + * Giga phys: yt8511, yt8521 + * 100/10 Phys : yt8512, yt8512b, yt8510 + * Automotive 100Mb Phys : yt8010 + * Automotive 100/10 hyper range Phys: yt8510 */ #include #include #include +#include +#include +#include +#include +#ifndef LINUX_VERSION_CODE +#include +#else +#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) +#endif +/*for wol, 20210604*/ +#include -#define PHY_ID_YT8511 0x0000010a +#include "yt8614-phy.h" -#define YT8511_PAGE_SELECT 0x1e -#define YT8511_PAGE 0x1f -#define YT8511_EXT_CLK_GATE 0x0c -#define YT8511_EXT_DELAY_DRIVE 0x0d -#define YT8511_EXT_SLEEP_CTRL 0x27 +/**** configuration section begin ***********/ -/* 2b00 25m from pll - * 2b01 25m from xtl *default* - * 2b10 62.m from pll - * 2b11 125m from pll +/* if system depends on ethernet packet to restore from sleep, please define this macro to 1 + * otherwise, define it to 0. */ -#define YT8511_CLK_125M (BIT(2) | BIT(1)) -#define YT8511_PLLON_SLP BIT(14) +#define SYS_WAKEUP_BASED_ON_ETH_PKT 1 -/* RX Delay enabled = 1.8ns 1000T, 8ns 10/100T */ -#define YT8511_DELAY_RX BIT(0) +/* to enable system WOL of phy, please define this macro to 1 + * otherwise, define it to 0. + */ +#define YTPHY_ENABLE_WOL 0 -/* TX Gig-E Delay is bits 7:4, default 0x5 - * TX Fast-E Delay is bits 15:12, default 0xf - * Delay = 150ps * N - 250ps - * On = 2000ps, off = 50ps +/* some GMAC need clock input from PHY, for eg., 125M, please enable this macro + * by degault, it is set to 0 + * NOTE: this macro will need macro SYS_WAKEUP_BASED_ON_ETH_PKT to set to 1 */ -#define YT8511_DELAY_GE_TX_EN (0xf << 4) -#define YT8511_DELAY_GE_TX_DIS (0x2 << 4) -#define YT8511_DELAY_FE_TX_EN (0xf << 12) -#define YT8511_DELAY_FE_TX_DIS (0x2 << 12) +#define GMAC_CLOCK_INPUT_NEEDED 1 + + +#define YT8521_PHY_MODE_FIBER 1 //fiber mode only +#define YT8521_PHY_MODE_UTP 2 //utp mode only +#define YT8521_PHY_MODE_POLL 3 //fiber and utp, poll mode + +/* please make choice according to system design + * for Fiber only system, please define YT8521_PHY_MODE_CURR 1 + * for UTP only system, please define YT8521_PHY_MODE_CURR 2 + * for combo system, please define YT8521_PHY_MODE_CURR 3 + */ +#define YT8521_PHY_MODE_CURR 3 + +/**** configuration section end ***********/ + + +/* no need to change below */ + +#if (YTPHY_ENABLE_WOL) +#undef SYS_WAKEUP_BASED_ON_ETH_PKT +#define SYS_WAKEUP_BASED_ON_ETH_PKT 1 +#endif -static int yt8511_read_page(struct phy_device *phydev) +/* workaround for 8521 fiber 100m mode */ +static int link_mode_8521 = 0; //0: no link; 1: utp; 32: fiber. traced that 1000m fiber uses 32. +static int link_mode_8614[4] = {0}; //0: no link; 1: utp; 32: fiber. traced that 1000m fiber uses 32. + +/* for multiple port phy, base phy address */ +static unsigned int yt_mport_base_phy_addr = 0xff; //0xff: invalid; for 8618 +static unsigned int yt_mport_base_phy_addr_8614 = 0xff; //0xff: invalid; + +int phy_yt8531_led_fixup(struct mii_bus *bus, int addr); +int yt8511_config_out_125m(struct mii_bus *bus, int phy_id); + +#if ( LINUX_VERSION_CODE > KERNEL_VERSION(5,0,0) ) +int genphy_config_init(struct phy_device *phydev) { - return __phy_read(phydev, YT8511_PAGE_SELECT); -}; + int ret; + + //printk (KERN_INFO "yzhang..read phyaddr=%d, phyid=%08x\n",phydev->mdio.addr, phydev->phy_id); + + if(phydev->phy_id == 0x4f51e91b) + { + //printk (KERN_INFO "yzhang..get YT8511, abt to set 125m clk out, phyaddr=%d, phyid=%08x\n",phydev->mdio.addr, phydev->phy_id); + ret = yt8511_config_out_125m(phydev->mdio.bus, phydev->mdio.addr); + //printk (KERN_INFO "yzhang..8511 set 125m clk out, reg=%#04x\n",phydev->mdio.bus->read(phydev->mdio.bus,phydev->mdio.addr,0x1f)/*double check as delay*/); + if (ret<0) + printk (KERN_INFO "yzhang..failed to set 125m clk out, ret=%d\n",ret); -static int yt8511_write_page(struct phy_device *phydev, int page) + phy_yt8531_led_fixup(phydev->mdio.bus, phydev->mdio.addr); + } + return genphy_read_abilities(phydev); +} +#endif + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +static int ytphy_config_init(struct phy_device *phydev) { - return __phy_write(phydev, YT8511_PAGE_SELECT, page); -}; + return 0; +} +#endif + +static int ytphy_read_ext(struct phy_device *phydev, u32 regnum) +{ + int ret; + int val; + + ret = phy_write(phydev, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_DEBUG_DATA); + + return val; +} + +static int ytphy_write_ext(struct phy_device *phydev, u32 regnum, u16 val) +{ + int ret; + + ret = phy_write(phydev, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + return ret; + + ret = phy_write(phydev, REG_DEBUG_DATA, val); + + return ret; +} + +static int yt8010_config_aneg(struct phy_device *phydev) +{ + phydev->speed = SPEED_100; + return 0; +} + +static int yt8512_clk_init(struct phy_device *phydev) +{ + int ret; + int val; + + val = ytphy_read_ext(phydev, YT8512_EXTREG_AFE_PLL); + if (val < 0) + return val; + + val |= YT8512_CONFIG_PLL_REFCLK_SEL_EN; + + ret = ytphy_write_ext(phydev, YT8512_EXTREG_AFE_PLL, val); + if (ret < 0) + return ret; + + val = ytphy_read_ext(phydev, YT8512_EXTREG_EXTEND_COMBO); + if (val < 0) + return val; + + val |= YT8512_CONTROL1_RMII_EN; + + ret = ytphy_write_ext(phydev, YT8512_EXTREG_EXTEND_COMBO, val); + if (ret < 0) + return ret; + + val = phy_read(phydev, MII_BMCR); + if (val < 0) + return val; + + val |= YT_SOFTWARE_RESET; + ret = phy_write(phydev, MII_BMCR, val); + + return ret; +} + +static int yt8512_led_init(struct phy_device *phydev) +{ + int ret; + int val; + int mask; + + val = ytphy_read_ext(phydev, YT8512_EXTREG_LED0); + if (val < 0) + return val; + + val |= YT8512_LED0_ACT_BLK_IND; + + mask = YT8512_LED0_DIS_LED_AN_TRY | YT8512_LED0_BT_BLK_EN | + YT8512_LED0_HT_BLK_EN | YT8512_LED0_COL_BLK_EN | + YT8512_LED0_BT_ON_EN; + val &= ~mask; + + ret = ytphy_write_ext(phydev, YT8512_EXTREG_LED0, val); + if (ret < 0) + return ret; + + val = ytphy_read_ext(phydev, YT8512_EXTREG_LED1); + if (val < 0) + return val; + + val |= YT8512_LED1_BT_ON_EN; + + mask = YT8512_LED1_TXACT_BLK_EN | YT8512_LED1_RXACT_BLK_EN; + val &= ~mask; + + ret = ytphy_write_ext(phydev, YT8512_LED1_BT_ON_EN, val); + + return ret; +} + +static int yt8512_config_init(struct phy_device *phydev) +{ + int ret; + int val; +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + ret = yt8512_clk_init(phydev); + if (ret < 0) + return ret; + + ret = yt8512_led_init(phydev); + + /* disable auto sleep */ + val = ytphy_read_ext(phydev, YT8512_EXTREG_SLEEP_CONTROL1); + if (val < 0) + return val; + + val &= (~BIT(YT8512_EN_SLEEP_SW_BIT)); + + ret = ytphy_write_ext(phydev, YT8512_EXTREG_SLEEP_CONTROL1, val); + if (ret < 0) + return ret; + + return ret; +} + +static int yt8512_read_status(struct phy_device *phydev) +{ + int ret; + int val; + int speed, speed_mode, duplex; + + ret = genphy_update_link(phydev); + if (ret) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + duplex = (val & YT8512_DUPLEX) >> YT8512_DUPLEX_BIT; + speed_mode = (val & YT8512_SPEED_MODE) >> YT8512_SPEED_MODE_BIT; + switch (speed_mode) { + case 0: + speed = SPEED_10; + break; + case 1: + speed = SPEED_100; + break; + case 2: + case 3: + default: +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + speed = -1; +#else + speed = SPEED_UNKNOWN; +#endif + break; + } + + phydev->speed = speed; + phydev->duplex = duplex; + + return 0; +} +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +#else +#if 0 +int yt8521_soft_reset(struct phy_device *phydev) +{ + int ret; + + ytphy_write_ext(phydev, 0xa000, 0); + ret = genphy_soft_reset(phydev); + if (ret < 0) + return ret; + + ytphy_write_ext(phydev, 0xa000, 2); + ret = genphy_soft_reset(phydev); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); + return ret; + } + + return 0; +} +#else +/* qingsong feedback 2 genphy_soft_reset will cause problem. + * and this is the reduction version + */ +int yt8521_soft_reset(struct phy_device *phydev) +{ + int ret, val; + + val = ytphy_read_ext(phydev, 0xa001); + ytphy_write_ext(phydev, 0xa001, (val & ~0x8000)); + + ret = genphy_soft_reset(phydev); + if (ret < 0) + return ret; + + return 0; +} +#endif + +#endif + +#if GMAC_CLOCK_INPUT_NEEDED +static int ytphy_mii_rd_ext(struct mii_bus *bus, int phy_id, u32 regnum) +{ + int ret; + int val; + + ret = bus->write(bus, phy_id, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + return ret; + + val = bus->read(bus, phy_id, REG_DEBUG_DATA); + + return val; +} + +static int ytphy_mii_wr_ext(struct mii_bus *bus, int phy_id, u32 regnum, u16 val) +{ + int ret; + + ret = bus->write(bus, phy_id, REG_DEBUG_ADDR_OFFSET, regnum); + if (ret < 0) + return ret; + + ret = bus->write(bus, phy_id, REG_DEBUG_DATA, val); + + return ret; +} + +int yt8511_config_dis_txdelay(struct mii_bus *bus, int phy_id) +{ + int ret; + int val; + + /* disable auto sleep */ + val = ytphy_mii_rd_ext(bus, phy_id, 0x27); + if (val < 0) + return val; + + val &= (~BIT(15)); + + ret = ytphy_mii_wr_ext(bus, phy_id, 0x27, val); + if (ret < 0) + return ret; + + /* enable RXC clock when no wire plug */ + val = ytphy_mii_rd_ext(bus, phy_id, 0xc); + if (val < 0) + return val; + + /* ext reg 0xc b[7:4] + Tx Delay time = 150ps * N - 250ps + */ + val &= ~(0xf << 4); + ret = ytphy_mii_wr_ext(bus, phy_id, 0xc, val); + //printk("yt8511_config_dis_txdelay..phy txdelay, val=%#08x\n",val); + + return ret; +} + +int phy_yt8531_led_fixup(struct mii_bus *bus, int addr) +{ + //printk("%s in\n", __func__); + + ytphy_mii_wr_ext(bus, addr, 0xa00d, 0x670); + ytphy_mii_wr_ext(bus, addr, 0xa00e, 0x2070); + ytphy_mii_wr_ext(bus, addr, 0xa00f, 0x7e); + + return 0; +} + +int yt8511_config_out_125m(struct mii_bus *bus, int addr) +{ + int ret; + int val; + + mdelay(100); + ret = ytphy_mii_wr_ext(bus, addr, 0xa012, 0xd0); + + mdelay(100); + val = ytphy_mii_rd_ext(bus, addr, 0xa012); + + if(val != 0xd0) + { + printk("yt8511_config_out_125m error\n"); + return -1; + } + + /* disable auto sleep */ + val = ytphy_mii_rd_ext(bus, addr, 0x27); + if (val < 0) + return val; + + val &= (~BIT(15)); + + ret = ytphy_mii_wr_ext(bus, addr, 0x27, val); + if (ret < 0) + return ret; + + /* enable RXC clock when no wire plug */ + val = ytphy_mii_rd_ext(bus, addr, 0xc); + if (val < 0) + return val; + + /* ext reg 0xc.b[2:1] + 00-----25M from pll; + 01---- 25M from xtl;(default) + 10-----62.5M from pll; + 11----125M from pll(here set to this value) + */ + val |= (3 << 1); + ret = ytphy_mii_wr_ext(bus, addr, 0xc, val); + //printk("yt8511_config_out_125m, phy clk out, val=%#08x\n",val); + +#if 0 + /* for customer, please enable it based on demand. + * configure to master + */ + val = bus->read(bus, phy_id, 0x9/*master/slave config reg*/); + val |= (0x3<<11); //to be manual config and force to be master + ret = bus->write(bus, phy_id, 0x9, val); //take effect until phy soft reset + if (ret < 0) + return ret; + + printk("yt8511_config_out_125m, phy to be master, val=%#08x\n",val); +#endif + + return ret; +} + +EXPORT_SYMBOL(yt8511_config_out_125m); static int yt8511_config_init(struct phy_device *phydev) { - int oldpage, ret = 0; - unsigned int ge, fe; + int ret; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + + return ret; +} +#endif /*GMAC_CLOCK_INPUT_NEEDED*/ + +#if (YTPHY_ENABLE_WOL) +static int ytphy_switch_reg_space(struct phy_device *phydev, int space) +{ + int ret; + + if (space == YTPHY_REG_SPACE_UTP){ + ret = ytphy_write_ext(phydev, 0xa000, 0); + }else{ + ret = ytphy_write_ext(phydev, 0xa000, 2); + } + + return ret; +} + +static int ytphy_wol_en_cfg(struct phy_device *phydev, ytphy_wol_cfg_t wol_cfg) +{ + int ret=0; + int val=0; + + val = ytphy_read_ext(phydev, YTPHY_WOL_CFG_REG); + if (val < 0) + return val; + + if(wol_cfg.enable) { + val |= YTPHY_WOL_CFG_EN; + + if(wol_cfg.type == YTPHY_WOL_TYPE_LEVEL) { + val &= ~YTPHY_WOL_CFG_TYPE; + val &= ~YTPHY_WOL_CFG_INTR_SEL; + } else if(wol_cfg.type == YTPHY_WOL_TYPE_PULSE) { + val |= YTPHY_WOL_CFG_TYPE; + val |= YTPHY_WOL_CFG_INTR_SEL; + + if(wol_cfg.width == YTPHY_WOL_WIDTH_84MS) { + val &= ~YTPHY_WOL_CFG_WIDTH1; + val &= ~YTPHY_WOL_CFG_WIDTH2; + } else if(wol_cfg.width == YTPHY_WOL_WIDTH_168MS) { + val |= YTPHY_WOL_CFG_WIDTH1; + val &= ~YTPHY_WOL_CFG_WIDTH2; + } else if(wol_cfg.width == YTPHY_WOL_WIDTH_336MS) { + val &= ~YTPHY_WOL_CFG_WIDTH1; + val |= YTPHY_WOL_CFG_WIDTH2; + } else if(wol_cfg.width == YTPHY_WOL_WIDTH_672MS) { + val |= YTPHY_WOL_CFG_WIDTH1; + val |= YTPHY_WOL_CFG_WIDTH2; + } + } + } else { + val &= ~YTPHY_WOL_CFG_EN; + val &= ~YTPHY_WOL_CFG_INTR_SEL; + } + + ret = ytphy_write_ext(phydev, YTPHY_WOL_CFG_REG, val); + if (ret < 0) + return ret; + + return 0; +} + +static void ytphy_get_wol(struct phy_device *phydev, struct ethtool_wolinfo *wol) +{ + int val = 0; + + wol->supported = WAKE_MAGIC; + wol->wolopts = 0; + + val = ytphy_read_ext(phydev, YTPHY_WOL_CFG_REG); + if (val < 0) + return; + + if (val & YTPHY_WOL_CFG_EN) + wol->wolopts |= WAKE_MAGIC; + + return; +} + +static int ytphy_set_wol(struct phy_device *phydev, struct ethtool_wolinfo *wol) +{ + int ret, pre_page, val; + ytphy_wol_cfg_t wol_cfg; + struct net_device *p_attached_dev = phydev->attached_dev; + + memset(&wol_cfg,0,sizeof(ytphy_wol_cfg_t)); + pre_page = ytphy_read_ext(phydev, 0xa000); + if (pre_page < 0) + return pre_page; + + /* Switch to phy UTP page */ + ret = ytphy_switch_reg_space(phydev, YTPHY_REG_SPACE_UTP); + if (ret < 0) + return ret; + + if (wol->wolopts & WAKE_MAGIC) { + + /* Enable the WOL interrupt */ + val = phy_read(phydev, YTPHY_UTP_INTR_REG); + val |= YTPHY_WOL_INTR; + ret = phy_write(phydev, YTPHY_UTP_INTR_REG, val); + if (ret < 0) + return ret; + + /* Set the WOL config */ + wol_cfg.enable = 1; //enable + wol_cfg.type= YTPHY_WOL_TYPE_PULSE; + wol_cfg.width= YTPHY_WOL_WIDTH_672MS; + ret = ytphy_wol_en_cfg(phydev, wol_cfg); + if (ret < 0) + return ret; + + /* Store the device address for the magic packet */ + ret = ytphy_write_ext(phydev, YTPHY_MAGIC_PACKET_MAC_ADDR2, + ((p_attached_dev->dev_addr[0] << 8) | + p_attached_dev->dev_addr[1])); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, YTPHY_MAGIC_PACKET_MAC_ADDR1, + ((p_attached_dev->dev_addr[2] << 8) | + p_attached_dev->dev_addr[3])); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, YTPHY_MAGIC_PACKET_MAC_ADDR0, + ((p_attached_dev->dev_addr[4] << 8) | + p_attached_dev->dev_addr[5])); + if (ret < 0) + return ret; + } else { + wol_cfg.enable = 0; //disable + wol_cfg.type= YTPHY_WOL_TYPE_MAX; + wol_cfg.width= YTPHY_WOL_WIDTH_MAX; + ret = ytphy_wol_en_cfg(phydev, wol_cfg); + if (ret < 0) + return ret; + } + + /* Recover to previous register space page */ + ret = ytphy_switch_reg_space(phydev, pre_page); + if (ret < 0) + return ret; + + return 0; +} + +#endif /*(YTPHY_ENABLE_WOL)*/ + +static int yt8521_config_init(struct phy_device *phydev) +{ + int ret; + int val; + + phydev->irq = PHY_POLL; + + ytphy_write_ext(phydev, 0xa000, 0); +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + /* disable auto sleep */ + val = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); + if (val < 0) + return val; + + val &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); + + ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, val); + if (ret < 0) + return ret; - oldpage = phy_select_page(phydev, YT8511_EXT_CLK_GATE); - if (oldpage < 0) - goto err_restore_page; + /* enable RXC clock when no wire plug */ + ret = ytphy_write_ext(phydev, 0xa000, 0); + if (ret < 0) + return ret; + + val = ytphy_read_ext(phydev, 0xc); + if (val < 0) + return val; + val &= ~(1 << 12); + ret = ytphy_write_ext(phydev, 0xc, val); + if (ret < 0) + return ret; - /* set rgmii delay mode */ - switch (phydev->interface) { - case PHY_INTERFACE_MODE_RGMII: - ge = YT8511_DELAY_GE_TX_DIS; - fe = YT8511_DELAY_FE_TX_DIS; + printk (KERN_INFO "yt8521_config_init, 8521 init call out.\n"); + return ret; +} + +/* + * for fiber mode, there is no 10M speed mode and + * this function is for this purpose. + */ +static int yt8521_adjust_status(struct phy_device *phydev, int val, int is_utp) +{ + int speed_mode, duplex; +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + int speed = -1; +#else + int speed = SPEED_UNKNOWN; +#endif + + duplex = (val & YT8512_DUPLEX) >> YT8521_DUPLEX_BIT; + speed_mode = (val & YT8521_SPEED_MODE) >> YT8521_SPEED_MODE_BIT; + switch (speed_mode) { + case 0: + if (is_utp) + speed = SPEED_10; + break; + case 1: + speed = SPEED_100; break; - case PHY_INTERFACE_MODE_RGMII_RXID: - ge = YT8511_DELAY_RX | YT8511_DELAY_GE_TX_DIS; - fe = YT8511_DELAY_FE_TX_DIS; + case 2: + speed = SPEED_1000; break; - case PHY_INTERFACE_MODE_RGMII_TXID: - ge = YT8511_DELAY_GE_TX_EN; - fe = YT8511_DELAY_FE_TX_EN; + case 3: break; - case PHY_INTERFACE_MODE_RGMII_ID: - ge = YT8511_DELAY_RX | YT8511_DELAY_GE_TX_EN; - fe = YT8511_DELAY_FE_TX_EN; + default: +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + speed = -1; +#else + speed = SPEED_UNKNOWN; +#endif break; - default: /* do not support other modes */ - ret = -EOPNOTSUPP; - goto err_restore_page; } - ret = __phy_modify(phydev, YT8511_PAGE, (YT8511_DELAY_RX | YT8511_DELAY_GE_TX_EN), ge); + phydev->speed = speed; + phydev->duplex = duplex; + //printk (KERN_INFO "yt8521_adjust_status call out,regval=0x%04x,mode=%s,speed=%dm...\n", val,is_utp?"utp":"fiber", phydev->speed); + + return 0; +} + +/* + * for fiber mode, when speed is 100M, there is no definition for autonegotiation, and + * this function handles this case and return 1 per linux kernel's polling. + */ +int yt8521_aneg_done (struct phy_device *phydev) +{ + + //printk("yt8521_aneg_done callin,speed=%dm,linkmoded=%d\n", phydev->speed,link_mode_8521); + + if((32 == link_mode_8521) && (SPEED_100 == phydev->speed)) + { + return 1/*link_mode_8521*/; + } + +#if ( LINUX_VERSION_CODE > KERNEL_VERSION(3,11,0) ) + return genphy_aneg_done(phydev); +#else + return 1; +#endif +} + +static int yt8521_read_status(struct phy_device *phydev) +{ + int ret; + volatile int val, yt8521_fiber_latch_val, yt8521_fiber_curr_val; + volatile int link; + int link_utp = 0, link_fiber = 0; + +#if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + /* reading UTP */ + ret = ytphy_write_ext(phydev, 0xa000, 0); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link) { + link_utp = 1; + link_mode_8521 = 1; + yt8521_adjust_status(phydev, val, 1); + } else { + link_utp = 0; + } +#endif //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + +#if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) + /* reading Fiber */ + ret = ytphy_write_ext(phydev, 0xa000, 2); + if (ret < 0) + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + //note: below debug information is used to check multiple PHy ports. + //printk (KERN_INFO "yt8521_read_status, fiber status=%04x,macbase=0x%08lx\n", val,(unsigned long)phydev->attached_dev); + + /* for fiber, from 1000m to 100m, there is not link down from 0x11, and check reg 1 to identify such case + * this is important for Linux kernel for that, missing linkdown event will cause problem. + */ + yt8521_fiber_latch_val = phy_read(phydev, MII_BMSR); + yt8521_fiber_curr_val = phy_read(phydev, MII_BMSR); + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if((link) && (yt8521_fiber_latch_val != yt8521_fiber_curr_val)) + { + link = 0; + printk (KERN_INFO "yt8521_read_status, fiber link down detect,latch=%04x,curr=%04x\n", yt8521_fiber_latch_val,yt8521_fiber_curr_val); + } + + if (link) { + link_fiber = 1; + yt8521_adjust_status(phydev, val, 0); + link_mode_8521 = 32; //fiber mode + + + } else { + link_fiber = 0; + } +#endif //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) + + if (link_utp || link_fiber) { + phydev->link = 1; + } else { + phydev->link = 0; + link_mode_8521 = 0; + } + +#if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + if (link_utp) { + ytphy_write_ext(phydev, 0xa000, 0); + } +#endif + + //printk (KERN_INFO "yzhang..8521 read status call out,link=%d,linkmode=%d\n", phydev->link, link_mode_8521 ); + return 0; +} + +int yt8521_suspend(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_lock(&phydev->lock); +#else + /* no need lock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 2); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 0); + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + +int yt8521_resume(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + int ret; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_lock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + + /* disable auto sleep */ + value = ytphy_read_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1); + if (value < 0) + return value; + + value &= (~BIT(YT8521_EN_SLEEP_SW_BIT)); + ret = ytphy_write_ext(phydev, YT8521_EXTREG_SLEEP_CONTROL1, value); if (ret < 0) - goto err_restore_page; + return ret; + + /* enable RXC clock when no wire plug */ + value = ytphy_read_ext(phydev, 0xc); + if (value < 0) + return value; + value &= ~(1 << 12); + ret = ytphy_write_ext(phydev, 0xc, value); + if (ret < 0) + return ret; + + ytphy_write_ext(phydev, 0xa000, 2); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + +#if (YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + ytphy_write_ext(phydev, 0xa000, 0); +#endif + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +#else +int yt8618_soft_reset(struct phy_device *phydev) +{ + int ret; - /* set clock mode to 125mhz */ - ret = __phy_modify(phydev, YT8511_PAGE, 0, YT8511_CLK_125M); + ytphy_write_ext(phydev, 0xa000, 0); + ret = genphy_soft_reset(phydev); if (ret < 0) - goto err_restore_page; + return ret; - /* fast ethernet delay is in a separate page */ - ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8511_EXT_DELAY_DRIVE); + return 0; +} + +int yt8614_soft_reset(struct phy_device *phydev) +{ + int ret; + + /* utp */ + ytphy_write_ext(phydev, 0xa000, 0); + ret = genphy_soft_reset(phydev); if (ret < 0) - goto err_restore_page; + return ret; + + /* qsgmii */ + ytphy_write_ext(phydev, 0xa000, 2); + ret = genphy_soft_reset(phydev); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); //back to utp mode + return ret; + } + + /* sgmii */ + ytphy_write_ext(phydev, 0xa000, 3); + ret = genphy_soft_reset(phydev); + if (ret < 0) { + ytphy_write_ext(phydev, 0xa000, 0); //back to utp mode + return ret; + } + + return 0; +} + +#endif + +static int yt8618_config_init(struct phy_device *phydev) +{ + int ret; + int val; + + phydev->irq = PHY_POLL; + + if(0xff == yt_mport_base_phy_addr) + /* by default, we think the first phy should be the base phy addr. for mul */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + { + yt_mport_base_phy_addr = phydev->addr; + }else if (yt_mport_base_phy_addr > phydev->addr) { + printk (KERN_INFO "yzhang..8618 init, phy address mismatch, base=%d, cur=%d\n", yt_mport_base_phy_addr, phydev->addr); + } +#else + { + yt_mport_base_phy_addr = phydev->mdio.addr; + }else if (yt_mport_base_phy_addr > phydev->mdio.addr) { + printk (KERN_INFO "yzhang..8618 init, phy address mismatch, base=%d, cur=%d\n", yt_mport_base_phy_addr, phydev->mdio.addr); + } +#endif + + ytphy_write_ext(phydev, 0xa000, 0); +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + ret = ytphy_config_init(phydev); +#else + ret = genphy_config_init(phydev); +#endif + if (ret < 0) + return ret; + + /* for utp to optimize signal */ + ret = ytphy_write_ext(phydev, 0x41, 0x33); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x42, 0x66); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x43, 0xaa); + if (ret < 0) + return ret; + ret = ytphy_write_ext(phydev, 0x44, 0xd0d); + if (ret < 0) + return ret; +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + if((phydev->addr > yt_mport_base_phy_addr) && ((2 == phydev->addr - yt_mport_base_phy_addr) || (5 == phydev->addr - yt_mport_base_phy_addr))) +#else + if((phydev->mdio.addr > yt_mport_base_phy_addr) && ((2 == phydev->mdio.addr - yt_mport_base_phy_addr) || (5 == phydev->mdio.addr - yt_mport_base_phy_addr))) +#endif + { + ret = ytphy_write_ext(phydev, 0x44, 0x2929); + if (ret < 0) + return ret; + } + + val = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, val | BMCR_RESET); + + printk (KERN_INFO "yt8618_config_init call out.\n"); + return ret; +} + +static int yt8614_config_init(struct phy_device *phydev) +{ + int ret = 0; + + phydev->irq = PHY_POLL; - ret = __phy_modify(phydev, YT8511_PAGE, YT8511_DELAY_FE_TX_EN, fe); + if(0xff == yt_mport_base_phy_addr_8614) + /* by default, we think the first phy should be the base phy addr. for mul */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + { + yt_mport_base_phy_addr_8614 = (unsigned int)phydev->addr; + }else if (yt_mport_base_phy_addr_8614 > (unsigned int)phydev->addr) { + printk (KERN_INFO "yzhang..8618 init, phy address mismatch, base=%u, cur=%d\n", yt_mport_base_phy_addr_8614, phydev->addr); + } +#else + { + yt_mport_base_phy_addr_8614 = (unsigned int)phydev->mdio.addr; + }else if (yt_mport_base_phy_addr_8614 > (unsigned int)phydev->mdio.addr) { + printk (KERN_INFO "yzhang..8618 init, phy address mismatch, base=%u, cur=%d\n", yt_mport_base_phy_addr_8614, phydev->mdio.addr); + } +#endif + return ret; +} + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +#define yt8614_get_port_from_phydev(phydev) ((0xff == yt_mport_base_phy_addr_8614) && (yt_mport_base_phy_addr_8614 <= (phydev)->addr) ? 0 : (unsigned int)((phydev)->addr) - yt_mport_base_phy_addr_8614) +#else +#define yt8614_get_port_from_phydev(phydev) ((0xff == yt_mport_base_phy_addr_8614) && (yt_mport_base_phy_addr_8614 <= (phydev)->mdio.addr) ? 0 : (unsigned int)((phydev)->mdio.addr) - yt_mport_base_phy_addr_8614) +#endif + +int yt8618_aneg_done (struct phy_device *phydev) +{ + + return genphy_aneg_done(phydev); +} + +int yt8614_aneg_done (struct phy_device *phydev) +{ + int port = yt8614_get_port_from_phydev(phydev); + + /*it should be used for 8614 fiber*/ + if((32 == link_mode_8614[port]) && (SPEED_100 == phydev->speed)) + { + return 1; + } + + return genphy_aneg_done(phydev); +} + +static int yt8614_read_status(struct phy_device *phydev) +{ + //int i; + int ret; + volatile int val, yt8614_fiber_latch_val, yt8614_fiber_curr_val; + volatile int link; + int link_utp = 0, link_fiber = 0; + int port = yt8614_get_port_from_phydev(phydev); + +#if (YT8614_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + /* switch to utp and reading regs */ + ret = ytphy_write_ext(phydev, 0xa000, 0); if (ret < 0) - goto err_restore_page; + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; - /* leave pll enabled in sleep */ - ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8511_EXT_SLEEP_CTRL); + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link) { + link_utp = 1; + // here is same as 8521 and re-use the function; + yt8521_adjust_status(phydev, val, 1); + } else { + link_utp = 0; + } +#endif //(YT8614_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + +#if (YT8614_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) + /* reading Fiber/sgmii */ + ret = ytphy_write_ext(phydev, 0xa000, 3); if (ret < 0) - goto err_restore_page; + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + //printk (KERN_INFO "yzhang..8614 read fiber status=%04x,macbase=0x%08lx\n", val,(unsigned long)phydev->attached_dev); + + /* for fiber, from 1000m to 100m, there is not link down from 0x11, and check reg 1 to identify such case */ + yt8614_fiber_latch_val = phy_read(phydev, MII_BMSR); + yt8614_fiber_curr_val = phy_read(phydev, MII_BMSR); + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if((link) && (yt8614_fiber_latch_val != yt8614_fiber_curr_val)) + { + link = 0; + printk (KERN_INFO "yt8614_read_status, fiber link down detect,latch=%04x,curr=%04x\n", yt8614_fiber_latch_val,yt8614_fiber_curr_val); + } + + if (link) { + link_fiber = 1; + yt8521_adjust_status(phydev, val, 0); + link_mode_8614[port] = 32; //fiber mode - ret = __phy_modify(phydev, YT8511_PAGE, 0, YT8511_PLLON_SLP); + + } else { + link_fiber = 0; + } +#endif //(YT8521_PHY_MODE_CURR != YT8521_PHY_MODE_UTP) + + if (link_utp || link_fiber) { + phydev->link = 1; + } else { + phydev->link = 0; + link_mode_8614[port] = 0; + } + +#if (YT8614_PHY_MODE_CURR != YT8521_PHY_MODE_FIBER) + if (link_utp) { + ytphy_write_ext(phydev, 0xa000, 0); + } +#endif + //printk (KERN_INFO "yt8614_read_status call out,link=%d,linkmode=%d\n", phydev->link, link_mode_8614[port] ); + + return 0; +} + +static int yt8618_read_status(struct phy_device *phydev) +{ + int ret; + volatile int val; //maybe for 8614 yt8521_fiber_latch_val, yt8521_fiber_curr_val; + volatile int link; + int link_utp = 0, link_fiber = 0; + + /* switch to utp and reading regs */ + ret = ytphy_write_ext(phydev, 0xa000, 0); if (ret < 0) - goto err_restore_page; + return ret; + + val = phy_read(phydev, REG_PHY_SPEC_STATUS); + if (val < 0) + return val; + + link = val & (BIT(YT8521_LINK_STATUS_BIT)); + if (link) { + link_utp = 1; + yt8521_adjust_status(phydev, val, 1); + } else { + link_utp = 0; + } + + if (link_utp || link_fiber) { + phydev->link = 1; + } else { + phydev->link = 0; + } + + return 0; +} + +int yt8618_suspend(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_lock(&phydev->lock); +#else + /* no need lock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} -err_restore_page: - return phy_restore_page(phydev, oldpage, ret); +int yt8618_resume(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_lock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + +int yt8614_suspend(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_lock(&phydev->lock); +#else + /* no need lock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 3); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value | BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 0); + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; } -static struct phy_driver motorcomm_phy_drvs[] = { +int yt8614_resume(struct phy_device *phydev) +{ +#if !(SYS_WAKEUP_BASED_ON_ETH_PKT) + int value; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_lock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif + + ytphy_write_ext(phydev, 0xa000, 0); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 3); + value = phy_read(phydev, MII_BMCR); + phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN); + + ytphy_write_ext(phydev, 0xa000, 0); + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + mutex_unlock(&phydev->lock); +#else + /* no need lock/unlock in 4.19 */ +#endif +#endif /*!(SYS_WAKEUP_BASED_ON_ETH_PKT)*/ + + return 0; +} + + +static struct phy_driver ytphy_drvs[] = { { - PHY_ID_MATCH_EXACT(PHY_ID_YT8511), + .phy_id = PHY_ID_YT8010, + .name = "YT8010 Automotive Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES, + .flags = PHY_HAS_INTERRUPT, +#endif + .config_aneg = yt8010_config_aneg, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + .config_init = ytphy_config_init, +#else + .config_init = genphy_config_init, +#endif + .read_status = genphy_read_status, + }, { + .phy_id = PHY_ID_YT8510, + .name = "YT8510 100/10Mb Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES, + .flags = PHY_HAS_INTERRUPT, +#endif + .config_aneg = genphy_config_aneg, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + .config_init = ytphy_config_init, +#else + .config_init = genphy_config_init, +#endif + .read_status = genphy_read_status, + }, { + .phy_id = PHY_ID_YT8511, .name = "YT8511 Gigabit Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_GBIT_FEATURES, + .flags = PHY_HAS_INTERRUPT, +#endif + .config_aneg = genphy_config_aneg, +#if GMAC_CLOCK_INPUT_NEEDED .config_init = yt8511_config_init, +#else +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + .config_init = ytphy_config_init, +#else + .config_init = genphy_config_init, +#endif +#endif + .read_status = genphy_read_status, + .suspend = genphy_suspend, + .resume = genphy_resume, + }, { + .phy_id = PHY_ID_YT8512, + .name = "YT8512 Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES, + .flags = PHY_HAS_INTERRUPT, +#endif + .config_aneg = genphy_config_aneg, + .config_init = yt8512_config_init, + .read_status = yt8512_read_status, .suspend = genphy_suspend, .resume = genphy_resume, - .read_page = yt8511_read_page, - .write_page = yt8511_write_page, - }, + }, { + .phy_id = PHY_ID_YT8512B, + .name = "YT8512B Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES, + .flags = PHY_HAS_INTERRUPT, +#endif + .config_aneg = genphy_config_aneg, + .config_init = yt8512_config_init, + .read_status = yt8512_read_status, + .suspend = genphy_suspend, + .resume = genphy_resume, + }, { + .phy_id = PHY_ID_YT8521, + .name = "YT8521 Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES | PHY_GBIT_FEATURES, +#endif + .flags = PHY_POLL, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +#else + .soft_reset = yt8521_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if ( LINUX_VERSION_CODE > KERNEL_VERSION(3,11,0) ) + .aneg_done = yt8521_aneg_done, +#endif + .config_init = yt8521_config_init, + .read_status = yt8521_read_status, + .suspend = yt8521_suspend, + .resume = yt8521_resume, +#if (YTPHY_ENABLE_WOL) + .get_wol = &ytphy_get_wol, + .set_wol = &ytphy_set_wol, +#endif + },{ + /* same as 8521 */ + .phy_id = PHY_ID_YT8531S, + .name = "YT8531S Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES | PHY_GBIT_FEATURES, +#endif + .flags = PHY_POLL, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +#else + .soft_reset = yt8521_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if ( LINUX_VERSION_CODE > KERNEL_VERSION(3,11,0) ) + .aneg_done = yt8521_aneg_done, +#endif + .config_init = yt8521_config_init, + .read_status = yt8521_read_status, + .suspend = yt8521_suspend, + .resume = yt8521_resume, +#if (YTPHY_ENABLE_WOL) + .get_wol = &ytphy_get_wol, + .set_wol = &ytphy_set_wol, +#endif + }, { + /* same as 8511 */ + .phy_id = PHY_ID_YT8531, + .name = "YT8531 Gigabit Ethernet", + .phy_id_mask = MOTORCOMM_PHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES | PHY_GBIT_FEATURES, + .flags = PHY_HAS_INTERRUPT, +#endif + .config_aneg = genphy_config_aneg, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) + .config_init = ytphy_config_init, +#else + .config_init = genphy_config_init, +#endif + .read_status = genphy_read_status, + .suspend = genphy_suspend, + .resume = genphy_resume, +#if (YTPHY_ENABLE_WOL) + .get_wol = &ytphy_get_wol, + .set_wol = &ytphy_set_wol, +#endif + }, { + .phy_id = PHY_ID_YT8618, + .name = "YT8618 Ethernet", + .phy_id_mask = MOTORCOMM_MPHY_ID_MASK, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES | PHY_GBIT_FEATURES, +#endif + .flags = PHY_POLL, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +#else + .soft_reset = yt8618_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if ( LINUX_VERSION_CODE > KERNEL_VERSION(3,11,0) ) + .aneg_done = yt8618_aneg_done, +#endif + .config_init = yt8618_config_init, + .read_status = yt8618_read_status, + .suspend = yt8618_suspend, + .resume = yt8618_resume, + }, { + .phy_id = PHY_ID_YT8614, + .name = "YT8614 Ethernet", + .phy_id_mask = MOTORCOMM_MPHY_ID_MASK_8614, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(5,4,0) ) + .features = PHY_BASIC_FEATURES | PHY_GBIT_FEATURES, +#endif + .flags = PHY_POLL, +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +#else + .soft_reset = yt8614_soft_reset, +#endif + .config_aneg = genphy_config_aneg, +#if ( LINUX_VERSION_CODE > KERNEL_VERSION(3,11,0) ) + .aneg_done = yt8614_aneg_done, +#endif + .config_init = yt8614_config_init, + .read_status = yt8614_read_status, + .suspend = yt8614_suspend, + .resume = yt8614_resume, + }, }; -module_phy_driver(motorcomm_phy_drvs); +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) ) +static int ytphy_drivers_register(struct phy_driver* phy_drvs, int size) +{ + int i, j; + int ret; + + for (i = 0; i < size; i++) { + ret = phy_driver_register(&phy_drvs[i]); + if (ret) + goto err; + } + + return 0; + +err: + for (j = 0; j < i; j++) + phy_driver_unregister(&phy_drvs[j]); + + return ret; +} + +static void ytphy_drivers_unregister(struct phy_driver* phy_drvs, int size) +{ + int i; + + for (i = 0; i < size; i++) { + phy_driver_unregister(&phy_drvs[i]); + } +} + +static int __init ytphy_init(void) +{ + printk("motorcomm phy register\n"); + return ytphy_drivers_register(ytphy_drvs, ARRAY_SIZE(ytphy_drvs)); +} + +static void __exit ytphy_exit(void) +{ + printk("motorcomm phy unregister\n"); + ytphy_drivers_unregister(ytphy_drvs, ARRAY_SIZE(ytphy_drvs)); +} + +module_init(ytphy_init); +module_exit(ytphy_exit); +#else +/* for linux 4.x */ +module_phy_driver(ytphy_drvs); +#endif MODULE_DESCRIPTION("Motorcomm PHY driver"); -MODULE_AUTHOR("Peter Geis"); +MODULE_AUTHOR("Leilei Zhao"); MODULE_LICENSE("GPL"); -static const struct mdio_device_id __maybe_unused motorcomm_tbl[] = { - { PHY_ID_MATCH_EXACT(PHY_ID_YT8511) }, - { /* sentinal */ } +static struct mdio_device_id __maybe_unused motorcomm_tbl[] = { + { PHY_ID_YT8010, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8510, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8511, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8512, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8512B, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8521, MOTORCOMM_PHY_ID_MASK }, + { PHY_ID_YT8531S, MOTORCOMM_PHY_ID_8531_MASK }, + { PHY_ID_YT8531, MOTORCOMM_PHY_ID_8531_MASK }, + { PHY_ID_YT8618, MOTORCOMM_MPHY_ID_MASK }, + { PHY_ID_YT8614, MOTORCOMM_MPHY_ID_MASK_8614 }, + { } }; MODULE_DEVICE_TABLE(mdio, motorcomm_tbl); + + diff --git a/drivers/net/phy/yt8614-phy.h b/drivers/net/phy/yt8614-phy.h new file mode 100644 index 000000000..56a398338 --- /dev/null +++ b/drivers/net/phy/yt8614-phy.h @@ -0,0 +1,491 @@ +#ifndef _PHY_H_ +#define _PHY_H_ + + +/* configuration for driver */ + +#define YT8614_MAX_LPORT_ID 3 + +#define YT8614_PHY_MODE_FIBER 1 //fiber mode only +#define YT8614_PHY_MODE_UTP 2 //utp mode only +#define YT8614_PHY_MODE_POLL 3 //fiber and utp, poll mode + +/* please make choice according to system design + * for Fiber only system, please define YT8614_PHY_MODE_CURR 1 + * for UTP only system, please define YT8614_PHY_MODE_CURR 2 + * for combo system, please define YT8614_PHY_MODE_CURR 3 + */ +#define YT8614_PHY_MODE_CURR 3 + + + +/* pls dont modify below lines */ + +#define PHY_ID_YT8614 0x4F51E899 //serdes +#define MOTORCOMM_MPHY_ID_MASK_8614 0xffffffff + +#ifndef BOOL +#define BOOL unsigned int +#endif + +#ifndef FALSE +#define FALSE 0 +#endif + +#ifndef TRUE +#define TRUE 1 +#endif + +#ifndef SPEED_1000M +#define SPEED_1000M 2 +#endif +#ifndef SPEED_100M +#define SPEED_100M 1 +#endif +#ifndef SPEED_10M +#define SPEED_10M 0 +#endif + +#ifndef SPEED_UNKNOWN +#define SPEED_UNKNOWN 0xffff +#endif + +#ifndef DUPLEX_FULL +#define DUPLEX_FULL 1 +#endif +#ifndef DUPLEX_HALF +#define DUPLEX_HALF 0 +#endif + +#ifndef BIT +#define BIT(n) (0x1<<(n)) +#endif +#ifndef s32 +typedef int s32; +typedef unsigned int u32; +typedef unsigned short u16; +typedef unsigned char u8; +#endif + +#ifndef REG_PHY_SPEC_STATUS +#define REG_PHY_SPEC_STATUS 0x11 +#define REG_DEBUG_ADDR_OFFSET 0x1e +#define REG_DEBUG_DATA 0x1f +#endif + +/**********YT8614************************************************/ + +#define YT8614_SMI_SEL_PHY 0x0 +#define YT8614_SMI_SEL_SDS_QSGMII 0x02 +#define YT8614_SMI_SEL_SDS_SGMII 0x03 + +/* yt8614 register type */ +#define YT8614_TYPE_COMMON 0x01 +#define YT8614_TYPE_UTP_MII 0x02 +#define YT8614_TYPE_UTP_EXT 0x03 +#define YT8614_TYPE_LDS_MII 0x04 +#define YT8614_TYPE_UTP_MMD 0x05 +#define YT8614_TYPE_SDS_QSGMII_MII 0x06 +#define YT8614_TYPE_SDS_SGMII_MII 0x07 +#define YT8614_TYPE_SDS_QSGMII_EXT 0x08 +#define YT8614_TYPE_SDS_SGMII_EXT 0x09 + +/* YT8614 extended common register */ +#define YT8614_REG_COM_SMI_MUX 0xA000 +#define YT8614_REG_COM_SLED_CFG0 0xA001 +#define YT8614_REG_COM_PHY_ID 0xA002 +#define YT8614_REG_COM_CHIP_VER 0xA003 +#define YT8614_REG_COM_SLED_CFG 0xA004 +#define YT8614_REG_COM_MODE_CHG_RESET 0xA005 +#define YT8614_REG_COM_SYNCE0_CFG 0xA006 +#define YT8614_REG_COM_CHIP_MODE 0xA007 + +#define YT8614_REG_COM_HIDE_SPEED 0xA009 + +#define YT8614_REG_COM_SYNCE1_CFG 0xA00E + +#define YT8614_REG_COM_HIDE_FIBER_MODE 0xA019 + + +#define YT8614_REG_COM_HIDE_SEL1 0xA054 +#define YT8614_REG_COM_HIDE_LED_CFG2 0xB8 +#define YT8614_REG_COM_HIDE_LED_CFG3 0xB9 +#define YT8614_REG_COM_HIDE_LED_CFG5 0xBB + +#define YT8614_REG_COM_HIDE_LED_CFG4 0xBA //not used currently + +#if 0 +#define YT8614_REG_COM_HIDE_LED12_CFG 0xA060 //not used currently +#define YT8614_REG_COM_HIDE_LED13_CFG 0xA061 +#define YT8614_REG_COM_HIDE_LED14_CFG 0xA062 +#define YT8614_REG_COM_HIDE_LED15_CFG 0xA063 +#define YT8614_REG_COM_HIDE_LED16_CFG 0xA064 +#define YT8614_REG_COM_HIDE_LED17_CFG 0xA065 +#define YT8614_REG_COM_HIDE_LED18_CFG 0xA066 +#define YT8614_REG_COM_HIDE_LED19_CFG 0xA067 +#define YT8614_REG_COM_HIDE_LED20_CFG 0xA068 +#define YT8614_REG_COM_HIDE_LED21_CFG 0xA069 +#define YT8614_REG_COM_HIDE_LED22_CFG 0xA06A +#define YT8614_REG_COM_HIDE_LED23_CFG 0xA06B +#define YT8614_REG_COM_HIDE_LED24_CFG 0xA06C +#define YT8614_REG_COM_HIDE_LED25_CFG 0xA06D +#define YT8614_REG_COM_HIDE_LED26_CFG 0xA06E +#define YT8614_REG_COM_HIDE_LED27_CFG 0xA06F +#endif + +#define YT8614_REG_COM_HIDE_LED28_CFG 0xA070 +#define YT8614_REG_COM_HIDE_LED29_CFG 0xA071 +#define YT8614_REG_COM_HIDE_LED30_CFG 0xA072 +#define YT8614_REG_COM_HIDE_LED31_CFG 0xA073 +#define YT8614_REG_COM_HIDE_LED32_CFG 0xA074 +#define YT8614_REG_COM_HIDE_LED33_CFG 0xA075 +#define YT8614_REG_COM_HIDE_LED34_CFG 0xA076 +#define YT8614_REG_COM_HIDE_LED35_CFG 0xA077 + +#define YT8614_REG_COM_PKG_CFG0 0xA0A0 +#define YT8614_REG_COM_PKG_CFG1 0xA0A1 +#define YT8614_REG_COM_PKG_CFG2 0xA0A2 +#define YT8614_REG_COM_PKG_RX_VALID0 0xA0A3 +#define YT8614_REG_COM_PKG_RX_VALID1 0xA0A4 +#define YT8614_REG_COM_PKG_RX_OS0 0xA0A5 +#define YT8614_REG_COM_PKG_RX_OS1 0xA0A6 +#define YT8614_REG_COM_PKG_RX_US0 0xA0A7 +#define YT8614_REG_COM_PKG_RX_US1 0xA0A8 +#define YT8614_REG_COM_PKG_RX_ERR 0xA0A9 +#define YT8614_REG_COM_PKG_RX_OS_BAD 0xA0AA +#define YT8614_REG_COM_PKG_RX_FRAG 0xA0AB +#define YT8614_REG_COM_PKG_RX_NOSFD 0xA0AC +#define YT8614_REG_COM_PKG_TX_VALID0 0xA0AD +#define YT8614_REG_COM_PKG_TX_VALID1 0xA0AE +#define YT8614_REG_COM_PKG_TX_OS0 0xA0AF + +#define YT8614_REG_COM_PKG_TX_OS1 0xA0B0 +#define YT8614_REG_COM_PKG_TX_US0 0xA0B1 +#define YT8614_REG_COM_PKG_TX_US1 0xA0B2 +#define YT8614_REG_COM_PKG_TX_ERR 0xA0B3 +#define YT8614_REG_COM_PKG_TX_OS_BAD 0xA0B4 +#define YT8614_REG_COM_PKG_TX_FRAG 0xA0B5 +#define YT8614_REG_COM_PKG_TX_NOSFD 0xA0B6 +#define YT8614_REG_COM_PKG_CFG3 0xA0B7 +#define YT8614_REG_COM_PKG_AZ_CFG 0xA0B8 +#define YT8614_REG_COM_PKG_DA_SA_CFG3 0xA0B9 + +#define YT8614_REG_COM_MANU_HW_RESET 0xA0C0 + +/* YT8614 UTP MII register: same as generic phy register definitions */ +#define REG_MII_BMCR 0x00 /* Basic mode control register */ +#define REG_MII_BMSR 0x01 /* Basic mode status register */ +#define REG_MII_PHYSID1 0x02 /* PHYS ID 1 */ +#define REG_MII_PHYSID2 0x03 /* PHYS ID 2 */ +#define REG_MII_ADVERTISE 0x04 /* Advertisement control reg */ +#define REG_MII_LPA 0x05 /* Link partner ability reg */ +#define REG_MII_EXPANSION 0x06 /* Expansion register */ +#define REG_MII_NEXT_PAGE 0x07 /* Next page register */ +#define REG_MII_LPR_NEXT_PAGE 0x08 /* LPR next page register */ +#define REG_MII_CTRL1000 0x09 /* 1000BASE-T control */ +#define REG_MII_STAT1000 0x0A /* 1000BASE-T status */ + +#define REG_MII_MMD_CTRL 0x0D /* MMD access control register */ +#define REG_MII_MMD_DATA 0x0E /* MMD access data register */ + +#define REG_MII_ESTATUS 0x0F /* Extended Status */ +#define REG_MII_SPEC_CTRL 0x10 /* PHY specific func control */ +#define REG_MII_SPEC_STATUS 0x11 /* PHY specific status */ +#define REG_MII_INT_MASK 0x12 /* Interrupt mask register */ +#define REG_MII_INT_STATUS 0x13 /* Interrupt status register */ +#define REG_MII_DOWNG_CTRL 0x14 /* Speed auto downgrade control*/ +#define REG_MII_RERRCOUNTER 0x15 /* Receive error counter */ + +#define REG_MII_EXT_ADDR 0x1E /* Extended reg's address */ +#define REG_MII_EXT_DATA 0x1F /* Extended reg's date */ + +#ifndef MII_BMSR +#define MII_BMSR REG_MII_BMSR +#endif + +#ifndef YT8614_SPEED_MODE_BIT +#define YT8614_SPEED_MODE 0xc000 +#define YT8614_DUPLEX 0x2000 +#define YT8614_SPEED_MODE_BIT 14 +#define YT8614_DUPLEX_BIT 13 +#define YT8614_LINK_STATUS_BIT 10 + +#endif + +#define YT8614_REG_COM_HIDE_SPEED_CMB_PRI 0x2000 + +/* YT8614 UTP MMD register */ +#define YT8614_REG_UTP_MMD_CTRL1 0x00 /* PCS control 1 register */ +#define YT8614_REG_UTP_MMD_STATUS1 0x01 /* PCS status 1 register */ +#define YT8614_REG_UTP_MMD_EEE_CTRL 0x14 /* EEE control and capability */ +#define YT8614_REG_UTP_MMD_EEE_WK_ERR_CNT 0x16 /* EEE wake error counter */ +#define YT8614_REG_UTP_MMD_EEE_LOCAL_ABI 0x3C /* local device EEE ability */ +#define YT8614_REG_UTP_MMD_EEE_LP_ABI 0x3D /* link partner EEE ability */ +#define YT8614_REG_UTP_MMD_EEE_AUTONEG_RES 0x8000 /* autoneg result of EEE */ + +/* YT8614 UTP EXT register */ +#define YT8614_REG_UTP_EXT_LPBK 0x0A +#define YT8614_REG_UTP_EXT_SLEEP_CTRL1 0x27 +#define YT8614_REG_UTP_EXT_DEBUG_MON1 0x5A +#define YT8614_REG_UTP_EXT_DEBUG_MON2 0x5B +#define YT8614_REG_UTP_EXT_DEBUG_MON3 0x5C +#define YT8614_REG_UTP_EXT_DEBUG_MON4 0x5D + +/* YT8614 SDS(1.25G/5G) MII register: same as YT8521S */ +#define REG_SDS_BMCR 0x00 /* Basic mode control register */ +#define REG_SDS_BMSR 0x01 /* Basic mode status register */ +#define REG_SDS_PHYSID1 0x02 /* PHYS ID 1 */ +#define REG_SDS_PHYSID2 0x03 /* PHYS ID 2 */ +#define REG_SDS_ADVERTISE 0x04 /* Advertisement control reg */ +#define REG_SDS_LPA 0x05 /* Link partner ability reg */ +#define REG_SDS_EXPANSION 0x06 /* Expansion register */ +#define REG_SDS_NEXT_PAGE 0x07 /* Next page register */ +#define REG_SDS_LPR_NEXT_PAGE 0x08 /* LPR next page register */ + +#define REG_SDS_ESTATUS 0x0F /* Extended Status */ +#define REG_SDS_SPEC_STATUS 0x11 /* SDS specific status */ + +#define REG_SDS_100FX_CFG 0x14 /* 100fx cfg */ +#define REG_SDS_RERRCOUNTER 0x15 /* Receive error counter */ +#define REG_SDS_LINT_FAIL_CNT 0x16 /* Lint fail counter mon */ + +/* YT8614 SDS(5G) EXT register */ +#define YT8614_REG_QSGMII_EXT_ANA_DIG_CFG 0x02 /* sds analog digital interface cfg */ +#define YT8614_REG_QSGMII_EXT_PRBS_CFG1 0x05 /* sds prbs cfg1 */ +#define YT8614_REG_QSGMII_EXT_PRBS_CFG2_1 0x06 /* sds prbs cfg2 */ +#define YT8614_REG_QSGMII_EXT_PRBS_CFG2_2 0x07 /* sds prbs cfg2 */ +#define YT8614_REG_QSGMII_EXT_PRBS_MON1 0x08 /* sds prbs mon1 */ +#define YT8614_REG_QSGMII_EXT_PRBS_MON2 0x09 /* sds prbs mon2 */ +#define YT8614_REG_QSGMII_EXT_PRBS_MON3 0x0A /* sds prbs mon3 */ +#define YT8614_REG_QSGMII_EXT_PRBS_MON4 0x0B /* sds prbs mon4 */ +#define YT8614_REG_QSGMII_EXT_PRBS_MON5 0x0C /* sds prbs mon5 */ +#define YT8614_REG_QSGMII_EXT_ANA_CFG2 0xA1 /* Analog cfg2 */ + +/* YT8614 SDS(1.25G) EXT register */ +#define YT8614_REG_SGMII_EXT_PRBS_CFG1 0x05 /* sds prbs cfg1 */ +#define YT8614_REG_SGMII_EXT_PRBS_CFG2 0x06 /* sds prbs cfg2 */ +#define YT8614_REG_SGMII_EXT_PRBS_MON1 0x08 /* sds prbs mon1 */ +#define YT8614_REG_SGMII_EXT_PRBS_MON2 0x09 /* sds prbs mon2 */ +#define YT8614_REG_SGMII_EXT_PRBS_MON3 0x0A /* sds prbs mon3 */ +#define YT8614_REG_SGMII_EXT_PRBS_MON4 0x0B /* sds prbs mon4 */ +#define YT8614_REG_SGMII_EXT_PRBS_MON5 0x0C /* sds prbs mon5 */ +#define YT8614_REG_SGMII_EXT_ANA_CFG2 0xA1 /* Analog cfg2 */ +#define YT8614_REG_SGMII_EXT_HIDE_AUTO_SEN 0xA5 /* Fiber auto sensing */ + +//////////////////////////////////////////////////////////////////// +#define YT8614_MMD_DEV_ADDR1 0x1 +#define YT8614_MMD_DEV_ADDR3 0x3 +#define YT8614_MMD_DEV_ADDR7 0x7 +#define YT8614_MMD_DEV_ADDR_NONE 0xFF + +/**********YT8521S************************************************/ +/* Basic mode control register(0x00) */ +#define BMCR_RESV 0x003f /* Unused... */ +#define BMCR_SPEED1000 0x0040 /* MSB of Speed (1000) */ +#define BMCR_CTST 0x0080 /* Collision test */ +#define BMCR_FULLDPLX 0x0100 /* Full duplex */ +#define BMCR_ANRESTART 0x0200 /* Auto negotiation restart */ +#define BMCR_ISOLATE 0x0400 /* Disconnect DP83840 from MII */ +#define BMCR_PDOWN 0x0800 /* Powerdown the DP83840 */ +#define BMCR_ANENABLE 0x1000 /* Enable auto negotiation */ +#define BMCR_SPEED100 0x2000 /* Select 100Mbps */ +#define BMCR_LOOPBACK 0x4000 /* TXD loopback bits */ +#define BMCR_RESET 0x8000 /* Reset the DP83840 */ + +/* Basic mode status register(0x01) */ +#define BMSR_ERCAP 0x0001 /* Ext-reg capability */ +#define BMSR_JCD 0x0002 /* Jabber detected */ +#define BMSR_LSTATUS 0x0004 /* Link status */ +#define BMSR_ANEGCAPABLE 0x0008 /* Able to do auto-negotiation */ +#define BMSR_RFAULT 0x0010 /* Remote fault detected */ +#define BMSR_ANEGCOMPLETE 0x0020 /* Auto-negotiation complete */ +#define BMSR_RESV 0x00c0 /* Unused... */ +#define BMSR_ESTATEN 0x0100 /* Extended Status in R15 */ +#define BMSR_100HALF2 0x0200 /* Can do 100BASE-T2 HDX */ +#define BMSR_100FULL2 0x0400 /* Can do 100BASE-T2 FDX */ +#define BMSR_10HALF 0x0800 /* Can do 10mbps, half-duplex */ +#define BMSR_10FULL 0x1000 /* Can do 10mbps, full-duplex */ +#define BMSR_100HALF 0x2000 /* Can do 100mbps, half-duplex */ +#define BMSR_100FULL 0x4000 /* Can do 100mbps, full-duplex */ +#define BMSR_100BASE4 0x8000 /* Can do 100mbps, 4k packets */ + +/* Advertisement control register(0x04) */ +#define ADVERTISE_SLCT 0x001f /* Selector bits */ +#define ADVERTISE_CSMA 0x0001 /* Only selector supported */ +#define ADVERTISE_10HALF 0x0020 /* Try for 10mbps half-duplex */ +#define ADVERTISE_1000XFULL 0x0020 /* Try for 1000BASE-X full-duplex */ +#define ADVERTISE_10FULL 0x0040 /* Try for 10mbps full-duplex */ +#define ADVERTISE_1000XHALF 0x0040 /* Try for 1000BASE-X half-duplex */ +#define ADVERTISE_100HALF 0x0080 /* Try for 100mbps half-duplex */ +#define ADVERTISE_1000XPAUSE 0x0080 /* Try for 1000BASE-X pause */ +#define ADVERTISE_100FULL 0x0100 /* Try for 100mbps full-duplex */ +#define ADVERTISE_1000XPSE_ASYM 0x0100 /* Try for 1000BASE-X asym pause */ +#define ADVERTISE_100BASE4 0x0200 /* Try for 100mbps 4k packets */ +#define ADVERTISE_PAUSE_CAP 0x0400 /* Try for pause */ +#define ADVERTISE_PAUSE_ASYM 0x0800 /* Try for asymetric pause */ +#define ADVERTISE_RESV 0x1000 /* Unused... */ +#define ADVERTISE_RFAULT 0x2000 /* Say we can detect faults */ +#define ADVERTISE_LPACK 0x4000 /* Ack link partners response */ +#define ADVERTISE_NPAGE 0x8000 /* Next page bit */ + +#define ADVERTISE_FULL (ADVERTISE_100FULL | ADVERTISE_10FULL | ADVERTISE_CSMA) +#define ADVERTISE_ALL (ADVERTISE_10HALF | ADVERTISE_10FULL | \ + ADVERTISE_100HALF | ADVERTISE_100FULL) + +/* Link partner ability register(0x05) */ +#define LPA_SLCT 0x001f /* Same as advertise selector */ +#define LPA_10HALF 0x0020 /* Can do 10mbps half-duplex */ +#define LPA_1000XFULL 0x0020 /* Can do 1000BASE-X full-duplex */ +#define LPA_10FULL 0x0040 /* Can do 10mbps full-duplex */ +#define LPA_1000XHALF 0x0040 /* Can do 1000BASE-X half-duplex */ +#define LPA_100HALF 0x0080 /* Can do 100mbps half-duplex */ +#define LPA_1000XPAUSE 0x0080 /* Can do 1000BASE-X pause */ +#define LPA_100FULL 0x0100 /* Can do 100mbps full-duplex */ +#define LPA_1000XPAUSE_ASYM 0x0100 /* Can do 1000BASE-X pause asym */ +#define LPA_100BASE4 0x0200 /* Can do 100mbps 4k packets */ +#define LPA_PAUSE_CAP 0x0400 /* Can pause */ +#define LPA_PAUSE_ASYM 0x0800 /* Can pause asymetrically */ +#define LPA_RESV 0x1000 /* Unused... */ +#define LPA_RFAULT 0x2000 /* Link partner faulted */ +#define LPA_LPACK 0x4000 /* Link partner acked us */ +#define LPA_NPAGE 0x8000 /* Next page bit */ + +/* 1000BASE-T Control register(0x09) */ +#define ADVERTISE_1000FULL 0x0200 /* Advertise 1000BASE-T full duplex */ +#define ADVERTISE_1000HALF 0x0100 /* Advertise 1000BASE-T half duplex */ +#define CTL1000_AS_MASTER 0x0800 +#define CTL1000_ENABLE_MASTER 0x1000 + +/* 1000BASE-T Status register(0x0A) */ +#define LPA_1000LOCALRXOK 0x2000 /* Link partner local receiver status */ +#define LPA_1000REMRXOK 0x1000 /* Link partner remote receiver status */ +#define LPA_1000FULL 0x0800 /* Link partner 1000BASE-T full duplex */ +#define LPA_1000HALF 0x0400 /* Link partner 1000BASE-T half duplex */ + +/**********YT8614************************************************/ +/* Basic mode control register(0x00) */ +#define FIBER_BMCR_RESV 0x001f /* b[4:0] Unused... */ +#define FIBER_BMCR_EN_UNIDIR 0x0020 /* b[5] Valid when bit 0.12 is zero and bit 0.8 is one */ +#define FIBER_BMCR_SPEED1000 0x0040 /* b[6] MSB of Speed (1000) */ +#define FIBER_BMCR_CTST 0x0080 /* b[7] Collision test */ +#define FIBER_BMCR_DUPLEX_MODE 0x0100 /* b[8] Duplex mode */ +#define FIBER_BMCR_ANRESTART 0x0200 /* b[9] Auto negotiation restart */ +#define FIBER_BMCR_ISOLATE 0x0400 /* b[10] Isolate phy from RGMII/SGMII/FIBER */ +#define FIBER_BMCR_PDOWN 0x0800 /* b[11] 1: Power down */ +#define FIBER_BMCR_ANENABLE 0x1000 /* b[12] Enable auto negotiation */ +#define FIBER_BMCR_SPEED100 0x2000 /* b[13] LSB of Speed (100) */ +#define FIBER_BMCR_LOOPBACK 0x4000 /* b[14] Internal loopback control */ +#define FIBER_BMCR_RESET 0x8000 /* b[15] PHY Software Reset(self-clear) */ + +/* Sds specific status register(0x11) */ +#define FIBER_SSR_ERCAP 0x0001 /* b[0] realtime syncstatus */ +#define FIBER_SSR_XMIT 0x000E /* b[3:1] realtime transmit statemachine. + 001: Xmit Idle; + 010: Xmit Config; + 100: Xmit Data. */ +#define FIBER_SSR_SER_MODE_CFG 0x0030 /* b[5:4] realtime serdes working mode. + 00: SG_MAC; + 01: SG_PHY; + 10: FIB_1000; + 11: FIB_100. */ +#define FIBER_SSR_EN_FLOWCTRL_TX 0x0040 /* b[6] realtime en_flowctrl_tx */ +#define FIBER_SSR_EN_FLOWCTRL_RX 0x0080 /* b[7] realtime en_flowctrl_rx */ +#define FIBER_SSR_DUPLEX_ERROR 0x0100 /* b[8] realtime deplex error */ +#define FIBER_SSR_RX_LPI_ACTIVE 0x0200 /* b[9] rx lpi is active */ +#define FIBER_SSR_LSTATUS 0x0400 /* b[10] Link status real-time */ +#define FIBER_SSR_PAUSE 0x1800 /* b[12:11] Pause to mac */ +#define FIBER_SSR_DUPLEX 0x2000 /* b[13] This status bit is valid only when bit10 is 1. + 1: full duplex + 0: half duplex */ +#define FIBER_SSR_SPEED_MODE 0xC000 /* b[15:14] These status bits are valid only when bit10 is 1. + 10---1000M + 01---100M */ + +/* SLED cfg0 (ext 0xA001) */ +#define FIBER_SLED_CFG0_EN_CTRL 0x00FF /* b[7:0] Control to enable the eight ports' SLED */ +#define FIBER_SLED_CFG0_BIT_MASK 0x0700 /* b[10:8] 1: enable the pin output */ +#define FIBER_SLED_CFG0_ACT_LOW 0x0800 /* b[11] control SLED's polarity. 1: active low; 0: active high */ +#define FIBER_SLED_CFG0_MANU_ST 0x7000 /* b[14:12] SLEDs' manul status, corresponding to each port's 3 SLEDs */ +#define FIBER_SLED_CFG0_MANU_EN 0x8000 /* b[15] to control serial LEDs status manually */ + +/**********YT8614************************************************/ +/* Fiber auto sensing(sgmii ext 0xA5) */ +#define FIBER_AUTO_SEN_ENABLE 0x8000 /* b[15] Enable fiber auto sensing */ + +/* Fiber force speed(common ext 0xA009) */ +#define FIBER_FORCE_1000M 0x0001 /* b[0] 1:1000BX 0:100FX */ + +#ifndef NULL +#define NULL 0 +#endif + +/* errno */ +enum ytphy_8614_errno_e +{ + SYS_E_NONE, + SYS_E_PARAM, + SYS_E_MAX +}; + +/* errno */ +enum ytphy_8614_combo_speed_e +{ + YT8614_COMBO_FIBER_1000M, + YT8614_COMBO_FIBER_100M, + YT8614_COMBO_UTP_ONLY, + YT8614_COMBO_SPEED_MAX +}; + +/* definition for porting */ +/* phy registers access */ +typedef struct +{ + u16 reg; /* the offset of the phy internal address */ + u16 val; /* the value of the register */ + u8 regType; /* register type */ +} phy_data_s; + +/* for porting use. + * pls over-write member function read/write for mdio access + */ +typedef struct phy_info_str +{ +#if 0 + struct phy_device *phydev; + int mdio_base; +#endif + unsigned int lport; + unsigned int bus_id; + unsigned int phy_addr; + + s32 (*read)(struct phy_info_str *info, phy_data_s *param); + s32 (*write)(struct phy_info_str *info, phy_data_s *param); +}phy_info_s; + +/* get phy access method */ +s32 yt8614_read_reg(struct phy_info_str *info, phy_data_s *param); +s32 yt8614_write_reg(struct phy_info_str *info, phy_data_s *param); +s32 yt8614_phy_soft_reset(u32 lport); +s32 yt8614_phy_init(u32 lport); +s32 yt8614_fiber_enable(u32 lport, BOOL enable); +s32 yt8614_utp_enable(u32 lport, BOOL enable); +s32 yt8614_fiber_unidirection_set(u32 lport, int speed, BOOL enable); +s32 yt8614_fiber_autosensing_set(u32 lport, BOOL enable); +s32 yt8614_fiber_speed_set(u32 lport, int fiber_speed); +s32 yt8614_qsgmii_autoneg_set(u32 lport, BOOL enable); +s32 yt8614_sgmii_autoneg_set(u32 lport, BOOL enable); +s32 yt8614_qsgmii_sgmii_link_status_get(u32 lport, BOOL *enable, BOOL if_qsgmii); +int yt8614_combo_media_priority_set (u32 lport, int fiber); +int yt8614_combo_media_priority_get (u32 lport, int *fiber); +s32 yt8614_utp_autoneg_set(u32 lport, BOOL enable); +s32 yt8614_utp_autoneg_get(u32 lport, BOOL *enable); +s32 yt8614_utp_autoneg_ability_set(u32 lport, unsigned int cap_mask); +s32 yt8614_utp_autoneg_ability_get(u32 lport, unsigned int *cap_mask); +s32 yt8614_utp_force_duplex_set(u32 lport, BOOL full); +s32 yt8614_utp_force_duplex_get(u32 lport, BOOL *full); +s32 yt8614_utp_force_speed_set(u32 lport, unsigned int speed); +s32 yt8614_utp_force_speed_get(u32 lport, unsigned int *speed); +int yt8614_autoneg_done_get (u32 lport, int speed, int *aneg); +int yt8614_media_status_get(u32 lport, int* speed, int* duplex, int* ret_link, int *media); + +#endif diff --git a/include/linux/motorcomm_phy.h b/include/linux/motorcomm_phy.h new file mode 100644 index 000000000..9e01fc205 --- /dev/null +++ b/include/linux/motorcomm_phy.h @@ -0,0 +1,119 @@ +/* + * include/linux/motorcomm_phy.h + * + * Motorcomm PHY IDs + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License as published by the + * Free Software Foundation; either version 2 of the License, or (at your + * option) any later version. + * + */ + +#ifndef _MOTORCOMM_PHY_H +#define _MOTORCOMM_PHY_H + +#define MOTORCOMM_PHY_ID_MASK 0x00000fff +#define MOTORCOMM_PHY_ID_8531_MASK 0xffffffff +#define MOTORCOMM_MPHY_ID_MASK 0x0000ffff + +#define PHY_ID_YT8010 0x00000309 +#define PHY_ID_YT8510 0x00000109 +#define PHY_ID_YT8511 0x0000010a +#define PHY_ID_YT8512 0x00000118 +#define PHY_ID_YT8512B 0x00000128 +#define PHY_ID_YT8521 0x0000011a +#define PHY_ID_YT8531S 0x4f51e91a +#define PHY_ID_YT8531 0x4f51e91b +//#define PHY_ID_YT8614 0x0000e899 +#define PHY_ID_YT8618 0x0000e889 + +#define REG_PHY_SPEC_STATUS 0x11 +#define REG_DEBUG_ADDR_OFFSET 0x1e +#define REG_DEBUG_DATA 0x1f + +#define YT8512_EXTREG_AFE_PLL 0x50 +#define YT8512_EXTREG_EXTEND_COMBO 0x4000 +#define YT8512_EXTREG_LED0 0x40c0 +#define YT8512_EXTREG_LED1 0x40c3 + +#define YT8512_EXTREG_SLEEP_CONTROL1 0x2027 + +#define YT_SOFTWARE_RESET 0x8000 + +#define YT8512_CONFIG_PLL_REFCLK_SEL_EN 0x0040 +#define YT8512_CONTROL1_RMII_EN 0x0001 +#define YT8512_LED0_ACT_BLK_IND 0x1000 +#define YT8512_LED0_DIS_LED_AN_TRY 0x0001 +#define YT8512_LED0_BT_BLK_EN 0x0002 +#define YT8512_LED0_HT_BLK_EN 0x0004 +#define YT8512_LED0_COL_BLK_EN 0x0008 +#define YT8512_LED0_BT_ON_EN 0x0010 +#define YT8512_LED1_BT_ON_EN 0x0010 +#define YT8512_LED1_TXACT_BLK_EN 0x0100 +#define YT8512_LED1_RXACT_BLK_EN 0x0200 +#define YT8512_SPEED_MODE 0xc000 +#define YT8512_DUPLEX 0x2000 + +#define YT8512_SPEED_MODE_BIT 14 +#define YT8512_DUPLEX_BIT 13 +#define YT8512_EN_SLEEP_SW_BIT 15 + +#define YT8521_EXTREG_SLEEP_CONTROL1 0x27 +#define YT8521_EN_SLEEP_SW_BIT 15 + +#define YT8521_SPEED_MODE 0xc000 +#define YT8521_DUPLEX 0x2000 +#define YT8521_SPEED_MODE_BIT 14 +#define YT8521_DUPLEX_BIT 13 +#define YT8521_LINK_STATUS_BIT 10 + +/* based on yt8521 wol config register */ +#define YTPHY_UTP_INTR_REG 0x12 +/* WOL Event Interrupt Enable */ +#define YTPHY_WOL_INTR BIT(6) + +/* Magic Packet MAC address registers */ +#define YTPHY_MAGIC_PACKET_MAC_ADDR2 0xa007 +#define YTPHY_MAGIC_PACKET_MAC_ADDR1 0xa008 +#define YTPHY_MAGIC_PACKET_MAC_ADDR0 0xa009 + +#define YTPHY_WOL_CFG_REG 0xa00a +#define YTPHY_WOL_CFG_TYPE BIT(0) /* WOL TYPE */ +#define YTPHY_WOL_CFG_EN BIT(3) /* WOL Enable */ +#define YTPHY_WOL_CFG_INTR_SEL BIT(6) /* WOL Event Interrupt Enable */ +#define YTPHY_WOL_CFG_WIDTH1 BIT(1) /* WOL Pulse Width */ +#define YTPHY_WOL_CFG_WIDTH2 BIT(2) + +#define YTPHY_REG_SPACE_UTP 0 +#define YTPHY_REG_SPACE_FIBER 2 + +enum ytphy_wol_type_e +{ + YTPHY_WOL_TYPE_LEVEL, + YTPHY_WOL_TYPE_PULSE, + YTPHY_WOL_TYPE_MAX +}; +typedef enum ytphy_wol_type_e ytphy_wol_type_t; + +enum ytphy_wol_width_e +{ + YTPHY_WOL_WIDTH_84MS, + YTPHY_WOL_WIDTH_168MS, + YTPHY_WOL_WIDTH_336MS, + YTPHY_WOL_WIDTH_672MS, + YTPHY_WOL_WIDTH_MAX +}; +typedef enum ytphy_wol_width_e ytphy_wol_width_t; + +struct ytphy_wol_cfg_s +{ + int enable; + int type; + int width; +}; +typedef struct ytphy_wol_cfg_s ytphy_wol_cfg_t; + +#endif /* _MOTORCOMM_PHY_H */ + + -- 2.25.1