984 lines
22 KiB
C
984 lines
22 KiB
C
/*
|
|
* Marvell 88E6xxx Switch Global 2 Registers support (device address
|
|
* 0x1C)
|
|
*
|
|
* Copyright (c) 2008 Marvell Semiconductor
|
|
*
|
|
* Copyright (c) 2016 Vivien Didelot <vivien.didelot@savoirfairelinux.com>
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <linux/irqdomain.h>
|
|
#include "mv88e6xxx.h"
|
|
#include "global2.h"
|
|
|
|
#define ADDR_GLOBAL2 0x1c
|
|
|
|
static int mv88e6xxx_g2_read(struct mv88e6xxx_chip *chip, int reg, u16 *val)
|
|
{
|
|
return mv88e6xxx_read(chip, ADDR_GLOBAL2, reg, val);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_write(struct mv88e6xxx_chip *chip, int reg, u16 val)
|
|
{
|
|
return mv88e6xxx_write(chip, ADDR_GLOBAL2, reg, val);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_update(struct mv88e6xxx_chip *chip, int reg, u16 update)
|
|
{
|
|
return mv88e6xxx_update(chip, ADDR_GLOBAL2, reg, update);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_wait(struct mv88e6xxx_chip *chip, int reg, u16 mask)
|
|
{
|
|
return mv88e6xxx_wait(chip, ADDR_GLOBAL2, reg, mask);
|
|
}
|
|
|
|
/* Offset 0x02: Management Enable 2x */
|
|
/* Offset 0x03: Management Enable 0x */
|
|
|
|
int mv88e6095_g2_mgmt_rsvd2cpu(struct mv88e6xxx_chip *chip)
|
|
{
|
|
int err;
|
|
|
|
/* Consider the frames with reserved multicast destination
|
|
* addresses matching 01:80:c2:00:00:2x as MGMT.
|
|
*/
|
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_MGMT_EN_2X)) {
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_MGMT_EN_2X, 0xffff);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
/* Consider the frames with reserved multicast destination
|
|
* addresses matching 01:80:c2:00:00:0x as MGMT.
|
|
*/
|
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_MGMT_EN_0X))
|
|
return mv88e6xxx_g2_write(chip, GLOBAL2_MGMT_EN_0X, 0xffff);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Offset 0x06: Device Mapping Table register */
|
|
|
|
static int mv88e6xxx_g2_device_mapping_write(struct mv88e6xxx_chip *chip,
|
|
int target, int port)
|
|
{
|
|
u16 val = (target << 8) | (port & 0xf);
|
|
|
|
return mv88e6xxx_g2_update(chip, GLOBAL2_DEVICE_MAPPING, val);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_set_device_mapping(struct mv88e6xxx_chip *chip)
|
|
{
|
|
int target, port;
|
|
int err;
|
|
|
|
/* Initialize the routing port to the 32 possible target devices */
|
|
for (target = 0; target < 32; ++target) {
|
|
port = 0xf;
|
|
|
|
if (target < DSA_MAX_SWITCHES) {
|
|
port = chip->ds->rtable[target];
|
|
if (port == DSA_RTABLE_NONE)
|
|
port = 0xf;
|
|
}
|
|
|
|
err = mv88e6xxx_g2_device_mapping_write(chip, target, port);
|
|
if (err)
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
/* Offset 0x07: Trunk Mask Table register */
|
|
|
|
static int mv88e6xxx_g2_trunk_mask_write(struct mv88e6xxx_chip *chip, int num,
|
|
bool hask, u16 mask)
|
|
{
|
|
const u16 port_mask = BIT(mv88e6xxx_num_ports(chip)) - 1;
|
|
u16 val = (num << 12) | (mask & port_mask);
|
|
|
|
if (hask)
|
|
val |= GLOBAL2_TRUNK_MASK_HASK;
|
|
|
|
return mv88e6xxx_g2_update(chip, GLOBAL2_TRUNK_MASK, val);
|
|
}
|
|
|
|
/* Offset 0x08: Trunk Mapping Table register */
|
|
|
|
static int mv88e6xxx_g2_trunk_mapping_write(struct mv88e6xxx_chip *chip, int id,
|
|
u16 map)
|
|
{
|
|
const u16 port_mask = BIT(mv88e6xxx_num_ports(chip)) - 1;
|
|
u16 val = (id << 11) | (map & port_mask);
|
|
|
|
return mv88e6xxx_g2_update(chip, GLOBAL2_TRUNK_MAPPING, val);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_clear_trunk(struct mv88e6xxx_chip *chip)
|
|
{
|
|
const u16 port_mask = BIT(mv88e6xxx_num_ports(chip)) - 1;
|
|
int i, err;
|
|
|
|
/* Clear all eight possible Trunk Mask vectors */
|
|
for (i = 0; i < 8; ++i) {
|
|
err = mv88e6xxx_g2_trunk_mask_write(chip, i, false, port_mask);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
/* Clear all sixteen possible Trunk ID routing vectors */
|
|
for (i = 0; i < 16; ++i) {
|
|
err = mv88e6xxx_g2_trunk_mapping_write(chip, i, 0);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Offset 0x09: Ingress Rate Command register
|
|
* Offset 0x0A: Ingress Rate Data register
|
|
*/
|
|
|
|
static int mv88e6xxx_g2_clear_irl(struct mv88e6xxx_chip *chip)
|
|
{
|
|
int port, err;
|
|
|
|
/* Init all Ingress Rate Limit resources of all ports */
|
|
for (port = 0; port < mv88e6xxx_num_ports(chip); ++port) {
|
|
/* XXX newer chips (like 88E6390) have different 2-bit ops */
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_IRL_CMD,
|
|
GLOBAL2_IRL_CMD_OP_INIT_ALL |
|
|
(port << 8));
|
|
if (err)
|
|
break;
|
|
|
|
/* Wait for the operation to complete */
|
|
err = mv88e6xxx_g2_wait(chip, GLOBAL2_IRL_CMD,
|
|
GLOBAL2_IRL_CMD_BUSY);
|
|
if (err)
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
/* Offset 0x0D: Switch MAC/WoL/WoF register */
|
|
|
|
static int mv88e6xxx_g2_switch_mac_write(struct mv88e6xxx_chip *chip,
|
|
unsigned int pointer, u8 data)
|
|
{
|
|
u16 val = (pointer << 8) | data;
|
|
|
|
return mv88e6xxx_g2_update(chip, GLOBAL2_SWITCH_MAC, val);
|
|
}
|
|
|
|
int mv88e6xxx_g2_set_switch_mac(struct mv88e6xxx_chip *chip, u8 *addr)
|
|
{
|
|
int i, err;
|
|
|
|
for (i = 0; i < 6; i++) {
|
|
err = mv88e6xxx_g2_switch_mac_write(chip, i, addr[i]);
|
|
if (err)
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
/* Offset 0x0F: Priority Override Table */
|
|
|
|
static int mv88e6xxx_g2_pot_write(struct mv88e6xxx_chip *chip, int pointer,
|
|
u8 data)
|
|
{
|
|
u16 val = (pointer << 8) | (data & 0x7);
|
|
|
|
return mv88e6xxx_g2_update(chip, GLOBAL2_PRIO_OVERRIDE, val);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_clear_pot(struct mv88e6xxx_chip *chip)
|
|
{
|
|
int i, err;
|
|
|
|
/* Clear all sixteen possible Priority Override entries */
|
|
for (i = 0; i < 16; i++) {
|
|
err = mv88e6xxx_g2_pot_write(chip, i, 0);
|
|
if (err)
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
/* Offset 0x14: EEPROM Command
|
|
* Offset 0x15: EEPROM Data (for 16-bit data access)
|
|
* Offset 0x15: EEPROM Addr (for 8-bit data access)
|
|
*/
|
|
|
|
static int mv88e6xxx_g2_eeprom_wait(struct mv88e6xxx_chip *chip)
|
|
{
|
|
return mv88e6xxx_g2_wait(chip, GLOBAL2_EEPROM_CMD,
|
|
GLOBAL2_EEPROM_CMD_BUSY |
|
|
GLOBAL2_EEPROM_CMD_RUNNING);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_eeprom_cmd(struct mv88e6xxx_chip *chip, u16 cmd)
|
|
{
|
|
int err;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_EEPROM_CMD, cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_eeprom_wait(chip);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_eeprom_read8(struct mv88e6xxx_chip *chip,
|
|
u16 addr, u8 *data)
|
|
{
|
|
u16 cmd = GLOBAL2_EEPROM_CMD_OP_READ;
|
|
int err;
|
|
|
|
err = mv88e6xxx_g2_eeprom_wait(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_EEPROM_ADDR, addr);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_eeprom_cmd(chip, cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_read(chip, GLOBAL2_EEPROM_CMD, &cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
*data = cmd & 0xff;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mv88e6xxx_g2_eeprom_write8(struct mv88e6xxx_chip *chip,
|
|
u16 addr, u8 data)
|
|
{
|
|
u16 cmd = GLOBAL2_EEPROM_CMD_OP_WRITE | GLOBAL2_EEPROM_CMD_WRITE_EN;
|
|
int err;
|
|
|
|
err = mv88e6xxx_g2_eeprom_wait(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_EEPROM_ADDR, addr);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_eeprom_cmd(chip, cmd | data);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_eeprom_read16(struct mv88e6xxx_chip *chip,
|
|
u8 addr, u16 *data)
|
|
{
|
|
u16 cmd = GLOBAL2_EEPROM_CMD_OP_READ | addr;
|
|
int err;
|
|
|
|
err = mv88e6xxx_g2_eeprom_wait(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_eeprom_cmd(chip, cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_read(chip, GLOBAL2_EEPROM_DATA, data);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_eeprom_write16(struct mv88e6xxx_chip *chip,
|
|
u8 addr, u16 data)
|
|
{
|
|
u16 cmd = GLOBAL2_EEPROM_CMD_OP_WRITE | addr;
|
|
int err;
|
|
|
|
err = mv88e6xxx_g2_eeprom_wait(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_EEPROM_DATA, data);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_eeprom_cmd(chip, cmd);
|
|
}
|
|
|
|
int mv88e6xxx_g2_get_eeprom8(struct mv88e6xxx_chip *chip,
|
|
struct ethtool_eeprom *eeprom, u8 *data)
|
|
{
|
|
unsigned int offset = eeprom->offset;
|
|
unsigned int len = eeprom->len;
|
|
int err;
|
|
|
|
eeprom->len = 0;
|
|
|
|
while (len) {
|
|
err = mv88e6xxx_g2_eeprom_read8(chip, offset, data);
|
|
if (err)
|
|
return err;
|
|
|
|
eeprom->len++;
|
|
offset++;
|
|
data++;
|
|
len--;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mv88e6xxx_g2_set_eeprom8(struct mv88e6xxx_chip *chip,
|
|
struct ethtool_eeprom *eeprom, u8 *data)
|
|
{
|
|
unsigned int offset = eeprom->offset;
|
|
unsigned int len = eeprom->len;
|
|
int err;
|
|
|
|
eeprom->len = 0;
|
|
|
|
while (len) {
|
|
err = mv88e6xxx_g2_eeprom_write8(chip, offset, *data);
|
|
if (err)
|
|
return err;
|
|
|
|
eeprom->len++;
|
|
offset++;
|
|
data++;
|
|
len--;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mv88e6xxx_g2_get_eeprom16(struct mv88e6xxx_chip *chip,
|
|
struct ethtool_eeprom *eeprom, u8 *data)
|
|
{
|
|
unsigned int offset = eeprom->offset;
|
|
unsigned int len = eeprom->len;
|
|
u16 val;
|
|
int err;
|
|
|
|
eeprom->len = 0;
|
|
|
|
if (offset & 1) {
|
|
err = mv88e6xxx_g2_eeprom_read16(chip, offset >> 1, &val);
|
|
if (err)
|
|
return err;
|
|
|
|
*data++ = (val >> 8) & 0xff;
|
|
|
|
offset++;
|
|
len--;
|
|
eeprom->len++;
|
|
}
|
|
|
|
while (len >= 2) {
|
|
err = mv88e6xxx_g2_eeprom_read16(chip, offset >> 1, &val);
|
|
if (err)
|
|
return err;
|
|
|
|
*data++ = val & 0xff;
|
|
*data++ = (val >> 8) & 0xff;
|
|
|
|
offset += 2;
|
|
len -= 2;
|
|
eeprom->len += 2;
|
|
}
|
|
|
|
if (len) {
|
|
err = mv88e6xxx_g2_eeprom_read16(chip, offset >> 1, &val);
|
|
if (err)
|
|
return err;
|
|
|
|
*data++ = val & 0xff;
|
|
|
|
offset++;
|
|
len--;
|
|
eeprom->len++;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mv88e6xxx_g2_set_eeprom16(struct mv88e6xxx_chip *chip,
|
|
struct ethtool_eeprom *eeprom, u8 *data)
|
|
{
|
|
unsigned int offset = eeprom->offset;
|
|
unsigned int len = eeprom->len;
|
|
u16 val;
|
|
int err;
|
|
|
|
/* Ensure the RO WriteEn bit is set */
|
|
err = mv88e6xxx_g2_read(chip, GLOBAL2_EEPROM_CMD, &val);
|
|
if (err)
|
|
return err;
|
|
|
|
if (!(val & GLOBAL2_EEPROM_CMD_WRITE_EN))
|
|
return -EROFS;
|
|
|
|
eeprom->len = 0;
|
|
|
|
if (offset & 1) {
|
|
err = mv88e6xxx_g2_eeprom_read16(chip, offset >> 1, &val);
|
|
if (err)
|
|
return err;
|
|
|
|
val = (*data++ << 8) | (val & 0xff);
|
|
|
|
err = mv88e6xxx_g2_eeprom_write16(chip, offset >> 1, val);
|
|
if (err)
|
|
return err;
|
|
|
|
offset++;
|
|
len--;
|
|
eeprom->len++;
|
|
}
|
|
|
|
while (len >= 2) {
|
|
val = *data++;
|
|
val |= *data++ << 8;
|
|
|
|
err = mv88e6xxx_g2_eeprom_write16(chip, offset >> 1, val);
|
|
if (err)
|
|
return err;
|
|
|
|
offset += 2;
|
|
len -= 2;
|
|
eeprom->len += 2;
|
|
}
|
|
|
|
if (len) {
|
|
err = mv88e6xxx_g2_eeprom_read16(chip, offset >> 1, &val);
|
|
if (err)
|
|
return err;
|
|
|
|
val = (val & 0xff00) | *data++;
|
|
|
|
err = mv88e6xxx_g2_eeprom_write16(chip, offset >> 1, val);
|
|
if (err)
|
|
return err;
|
|
|
|
offset++;
|
|
len--;
|
|
eeprom->len++;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Offset 0x18: SMI PHY Command Register
|
|
* Offset 0x19: SMI PHY Data Register
|
|
*/
|
|
|
|
static int mv88e6xxx_g2_smi_phy_wait(struct mv88e6xxx_chip *chip)
|
|
{
|
|
return mv88e6xxx_g2_wait(chip, GLOBAL2_SMI_PHY_CMD,
|
|
GLOBAL2_SMI_PHY_CMD_BUSY);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_smi_phy_cmd(struct mv88e6xxx_chip *chip, u16 cmd)
|
|
{
|
|
int err;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_SMI_PHY_CMD, cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_smi_phy_wait(chip);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_smi_phy_write_addr(struct mv88e6xxx_chip *chip,
|
|
int addr, int device, int reg,
|
|
bool external)
|
|
{
|
|
int cmd = SMI_CMD_OP_45_WRITE_ADDR | (addr << 5) | device;
|
|
int err;
|
|
|
|
if (external)
|
|
cmd |= GLOBAL2_SMI_PHY_CMD_EXTERNAL;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_wait(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_SMI_PHY_DATA, reg);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_smi_phy_cmd(chip, cmd);
|
|
}
|
|
|
|
int mv88e6xxx_g2_smi_phy_read_c45(struct mv88e6xxx_chip *chip, int addr,
|
|
int reg_c45, u16 *val, bool external)
|
|
{
|
|
int device = (reg_c45 >> 16) & 0x1f;
|
|
int reg = reg_c45 & 0xffff;
|
|
int err;
|
|
u16 cmd;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_write_addr(chip, addr, device, reg,
|
|
external);
|
|
if (err)
|
|
return err;
|
|
|
|
cmd = GLOBAL2_SMI_PHY_CMD_OP_45_READ_DATA | (addr << 5) | device;
|
|
|
|
if (external)
|
|
cmd |= GLOBAL2_SMI_PHY_CMD_EXTERNAL;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_cmd(chip, cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_read(chip, GLOBAL2_SMI_PHY_DATA, val);
|
|
if (err)
|
|
return err;
|
|
|
|
err = *val;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mv88e6xxx_g2_smi_phy_read_c22(struct mv88e6xxx_chip *chip, int addr,
|
|
int reg, u16 *val, bool external)
|
|
{
|
|
u16 cmd = GLOBAL2_SMI_PHY_CMD_OP_22_READ_DATA | (addr << 5) | reg;
|
|
int err;
|
|
|
|
if (external)
|
|
cmd |= GLOBAL2_SMI_PHY_CMD_EXTERNAL;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_wait(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_cmd(chip, cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_read(chip, GLOBAL2_SMI_PHY_DATA, val);
|
|
}
|
|
|
|
int mv88e6xxx_g2_smi_phy_read(struct mv88e6xxx_chip *chip,
|
|
struct mii_bus *bus,
|
|
int addr, int reg, u16 *val)
|
|
{
|
|
struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
|
|
bool external = mdio_bus->external;
|
|
|
|
if (reg & MII_ADDR_C45)
|
|
return mv88e6xxx_g2_smi_phy_read_c45(chip, addr, reg, val,
|
|
external);
|
|
return mv88e6xxx_g2_smi_phy_read_c22(chip, addr, reg, val, external);
|
|
}
|
|
|
|
int mv88e6xxx_g2_smi_phy_write_c45(struct mv88e6xxx_chip *chip, int addr,
|
|
int reg_c45, u16 val, bool external)
|
|
{
|
|
int device = (reg_c45 >> 16) & 0x1f;
|
|
int reg = reg_c45 & 0xffff;
|
|
int err;
|
|
u16 cmd;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_write_addr(chip, addr, device, reg,
|
|
external);
|
|
if (err)
|
|
return err;
|
|
|
|
cmd = GLOBAL2_SMI_PHY_CMD_OP_45_WRITE_DATA | (addr << 5) | device;
|
|
|
|
if (external)
|
|
cmd |= GLOBAL2_SMI_PHY_CMD_EXTERNAL;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_SMI_PHY_DATA, val);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_cmd(chip, cmd);
|
|
if (err)
|
|
return err;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mv88e6xxx_g2_smi_phy_write_c22(struct mv88e6xxx_chip *chip, int addr,
|
|
int reg, u16 val, bool external)
|
|
{
|
|
u16 cmd = GLOBAL2_SMI_PHY_CMD_OP_22_WRITE_DATA | (addr << 5) | reg;
|
|
int err;
|
|
|
|
if (external)
|
|
cmd |= GLOBAL2_SMI_PHY_CMD_EXTERNAL;
|
|
|
|
err = mv88e6xxx_g2_smi_phy_wait(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_SMI_PHY_DATA, val);
|
|
if (err)
|
|
return err;
|
|
|
|
return mv88e6xxx_g2_smi_phy_cmd(chip, cmd);
|
|
}
|
|
|
|
int mv88e6xxx_g2_smi_phy_write(struct mv88e6xxx_chip *chip,
|
|
struct mii_bus *bus,
|
|
int addr, int reg, u16 val)
|
|
{
|
|
struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
|
|
bool external = mdio_bus->external;
|
|
|
|
if (reg & MII_ADDR_C45)
|
|
return mv88e6xxx_g2_smi_phy_write_c45(chip, addr, reg, val,
|
|
external);
|
|
|
|
return mv88e6xxx_g2_smi_phy_write_c22(chip, addr, reg, val, external);
|
|
}
|
|
|
|
static int mv88e6097_watchdog_action(struct mv88e6xxx_chip *chip, int irq)
|
|
{
|
|
u16 reg;
|
|
|
|
mv88e6xxx_g2_read(chip, GLOBAL2_WDOG_CONTROL, ®);
|
|
|
|
dev_info(chip->dev, "Watchdog event: 0x%04x", reg);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static void mv88e6097_watchdog_free(struct mv88e6xxx_chip *chip)
|
|
{
|
|
u16 reg;
|
|
|
|
mv88e6xxx_g2_read(chip, GLOBAL2_WDOG_CONTROL, ®);
|
|
|
|
reg &= ~(GLOBAL2_WDOG_CONTROL_EGRESS_ENABLE |
|
|
GLOBAL2_WDOG_CONTROL_QC_ENABLE);
|
|
|
|
mv88e6xxx_g2_write(chip, GLOBAL2_WDOG_CONTROL, reg);
|
|
}
|
|
|
|
static int mv88e6097_watchdog_setup(struct mv88e6xxx_chip *chip)
|
|
{
|
|
return mv88e6xxx_g2_write(chip, GLOBAL2_WDOG_CONTROL,
|
|
GLOBAL2_WDOG_CONTROL_EGRESS_ENABLE |
|
|
GLOBAL2_WDOG_CONTROL_QC_ENABLE |
|
|
GLOBAL2_WDOG_CONTROL_SWRESET);
|
|
}
|
|
|
|
const struct mv88e6xxx_irq_ops mv88e6097_watchdog_ops = {
|
|
.irq_action = mv88e6097_watchdog_action,
|
|
.irq_setup = mv88e6097_watchdog_setup,
|
|
.irq_free = mv88e6097_watchdog_free,
|
|
};
|
|
|
|
static int mv88e6390_watchdog_setup(struct mv88e6xxx_chip *chip)
|
|
{
|
|
return mv88e6xxx_g2_update(chip, GLOBAL2_WDOG_CONTROL,
|
|
GLOBAL2_WDOG_INT_ENABLE |
|
|
GLOBAL2_WDOG_CUT_THROUGH |
|
|
GLOBAL2_WDOG_QUEUE_CONTROLLER |
|
|
GLOBAL2_WDOG_EGRESS |
|
|
GLOBAL2_WDOG_FORCE_IRQ);
|
|
}
|
|
|
|
static int mv88e6390_watchdog_action(struct mv88e6xxx_chip *chip, int irq)
|
|
{
|
|
int err;
|
|
u16 reg;
|
|
|
|
mv88e6xxx_g2_write(chip, GLOBAL2_WDOG_CONTROL, GLOBAL2_WDOG_EVENT);
|
|
err = mv88e6xxx_g2_read(chip, GLOBAL2_WDOG_CONTROL, ®);
|
|
|
|
dev_info(chip->dev, "Watchdog event: 0x%04x",
|
|
reg & GLOBAL2_WDOG_DATA_MASK);
|
|
|
|
mv88e6xxx_g2_write(chip, GLOBAL2_WDOG_CONTROL, GLOBAL2_WDOG_HISTORY);
|
|
err = mv88e6xxx_g2_read(chip, GLOBAL2_WDOG_CONTROL, ®);
|
|
|
|
dev_info(chip->dev, "Watchdog history: 0x%04x",
|
|
reg & GLOBAL2_WDOG_DATA_MASK);
|
|
|
|
/* Trigger a software reset to try to recover the switch */
|
|
if (chip->info->ops->reset)
|
|
chip->info->ops->reset(chip);
|
|
|
|
mv88e6390_watchdog_setup(chip);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static void mv88e6390_watchdog_free(struct mv88e6xxx_chip *chip)
|
|
{
|
|
mv88e6xxx_g2_update(chip, GLOBAL2_WDOG_CONTROL,
|
|
GLOBAL2_WDOG_INT_ENABLE);
|
|
}
|
|
|
|
const struct mv88e6xxx_irq_ops mv88e6390_watchdog_ops = {
|
|
.irq_action = mv88e6390_watchdog_action,
|
|
.irq_setup = mv88e6390_watchdog_setup,
|
|
.irq_free = mv88e6390_watchdog_free,
|
|
};
|
|
|
|
static irqreturn_t mv88e6xxx_g2_watchdog_thread_fn(int irq, void *dev_id)
|
|
{
|
|
struct mv88e6xxx_chip *chip = dev_id;
|
|
irqreturn_t ret = IRQ_NONE;
|
|
|
|
mutex_lock(&chip->reg_lock);
|
|
if (chip->info->ops->watchdog_ops->irq_action)
|
|
ret = chip->info->ops->watchdog_ops->irq_action(chip, irq);
|
|
mutex_unlock(&chip->reg_lock);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void mv88e6xxx_g2_watchdog_free(struct mv88e6xxx_chip *chip)
|
|
{
|
|
mutex_lock(&chip->reg_lock);
|
|
if (chip->info->ops->watchdog_ops->irq_free)
|
|
chip->info->ops->watchdog_ops->irq_free(chip);
|
|
mutex_unlock(&chip->reg_lock);
|
|
|
|
free_irq(chip->watchdog_irq, chip);
|
|
irq_dispose_mapping(chip->watchdog_irq);
|
|
}
|
|
|
|
static int mv88e6xxx_g2_watchdog_setup(struct mv88e6xxx_chip *chip)
|
|
{
|
|
int err;
|
|
|
|
chip->watchdog_irq = irq_find_mapping(chip->g2_irq.domain,
|
|
GLOBAL2_INT_SOURCE_WATCHDOG);
|
|
if (chip->watchdog_irq < 0)
|
|
return chip->watchdog_irq;
|
|
|
|
err = request_threaded_irq(chip->watchdog_irq, NULL,
|
|
mv88e6xxx_g2_watchdog_thread_fn,
|
|
IRQF_ONESHOT | IRQF_TRIGGER_FALLING,
|
|
"mv88e6xxx-watchdog", chip);
|
|
if (err)
|
|
return err;
|
|
|
|
mutex_lock(&chip->reg_lock);
|
|
if (chip->info->ops->watchdog_ops->irq_setup)
|
|
err = chip->info->ops->watchdog_ops->irq_setup(chip);
|
|
mutex_unlock(&chip->reg_lock);
|
|
|
|
return err;
|
|
}
|
|
|
|
static void mv88e6xxx_g2_irq_mask(struct irq_data *d)
|
|
{
|
|
struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
|
|
unsigned int n = d->hwirq;
|
|
|
|
chip->g2_irq.masked |= (1 << n);
|
|
}
|
|
|
|
static void mv88e6xxx_g2_irq_unmask(struct irq_data *d)
|
|
{
|
|
struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
|
|
unsigned int n = d->hwirq;
|
|
|
|
chip->g2_irq.masked &= ~(1 << n);
|
|
}
|
|
|
|
static irqreturn_t mv88e6xxx_g2_irq_thread_fn(int irq, void *dev_id)
|
|
{
|
|
struct mv88e6xxx_chip *chip = dev_id;
|
|
unsigned int nhandled = 0;
|
|
unsigned int sub_irq;
|
|
unsigned int n;
|
|
int err;
|
|
u16 reg;
|
|
|
|
mutex_lock(&chip->reg_lock);
|
|
err = mv88e6xxx_g2_read(chip, GLOBAL2_INT_SOURCE, ®);
|
|
mutex_unlock(&chip->reg_lock);
|
|
if (err)
|
|
goto out;
|
|
|
|
for (n = 0; n < 16; ++n) {
|
|
if (reg & (1 << n)) {
|
|
sub_irq = irq_find_mapping(chip->g2_irq.domain, n);
|
|
handle_nested_irq(sub_irq);
|
|
++nhandled;
|
|
}
|
|
}
|
|
out:
|
|
return (nhandled > 0 ? IRQ_HANDLED : IRQ_NONE);
|
|
}
|
|
|
|
static void mv88e6xxx_g2_irq_bus_lock(struct irq_data *d)
|
|
{
|
|
struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
|
|
|
|
mutex_lock(&chip->reg_lock);
|
|
}
|
|
|
|
static void mv88e6xxx_g2_irq_bus_sync_unlock(struct irq_data *d)
|
|
{
|
|
struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
|
|
|
|
mv88e6xxx_g2_write(chip, GLOBAL2_INT_MASK, ~chip->g2_irq.masked);
|
|
|
|
mutex_unlock(&chip->reg_lock);
|
|
}
|
|
|
|
static struct irq_chip mv88e6xxx_g2_irq_chip = {
|
|
.name = "mv88e6xxx-g2",
|
|
.irq_mask = mv88e6xxx_g2_irq_mask,
|
|
.irq_unmask = mv88e6xxx_g2_irq_unmask,
|
|
.irq_bus_lock = mv88e6xxx_g2_irq_bus_lock,
|
|
.irq_bus_sync_unlock = mv88e6xxx_g2_irq_bus_sync_unlock,
|
|
};
|
|
|
|
static int mv88e6xxx_g2_irq_domain_map(struct irq_domain *d,
|
|
unsigned int irq,
|
|
irq_hw_number_t hwirq)
|
|
{
|
|
struct mv88e6xxx_chip *chip = d->host_data;
|
|
|
|
irq_set_chip_data(irq, d->host_data);
|
|
irq_set_chip_and_handler(irq, &chip->g2_irq.chip, handle_level_irq);
|
|
irq_set_noprobe(irq);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct irq_domain_ops mv88e6xxx_g2_irq_domain_ops = {
|
|
.map = mv88e6xxx_g2_irq_domain_map,
|
|
.xlate = irq_domain_xlate_twocell,
|
|
};
|
|
|
|
void mv88e6xxx_g2_irq_free(struct mv88e6xxx_chip *chip)
|
|
{
|
|
int irq, virq;
|
|
|
|
mv88e6xxx_g2_watchdog_free(chip);
|
|
|
|
free_irq(chip->device_irq, chip);
|
|
irq_dispose_mapping(chip->device_irq);
|
|
|
|
for (irq = 0; irq < 16; irq++) {
|
|
virq = irq_find_mapping(chip->g2_irq.domain, irq);
|
|
irq_dispose_mapping(virq);
|
|
}
|
|
|
|
irq_domain_remove(chip->g2_irq.domain);
|
|
}
|
|
|
|
int mv88e6xxx_g2_irq_setup(struct mv88e6xxx_chip *chip)
|
|
{
|
|
int err, irq, virq;
|
|
|
|
if (!chip->dev->of_node)
|
|
return -EINVAL;
|
|
|
|
chip->g2_irq.domain = irq_domain_add_simple(
|
|
chip->dev->of_node, 16, 0, &mv88e6xxx_g2_irq_domain_ops, chip);
|
|
if (!chip->g2_irq.domain)
|
|
return -ENOMEM;
|
|
|
|
for (irq = 0; irq < 16; irq++)
|
|
irq_create_mapping(chip->g2_irq.domain, irq);
|
|
|
|
chip->g2_irq.chip = mv88e6xxx_g2_irq_chip;
|
|
chip->g2_irq.masked = ~0;
|
|
|
|
chip->device_irq = irq_find_mapping(chip->g1_irq.domain,
|
|
GLOBAL_STATUS_IRQ_DEVICE);
|
|
if (chip->device_irq < 0) {
|
|
err = chip->device_irq;
|
|
goto out;
|
|
}
|
|
|
|
err = request_threaded_irq(chip->device_irq, NULL,
|
|
mv88e6xxx_g2_irq_thread_fn,
|
|
IRQF_ONESHOT, "mv88e6xxx-g1", chip);
|
|
if (err)
|
|
goto out;
|
|
|
|
return mv88e6xxx_g2_watchdog_setup(chip);
|
|
|
|
out:
|
|
for (irq = 0; irq < 16; irq++) {
|
|
virq = irq_find_mapping(chip->g2_irq.domain, irq);
|
|
irq_dispose_mapping(virq);
|
|
}
|
|
|
|
irq_domain_remove(chip->g2_irq.domain);
|
|
|
|
return err;
|
|
}
|
|
|
|
int mv88e6xxx_g2_setup(struct mv88e6xxx_chip *chip)
|
|
{
|
|
u16 reg;
|
|
int err;
|
|
|
|
/* Ignore removed tag data on doubly tagged packets, disable
|
|
* flow control messages, force flow control priority to the
|
|
* highest, and send all special multicast frames to the CPU
|
|
* port at the highest priority.
|
|
*/
|
|
reg = GLOBAL2_SWITCH_MGMT_FORCE_FLOW_CTRL_PRI | (0x7 << 4);
|
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_MGMT_EN_0X) ||
|
|
mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_MGMT_EN_2X))
|
|
reg |= GLOBAL2_SWITCH_MGMT_RSVD2CPU | 0x7;
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_SWITCH_MGMT, reg);
|
|
if (err)
|
|
return err;
|
|
|
|
/* Program the DSA routing table. */
|
|
err = mv88e6xxx_g2_set_device_mapping(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
/* Clear all trunk masks and mapping. */
|
|
err = mv88e6xxx_g2_clear_trunk(chip);
|
|
if (err)
|
|
return err;
|
|
|
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAGS_IRL)) {
|
|
/* Disable ingress rate limiting by resetting all per port
|
|
* ingress rate limit resources to their initial state.
|
|
*/
|
|
err = mv88e6xxx_g2_clear_irl(chip);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAGS_PVT)) {
|
|
/* Initialize Cross-chip Port VLAN Table to reset defaults */
|
|
err = mv88e6xxx_g2_write(chip, GLOBAL2_PVT_ADDR,
|
|
GLOBAL2_PVT_ADDR_OP_INIT_ONES);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (mv88e6xxx_has(chip, MV88E6XXX_FLAG_G2_POT)) {
|
|
/* Clear the priority override table. */
|
|
err = mv88e6xxx_g2_clear_pot(chip);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|