392 lines
9.3 KiB
C
392 lines
9.3 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* Microchip LAN937X switch driver main logic
|
|
* Copyright (C) 2019-2022 Microchip Technology Inc.
|
|
*/
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/iopoll.h>
|
|
#include <linux/phy.h>
|
|
#include <linux/of_net.h>
|
|
#include <linux/if_bridge.h>
|
|
#include <linux/if_vlan.h>
|
|
#include <linux/math.h>
|
|
#include <net/dsa.h>
|
|
#include <net/switchdev.h>
|
|
|
|
#include "lan937x_reg.h"
|
|
#include "ksz_common.h"
|
|
#include "lan937x.h"
|
|
|
|
static int lan937x_cfg(struct ksz_device *dev, u32 addr, u8 bits, bool set)
|
|
{
|
|
return regmap_update_bits(dev->regmap[0], addr, bits, set ? bits : 0);
|
|
}
|
|
|
|
static int lan937x_port_cfg(struct ksz_device *dev, int port, int offset,
|
|
u8 bits, bool set)
|
|
{
|
|
return regmap_update_bits(dev->regmap[0], PORT_CTRL_ADDR(port, offset),
|
|
bits, set ? bits : 0);
|
|
}
|
|
|
|
static int lan937x_enable_spi_indirect_access(struct ksz_device *dev)
|
|
{
|
|
u16 data16;
|
|
int ret;
|
|
|
|
/* Enable Phy access through SPI */
|
|
ret = lan937x_cfg(dev, REG_GLOBAL_CTRL_0, SW_PHY_REG_BLOCK, false);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = ksz_read16(dev, REG_VPHY_SPECIAL_CTRL__2, &data16);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Allow SPI access */
|
|
data16 |= VPHY_SPI_INDIRECT_ENABLE;
|
|
|
|
return ksz_write16(dev, REG_VPHY_SPECIAL_CTRL__2, data16);
|
|
}
|
|
|
|
static int lan937x_vphy_ind_addr_wr(struct ksz_device *dev, int addr, int reg)
|
|
{
|
|
u16 addr_base = REG_PORT_T1_PHY_CTRL_BASE;
|
|
u16 temp;
|
|
|
|
/* get register address based on the logical port */
|
|
temp = PORT_CTRL_ADDR(addr, (addr_base + (reg << 2)));
|
|
|
|
return ksz_write16(dev, REG_VPHY_IND_ADDR__2, temp);
|
|
}
|
|
|
|
static int lan937x_internal_phy_write(struct ksz_device *dev, int addr, int reg,
|
|
u16 val)
|
|
{
|
|
unsigned int value;
|
|
int ret;
|
|
|
|
/* Check for internal phy port */
|
|
if (!dev->info->internal_phy[addr])
|
|
return -EOPNOTSUPP;
|
|
|
|
ret = lan937x_vphy_ind_addr_wr(dev, addr, reg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Write the data to be written to the VPHY reg */
|
|
ret = ksz_write16(dev, REG_VPHY_IND_DATA__2, val);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Write the Write En and Busy bit */
|
|
ret = ksz_write16(dev, REG_VPHY_IND_CTRL__2,
|
|
(VPHY_IND_WRITE | VPHY_IND_BUSY));
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_read_poll_timeout(dev->regmap[1], REG_VPHY_IND_CTRL__2,
|
|
value, !(value & VPHY_IND_BUSY), 10,
|
|
1000);
|
|
if (ret < 0) {
|
|
dev_err(dev->dev, "Failed to write phy register\n");
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int lan937x_internal_phy_read(struct ksz_device *dev, int addr, int reg,
|
|
u16 *val)
|
|
{
|
|
unsigned int value;
|
|
int ret;
|
|
|
|
/* Check for internal phy port, return 0xffff for non-existent phy */
|
|
if (!dev->info->internal_phy[addr])
|
|
return 0xffff;
|
|
|
|
ret = lan937x_vphy_ind_addr_wr(dev, addr, reg);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Write Read and Busy bit to start the transaction */
|
|
ret = ksz_write16(dev, REG_VPHY_IND_CTRL__2, VPHY_IND_BUSY);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_read_poll_timeout(dev->regmap[1], REG_VPHY_IND_CTRL__2,
|
|
value, !(value & VPHY_IND_BUSY), 10,
|
|
1000);
|
|
if (ret < 0) {
|
|
dev_err(dev->dev, "Failed to read phy register\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Read the VPHY register which has the PHY data */
|
|
return ksz_read16(dev, REG_VPHY_IND_DATA__2, val);
|
|
}
|
|
|
|
int lan937x_r_phy(struct ksz_device *dev, u16 addr, u16 reg, u16 *data)
|
|
{
|
|
return lan937x_internal_phy_read(dev, addr, reg, data);
|
|
}
|
|
|
|
int lan937x_w_phy(struct ksz_device *dev, u16 addr, u16 reg, u16 val)
|
|
{
|
|
return lan937x_internal_phy_write(dev, addr, reg, val);
|
|
}
|
|
|
|
int lan937x_reset_switch(struct ksz_device *dev)
|
|
{
|
|
u32 data32;
|
|
int ret;
|
|
|
|
/* reset switch */
|
|
ret = lan937x_cfg(dev, REG_SW_OPERATION, SW_RESET, true);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Enable Auto Aging */
|
|
ret = lan937x_cfg(dev, REG_SW_LUE_CTRL_1, SW_LINK_AUTO_AGING, true);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* disable interrupts */
|
|
ret = ksz_write32(dev, REG_SW_INT_MASK__4, SWITCH_INT_MASK);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = ksz_write32(dev, REG_SW_INT_STATUS__4, POR_READY_INT);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = ksz_write32(dev, REG_SW_PORT_INT_MASK__4, 0xFF);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ksz_read32(dev, REG_SW_PORT_INT_STATUS__4, &data32);
|
|
}
|
|
|
|
void lan937x_port_setup(struct ksz_device *dev, int port, bool cpu_port)
|
|
{
|
|
const u32 *masks = dev->info->masks;
|
|
const u16 *regs = dev->info->regs;
|
|
struct dsa_switch *ds = dev->ds;
|
|
u8 member;
|
|
|
|
/* enable tag tail for host port */
|
|
if (cpu_port)
|
|
lan937x_port_cfg(dev, port, REG_PORT_CTRL_0,
|
|
PORT_TAIL_TAG_ENABLE, true);
|
|
|
|
/* set back pressure for half duplex */
|
|
lan937x_port_cfg(dev, port, REG_PORT_MAC_CTRL_1, PORT_BACK_PRESSURE,
|
|
true);
|
|
|
|
/* enable 802.1p priority */
|
|
lan937x_port_cfg(dev, port, P_PRIO_CTRL, PORT_802_1P_PRIO_ENABLE, true);
|
|
|
|
if (!dev->info->internal_phy[port])
|
|
lan937x_port_cfg(dev, port, regs[P_XMII_CTRL_0],
|
|
masks[P_MII_TX_FLOW_CTRL] |
|
|
masks[P_MII_RX_FLOW_CTRL],
|
|
true);
|
|
|
|
if (cpu_port)
|
|
member = dsa_user_ports(ds);
|
|
else
|
|
member = BIT(dsa_upstream_port(ds, port));
|
|
|
|
dev->dev_ops->cfg_port_member(dev, port, member);
|
|
}
|
|
|
|
void lan937x_config_cpu_port(struct dsa_switch *ds)
|
|
{
|
|
struct ksz_device *dev = ds->priv;
|
|
struct dsa_port *dp;
|
|
|
|
dsa_switch_for_each_cpu_port(dp, ds) {
|
|
if (dev->info->cpu_ports & (1 << dp->index)) {
|
|
dev->cpu_port = dp->index;
|
|
|
|
/* enable cpu port */
|
|
lan937x_port_setup(dev, dp->index, true);
|
|
}
|
|
}
|
|
|
|
dsa_switch_for_each_user_port(dp, ds) {
|
|
ksz_port_stp_state_set(ds, dp->index, BR_STATE_DISABLED);
|
|
}
|
|
}
|
|
|
|
int lan937x_change_mtu(struct ksz_device *dev, int port, int new_mtu)
|
|
{
|
|
struct dsa_switch *ds = dev->ds;
|
|
int ret;
|
|
|
|
new_mtu += VLAN_ETH_HLEN + ETH_FCS_LEN;
|
|
|
|
if (dsa_is_cpu_port(ds, port))
|
|
new_mtu += LAN937X_TAG_LEN;
|
|
|
|
if (new_mtu >= FR_MIN_SIZE)
|
|
ret = lan937x_port_cfg(dev, port, REG_PORT_MAC_CTRL_0,
|
|
PORT_JUMBO_PACKET, true);
|
|
else
|
|
ret = lan937x_port_cfg(dev, port, REG_PORT_MAC_CTRL_0,
|
|
PORT_JUMBO_PACKET, false);
|
|
if (ret < 0) {
|
|
dev_err(ds->dev, "failed to enable jumbo\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Write the frame size in PORT_MAX_FR_SIZE register */
|
|
ksz_pwrite16(dev, port, PORT_MAX_FR_SIZE, new_mtu);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int lan937x_set_ageing_time(struct ksz_device *dev, unsigned int msecs)
|
|
{
|
|
u32 secs = msecs / 1000;
|
|
u32 value;
|
|
int ret;
|
|
|
|
value = FIELD_GET(SW_AGE_PERIOD_7_0_M, secs);
|
|
|
|
ret = ksz_write8(dev, REG_SW_AGE_PERIOD__1, value);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
value = FIELD_GET(SW_AGE_PERIOD_19_8_M, secs);
|
|
|
|
return ksz_write16(dev, REG_SW_AGE_PERIOD__2, value);
|
|
}
|
|
|
|
static void lan937x_set_tune_adj(struct ksz_device *dev, int port,
|
|
u16 reg, u8 val)
|
|
{
|
|
u16 data16;
|
|
|
|
ksz_pread16(dev, port, reg, &data16);
|
|
|
|
/* Update tune Adjust */
|
|
data16 |= FIELD_PREP(PORT_TUNE_ADJ, val);
|
|
ksz_pwrite16(dev, port, reg, data16);
|
|
|
|
/* write DLL reset to take effect */
|
|
data16 |= PORT_DLL_RESET;
|
|
ksz_pwrite16(dev, port, reg, data16);
|
|
}
|
|
|
|
static void lan937x_set_rgmii_tx_delay(struct ksz_device *dev, int port)
|
|
{
|
|
u8 val;
|
|
|
|
/* Apply different codes based on the ports as per characterization
|
|
* results
|
|
*/
|
|
val = (port == LAN937X_RGMII_1_PORT) ? RGMII_1_TX_DELAY_2NS :
|
|
RGMII_2_TX_DELAY_2NS;
|
|
|
|
lan937x_set_tune_adj(dev, port, REG_PORT_XMII_CTRL_5, val);
|
|
}
|
|
|
|
static void lan937x_set_rgmii_rx_delay(struct ksz_device *dev, int port)
|
|
{
|
|
u8 val;
|
|
|
|
val = (port == LAN937X_RGMII_1_PORT) ? RGMII_1_RX_DELAY_2NS :
|
|
RGMII_2_RX_DELAY_2NS;
|
|
|
|
lan937x_set_tune_adj(dev, port, REG_PORT_XMII_CTRL_4, val);
|
|
}
|
|
|
|
void lan937x_phylink_get_caps(struct ksz_device *dev, int port,
|
|
struct phylink_config *config)
|
|
{
|
|
config->mac_capabilities = MAC_100FD;
|
|
|
|
if (dev->info->supports_rgmii[port]) {
|
|
/* MII/RMII/RGMII ports */
|
|
config->mac_capabilities |= MAC_ASYM_PAUSE | MAC_SYM_PAUSE |
|
|
MAC_100HD | MAC_10 | MAC_1000FD;
|
|
}
|
|
}
|
|
|
|
void lan937x_setup_rgmii_delay(struct ksz_device *dev, int port)
|
|
{
|
|
struct ksz_port *p = &dev->ports[port];
|
|
|
|
if (p->rgmii_tx_val) {
|
|
lan937x_set_rgmii_tx_delay(dev, port);
|
|
dev_info(dev->dev, "Applied rgmii tx delay for the port %d\n",
|
|
port);
|
|
}
|
|
|
|
if (p->rgmii_rx_val) {
|
|
lan937x_set_rgmii_rx_delay(dev, port);
|
|
dev_info(dev->dev, "Applied rgmii rx delay for the port %d\n",
|
|
port);
|
|
}
|
|
}
|
|
|
|
int lan937x_switch_init(struct ksz_device *dev)
|
|
{
|
|
dev->port_mask = (1 << dev->info->port_cnt) - 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int lan937x_setup(struct dsa_switch *ds)
|
|
{
|
|
struct ksz_device *dev = ds->priv;
|
|
int ret;
|
|
|
|
/* enable Indirect Access from SPI to the VPHY registers */
|
|
ret = lan937x_enable_spi_indirect_access(dev);
|
|
if (ret < 0) {
|
|
dev_err(dev->dev, "failed to enable spi indirect access");
|
|
return ret;
|
|
}
|
|
|
|
/* The VLAN aware is a global setting. Mixed vlan
|
|
* filterings are not supported.
|
|
*/
|
|
ds->vlan_filtering_is_global = true;
|
|
|
|
/* Enable aggressive back off for half duplex & UNH mode */
|
|
lan937x_cfg(dev, REG_SW_MAC_CTRL_0,
|
|
(SW_PAUSE_UNH_MODE | SW_NEW_BACKOFF | SW_AGGR_BACKOFF),
|
|
true);
|
|
|
|
/* If NO_EXC_COLLISION_DROP bit is set, the switch will not drop
|
|
* packets when 16 or more collisions occur
|
|
*/
|
|
lan937x_cfg(dev, REG_SW_MAC_CTRL_1, NO_EXC_COLLISION_DROP, true);
|
|
|
|
/* enable global MIB counter freeze function */
|
|
lan937x_cfg(dev, REG_SW_MAC_CTRL_6, SW_MIB_COUNTER_FREEZE, true);
|
|
|
|
/* disable CLK125 & CLK25, 1: disable, 0: enable */
|
|
lan937x_cfg(dev, REG_SW_GLOBAL_OUTPUT_CTRL__1,
|
|
(SW_CLK125_ENB | SW_CLK25_ENB), true);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void lan937x_teardown(struct dsa_switch *ds)
|
|
{
|
|
|
|
}
|
|
|
|
void lan937x_switch_exit(struct ksz_device *dev)
|
|
{
|
|
lan937x_reset_switch(dev);
|
|
}
|
|
|
|
MODULE_AUTHOR("Arun Ramadoss <arun.ramadoss@microchip.com>");
|
|
MODULE_DESCRIPTION("Microchip LAN937x Series Switch DSA Driver");
|
|
MODULE_LICENSE("GPL");
|