提交 7c263e9d 编写于 作者: D David S. Miller

Merge branch 'dsa-realtek-MDIO'

Luiz Angelo Daros de Luca says:

====================
net: dsa: realtek: MDIO interface and RTL8367S,RTL8367RB-VB

The old realtek-smi driver was linking subdrivers into a single
realtek-smi.ko After this series, each subdriver will be an independent
module required by either realtek-smi (platform driver) or the new
realtek-mdio (mdio driver). Both interface drivers (SMI or MDIO) are
independent, and they might even work side-by-side, although it will be
difficult to find such device. The subdriver can be individually
selected but only at buildtime, saving some storage space for custom
embedded systems.

Existing realtek-smi devices continue to work untouched during the
tests. The realtek-smi was moved into a realtek subdirectory, but it
normally does not break things.

I couldn't identify a fixed relation between port numbers (0..9) and
external interfaces (0..2), and I'm not sure if it is fixed for each
chip version or a device configuration. Until there is more info about
it, there is a new port property "realtek,ext-int" that can inform the
external interface.

The rtl8365mb might now handle multiple CPU ports and extint ports not
used as CPU ports. RTL8367S has an SGMII external interface, but my test
device (TP-Link Archer C5v4) uses only the second RGMII interface. We
need a test device with more external ports to test these features.
The driver still cannot handle SGMII ports.

RTL8367RB-VB support was added using information from Frank Wunderlich
<frank-w@public-files.de> but I didn't test it myself.

The rtl8365mb was tested with a MDIO-connected RTL8367S (TP-Link Acher
C5v4) and a SMI-connected RTL8365MB-VC switch (Asus RT-AC88U)

The rtl8366rb subdriver was not tested with this patch series, but it
was only slightly touched. It would be nice to test it, especially in an
MDIO-connected switch.

Best,

Luiz

Changelog:

v1-v2)
- formatting fixes
- dropped the rtl8365mb->rtl8367c rename
- other suggestions

v2-v3)
* realtek-mdio.c:
  - cleanup realtek-mdio.c (BUG_ON, comments and includes)
  - check devm_regmap_init return code
  - removed realtek,rtl8366s string from realtek-mdio
* realtek-smi.c:
  - removed void* type cast
* rtl8365mb.c:
  - using macros to identify EXT interfaces
  - rename some extra extport->extint cases
  - allow extint as non cpu (not tested)
  - allow multple cpu ports (not tested)
  - dropped cpu info from struct rtl8365mb
* dropped dt-bindings changes (dealing outside this series)
* formatting issues fixed

v3-v4)
* fix cover message numbering 0/13 -> 0/11
* use static for realtek_mdio_read_reg
  - Reported-by: kernel test robot <lkp@intel.com>
* use dsa_switch_for_each_cpu_port
* mention realtek_smi_{variant,ops} to realtek_{variant,ops}
  in commit message

v5) sent again v4 branch. Sorry

v4-v6)
- added support for RTL8367RB-VB
- cleanup mdio_{read,write}, removing misterious START_OP, checking and
  returning errors
- renamed priv->phy_id to priv->mdio_addr
- duplicated priv->ds_ops into ds_ops_{smi,mdio}. ds_ops_smi must not
  set
  phy_read or else both dsa and this driver might free slave_mii.
Dropped
  401fd75c92f37
- Map port to extint using code instead of device-tree property. Added
  comment
  about port number, port description and external interfaces. Dropped
  'realtek,ext-int' device-tree property
- Redacted the non-cpu ext port commit message, not highlighting the
  possibility of using multiple CPU ports as it was just a byproduct.
- In a possible case of multiple cpu ports, use the first one as the
  trap port.
  Dropped 'realtek,trap-port' device-tree property
- Some formatting fixes
- BUG: rtl8365mb_phy_mode_supported was still checking for a cpu port
  and not
  an external interface
- BUG: fix trapdoor masking for port>7. Got a compiler error with a
  bigger
  constant value
- WARN: completed kdoc for rtl8366rb_drop_untagged()
- WARN: removed marks from incomplete kdoc
====================
Signed-off-by: NDavid S. Miller <davem@davemloft.net>
无相关合并请求
...@@ -16352,8 +16352,7 @@ REALTEK RTL83xx SMI DSA ROUTER CHIPS ...@@ -16352,8 +16352,7 @@ REALTEK RTL83xx SMI DSA ROUTER CHIPS
M: Linus Walleij <linus.walleij@linaro.org> M: Linus Walleij <linus.walleij@linaro.org>
S: Maintained S: Maintained
F: Documentation/devicetree/bindings/net/dsa/realtek-smi.txt F: Documentation/devicetree/bindings/net/dsa/realtek-smi.txt
F: drivers/net/dsa/realtek-smi* F: drivers/net/dsa/realtek/*
F: drivers/net/dsa/rtl83*
REALTEK WIRELESS DRIVER (rtlwifi family) REALTEK WIRELESS DRIVER (rtlwifi family)
M: Ping-Ke Shih <pkshih@realtek.com> M: Ping-Ke Shih <pkshih@realtek.com>
......
...@@ -67,17 +67,7 @@ config NET_DSA_QCA8K ...@@ -67,17 +67,7 @@ config NET_DSA_QCA8K
This enables support for the Qualcomm Atheros QCA8K Ethernet This enables support for the Qualcomm Atheros QCA8K Ethernet
switch chips. switch chips.
config NET_DSA_REALTEK_SMI source "drivers/net/dsa/realtek/Kconfig"
tristate "Realtek SMI Ethernet switch family support"
select NET_DSA_TAG_RTL4_A
select NET_DSA_TAG_RTL8_4
select FIXED_PHY
select IRQ_DOMAIN
select REALTEK_PHY
select REGMAP
help
This enables support for the Realtek SMI-based switch
chips, currently only RTL8366RB.
config NET_DSA_SMSC_LAN9303 config NET_DSA_SMSC_LAN9303
tristate tristate
......
...@@ -9,8 +9,6 @@ obj-$(CONFIG_NET_DSA_LANTIQ_GSWIP) += lantiq_gswip.o ...@@ -9,8 +9,6 @@ obj-$(CONFIG_NET_DSA_LANTIQ_GSWIP) += lantiq_gswip.o
obj-$(CONFIG_NET_DSA_MT7530) += mt7530.o obj-$(CONFIG_NET_DSA_MT7530) += mt7530.o
obj-$(CONFIG_NET_DSA_MV88E6060) += mv88e6060.o obj-$(CONFIG_NET_DSA_MV88E6060) += mv88e6060.o
obj-$(CONFIG_NET_DSA_QCA8K) += qca8k.o obj-$(CONFIG_NET_DSA_QCA8K) += qca8k.o
obj-$(CONFIG_NET_DSA_REALTEK_SMI) += realtek-smi.o
realtek-smi-objs := realtek-smi-core.o rtl8366.o rtl8366rb.o rtl8365mb.o
obj-$(CONFIG_NET_DSA_SMSC_LAN9303) += lan9303-core.o obj-$(CONFIG_NET_DSA_SMSC_LAN9303) += lan9303-core.o
obj-$(CONFIG_NET_DSA_SMSC_LAN9303_I2C) += lan9303_i2c.o obj-$(CONFIG_NET_DSA_SMSC_LAN9303_I2C) += lan9303_i2c.o
obj-$(CONFIG_NET_DSA_SMSC_LAN9303_MDIO) += lan9303_mdio.o obj-$(CONFIG_NET_DSA_SMSC_LAN9303_MDIO) += lan9303_mdio.o
...@@ -23,5 +21,6 @@ obj-y += microchip/ ...@@ -23,5 +21,6 @@ obj-y += microchip/
obj-y += mv88e6xxx/ obj-y += mv88e6xxx/
obj-y += ocelot/ obj-y += ocelot/
obj-y += qca/ obj-y += qca/
obj-y += realtek/
obj-y += sja1105/ obj-y += sja1105/
obj-y += xrs700x/ obj-y += xrs700x/
# SPDX-License-Identifier: GPL-2.0-only
menuconfig NET_DSA_REALTEK
tristate "Realtek Ethernet switch family support"
depends on NET_DSA
select FIXED_PHY
select IRQ_DOMAIN
select REALTEK_PHY
select REGMAP
help
Select to enable support for Realtek Ethernet switch chips.
config NET_DSA_REALTEK_MDIO
tristate "Realtek MDIO connected switch driver"
depends on NET_DSA_REALTEK
default y
help
Select to enable support for registering switches configured
through MDIO.
config NET_DSA_REALTEK_SMI
tristate "Realtek SMI connected switch driver"
depends on NET_DSA_REALTEK
default y
help
Select to enable support for registering switches connected
through SMI.
config NET_DSA_REALTEK_RTL8365MB
tristate "Realtek RTL8365MB switch subdriver"
default y
depends on NET_DSA_REALTEK
depends on NET_DSA_REALTEK_SMI || NET_DSA_REALTEK_MDIO
select NET_DSA_TAG_RTL8_4
help
Select to enable support for Realtek RTL8365MB-VC and RTL8367S.
config NET_DSA_REALTEK_RTL8366RB
tristate "Realtek RTL8366RB switch subdriver"
default y
depends on NET_DSA_REALTEK
depends on NET_DSA_REALTEK_SMI || NET_DSA_REALTEK_MDIO
select NET_DSA_TAG_RTL4_A
help
Select to enable support for Realtek RTL8366RB
# SPDX-License-Identifier: GPL-2.0
obj-$(CONFIG_NET_DSA_REALTEK_MDIO) += realtek-mdio.o
obj-$(CONFIG_NET_DSA_REALTEK_SMI) += realtek-smi.o
obj-$(CONFIG_NET_DSA_REALTEK_RTL8366RB) += rtl8366.o
rtl8366-objs := rtl8366-core.o rtl8366rb.o
obj-$(CONFIG_NET_DSA_REALTEK_RTL8365MB) += rtl8365mb.o
// SPDX-License-Identifier: GPL-2.0+
/* Realtek MDIO interface driver
*
* ASICs we intend to support with this driver:
*
* RTL8366 - The original version, apparently
* RTL8369 - Similar enough to have the same datsheet as RTL8366
* RTL8366RB - Probably reads out "RTL8366 revision B", has a quite
* different register layout from the other two
* RTL8366S - Is this "RTL8366 super"?
* RTL8367 - Has an OpenWRT driver as well
* RTL8368S - Seems to be an alternative name for RTL8366RB
* RTL8370 - Also uses SMI
*
* Copyright (C) 2017 Linus Walleij <linus.walleij@linaro.org>
* Copyright (C) 2010 Antti Seppälä <a.seppala@gmail.com>
* Copyright (C) 2010 Roman Yeryomin <roman@advem.lv>
* Copyright (C) 2011 Colin Leitner <colin.leitner@googlemail.com>
* Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>
*/
#include <linux/module.h>
#include <linux/of_device.h>
#include <linux/regmap.h>
#include "realtek.h"
/* Read/write via mdiobus */
#define REALTEK_MDIO_CTRL0_REG 31
#define REALTEK_MDIO_START_REG 29
#define REALTEK_MDIO_CTRL1_REG 21
#define REALTEK_MDIO_ADDRESS_REG 23
#define REALTEK_MDIO_DATA_WRITE_REG 24
#define REALTEK_MDIO_DATA_READ_REG 25
#define REALTEK_MDIO_START_OP 0xFFFF
#define REALTEK_MDIO_ADDR_OP 0x000E
#define REALTEK_MDIO_READ_OP 0x0001
#define REALTEK_MDIO_WRITE_OP 0x0003
static int realtek_mdio_write(void *ctx, u32 reg, u32 val)
{
struct realtek_priv *priv = ctx;
struct mii_bus *bus = priv->bus;
int ret;
mutex_lock(&bus->mdio_lock);
ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL0_REG, REALTEK_MDIO_ADDR_OP);
if (ret)
goto out_unlock;
ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_ADDRESS_REG, reg);
if (ret)
goto out_unlock;
ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_DATA_WRITE_REG, val);
if (ret)
goto out_unlock;
ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL1_REG, REALTEK_MDIO_WRITE_OP);
out_unlock:
mutex_unlock(&bus->mdio_lock);
return ret;
}
static int realtek_mdio_read(void *ctx, u32 reg, u32 *val)
{
struct realtek_priv *priv = ctx;
struct mii_bus *bus = priv->bus;
int ret;
mutex_lock(&bus->mdio_lock);
ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL0_REG, REALTEK_MDIO_ADDR_OP);
if (ret)
goto out_unlock;
ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_ADDRESS_REG, reg);
if (ret)
goto out_unlock;
ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL1_REG, REALTEK_MDIO_READ_OP);
if (ret)
goto out_unlock;
ret = bus->read(bus, priv->mdio_addr, REALTEK_MDIO_DATA_READ_REG);
if (ret >= 0) {
*val = ret;
ret = 0;
}
out_unlock:
mutex_unlock(&bus->mdio_lock);
return ret;
}
static const struct regmap_config realtek_mdio_regmap_config = {
.reg_bits = 10, /* A4..A0 R4..R0 */
.val_bits = 16,
.reg_stride = 1,
/* PHY regs are at 0x8000 */
.max_register = 0xffff,
.reg_format_endian = REGMAP_ENDIAN_BIG,
.reg_read = realtek_mdio_read,
.reg_write = realtek_mdio_write,
.cache_type = REGCACHE_NONE,
};
static int realtek_mdio_probe(struct mdio_device *mdiodev)
{
struct realtek_priv *priv;
struct device *dev = &mdiodev->dev;
const struct realtek_variant *var;
int ret;
struct device_node *np;
var = of_device_get_match_data(dev);
if (!var)
return -EINVAL;
priv = devm_kzalloc(&mdiodev->dev, sizeof(*priv), GFP_KERNEL);
if (!priv)
return -ENOMEM;
priv->map = devm_regmap_init(dev, NULL, priv, &realtek_mdio_regmap_config);
if (IS_ERR(priv->map)) {
ret = PTR_ERR(priv->map);
dev_err(dev, "regmap init failed: %d\n", ret);
return ret;
}
priv->mdio_addr = mdiodev->addr;
priv->bus = mdiodev->bus;
priv->dev = &mdiodev->dev;
priv->chip_data = (void *)priv + sizeof(*priv);
priv->clk_delay = var->clk_delay;
priv->cmd_read = var->cmd_read;
priv->cmd_write = var->cmd_write;
priv->ops = var->ops;
priv->write_reg_noack = realtek_mdio_write;
np = dev->of_node;
dev_set_drvdata(dev, priv);
/* TODO: if power is software controlled, set up any regulators here */
priv->leds_disabled = of_property_read_bool(np, "realtek,disable-leds");
ret = priv->ops->detect(priv);
if (ret) {
dev_err(dev, "unable to detect switch\n");
return ret;
}
priv->ds = devm_kzalloc(dev, sizeof(*priv->ds), GFP_KERNEL);
if (!priv->ds)
return -ENOMEM;
priv->ds->dev = dev;
priv->ds->num_ports = priv->num_ports;
priv->ds->priv = priv;
priv->ds->ops = var->ds_ops_mdio;
ret = dsa_register_switch(priv->ds);
if (ret) {
dev_err(priv->dev, "unable to register switch ret = %d\n", ret);
return ret;
}
return 0;
}
static void realtek_mdio_remove(struct mdio_device *mdiodev)
{
struct realtek_priv *priv = dev_get_drvdata(&mdiodev->dev);
if (!priv)
return;
dsa_unregister_switch(priv->ds);
dev_set_drvdata(&mdiodev->dev, NULL);
}
static void realtek_mdio_shutdown(struct mdio_device *mdiodev)
{
struct realtek_priv *priv = dev_get_drvdata(&mdiodev->dev);
if (!priv)
return;
dsa_switch_shutdown(priv->ds);
dev_set_drvdata(&mdiodev->dev, NULL);
}
static const struct of_device_id realtek_mdio_of_match[] = {
#if IS_ENABLED(CONFIG_NET_DSA_REALTEK_RTL8366RB)
{ .compatible = "realtek,rtl8366rb", .data = &rtl8366rb_variant, },
#endif
#if IS_ENABLED(CONFIG_NET_DSA_REALTEK_RTL8365MB)
{ .compatible = "realtek,rtl8365mb", .data = &rtl8365mb_variant, },
{ .compatible = "realtek,rtl8367s", .data = &rtl8365mb_variant, },
#endif
{ /* sentinel */ },
};
MODULE_DEVICE_TABLE(of, realtek_mdio_of_match);
static struct mdio_driver realtek_mdio_driver = {
.mdiodrv.driver = {
.name = "realtek-mdio",
.of_match_table = of_match_ptr(realtek_mdio_of_match),
},
.probe = realtek_mdio_probe,
.remove = realtek_mdio_remove,
.shutdown = realtek_mdio_shutdown,
};
mdio_module_driver(realtek_mdio_driver);
MODULE_AUTHOR("Luiz Angelo Daros de Luca <luizluca@gmail.com>");
MODULE_DESCRIPTION("Driver for Realtek ethernet switch connected via MDIO interface");
MODULE_LICENSE("GPL");
...@@ -40,105 +40,105 @@ ...@@ -40,105 +40,105 @@
#include <linux/bitops.h> #include <linux/bitops.h>
#include <linux/if_bridge.h> #include <linux/if_bridge.h>
#include "realtek-smi-core.h" #include "realtek.h"
#define REALTEK_SMI_ACK_RETRY_COUNT 5 #define REALTEK_SMI_ACK_RETRY_COUNT 5
#define REALTEK_SMI_HW_STOP_DELAY 25 /* msecs */ #define REALTEK_SMI_HW_STOP_DELAY 25 /* msecs */
#define REALTEK_SMI_HW_START_DELAY 100 /* msecs */ #define REALTEK_SMI_HW_START_DELAY 100 /* msecs */
static inline void realtek_smi_clk_delay(struct realtek_smi *smi) static inline void realtek_smi_clk_delay(struct realtek_priv *priv)
{ {
ndelay(smi->clk_delay); ndelay(priv->clk_delay);
} }
static void realtek_smi_start(struct realtek_smi *smi) static void realtek_smi_start(struct realtek_priv *priv)
{ {
/* Set GPIO pins to output mode, with initial state: /* Set GPIO pins to output mode, with initial state:
* SCK = 0, SDA = 1 * SCK = 0, SDA = 1
*/ */
gpiod_direction_output(smi->mdc, 0); gpiod_direction_output(priv->mdc, 0);
gpiod_direction_output(smi->mdio, 1); gpiod_direction_output(priv->mdio, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
/* CLK 1: 0 -> 1, 1 -> 0 */ /* CLK 1: 0 -> 1, 1 -> 0 */
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 0); gpiod_set_value(priv->mdc, 0);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
/* CLK 2: */ /* CLK 2: */
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdio, 0); gpiod_set_value(priv->mdio, 0);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 0); gpiod_set_value(priv->mdc, 0);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdio, 1); gpiod_set_value(priv->mdio, 1);
} }
static void realtek_smi_stop(struct realtek_smi *smi) static void realtek_smi_stop(struct realtek_priv *priv)
{ {
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdio, 0); gpiod_set_value(priv->mdio, 0);
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdio, 1); gpiod_set_value(priv->mdio, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 0); gpiod_set_value(priv->mdc, 0);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
/* Add a click */ /* Add a click */
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 0); gpiod_set_value(priv->mdc, 0);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
/* Set GPIO pins to input mode */ /* Set GPIO pins to input mode */
gpiod_direction_input(smi->mdio); gpiod_direction_input(priv->mdio);
gpiod_direction_input(smi->mdc); gpiod_direction_input(priv->mdc);
} }
static void realtek_smi_write_bits(struct realtek_smi *smi, u32 data, u32 len) static void realtek_smi_write_bits(struct realtek_priv *priv, u32 data, u32 len)
{ {
for (; len > 0; len--) { for (; len > 0; len--) {
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
/* Prepare data */ /* Prepare data */
gpiod_set_value(smi->mdio, !!(data & (1 << (len - 1)))); gpiod_set_value(priv->mdio, !!(data & (1 << (len - 1))));
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
/* Clocking */ /* Clocking */
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
gpiod_set_value(smi->mdc, 0); gpiod_set_value(priv->mdc, 0);
} }
} }
static void realtek_smi_read_bits(struct realtek_smi *smi, u32 len, u32 *data) static void realtek_smi_read_bits(struct realtek_priv *priv, u32 len, u32 *data)
{ {
gpiod_direction_input(smi->mdio); gpiod_direction_input(priv->mdio);
for (*data = 0; len > 0; len--) { for (*data = 0; len > 0; len--) {
u32 u; u32 u;
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
/* Clocking */ /* Clocking */
gpiod_set_value(smi->mdc, 1); gpiod_set_value(priv->mdc, 1);
realtek_smi_clk_delay(smi); realtek_smi_clk_delay(priv);
u = !!gpiod_get_value(smi->mdio); u = !!gpiod_get_value(priv->mdio);
gpiod_set_value(smi->mdc, 0); gpiod_set_value(priv->mdc, 0);
*data |= (u << (len - 1)); *data |= (u << (len - 1));
} }
gpiod_direction_output(smi->mdio, 0); gpiod_direction_output(priv->mdio, 0);
} }
static int realtek_smi_wait_for_ack(struct realtek_smi *smi) static int realtek_smi_wait_for_ack(struct realtek_priv *priv)
{ {
int retry_cnt; int retry_cnt;
...@@ -146,12 +146,12 @@ static int realtek_smi_wait_for_ack(struct realtek_smi *smi) ...@@ -146,12 +146,12 @@ static int realtek_smi_wait_for_ack(struct realtek_smi *smi)
do { do {
u32 ack; u32 ack;
realtek_smi_read_bits(smi, 1, &ack); realtek_smi_read_bits(priv, 1, &ack);
if (ack == 0) if (ack == 0)
break; break;
if (++retry_cnt > REALTEK_SMI_ACK_RETRY_COUNT) { if (++retry_cnt > REALTEK_SMI_ACK_RETRY_COUNT) {
dev_err(smi->dev, "ACK timeout\n"); dev_err(priv->dev, "ACK timeout\n");
return -ETIMEDOUT; return -ETIMEDOUT;
} }
} while (1); } while (1);
...@@ -159,131 +159,131 @@ static int realtek_smi_wait_for_ack(struct realtek_smi *smi) ...@@ -159,131 +159,131 @@ static int realtek_smi_wait_for_ack(struct realtek_smi *smi)
return 0; return 0;
} }
static int realtek_smi_write_byte(struct realtek_smi *smi, u8 data) static int realtek_smi_write_byte(struct realtek_priv *priv, u8 data)
{ {
realtek_smi_write_bits(smi, data, 8); realtek_smi_write_bits(priv, data, 8);
return realtek_smi_wait_for_ack(smi); return realtek_smi_wait_for_ack(priv);
} }
static int realtek_smi_write_byte_noack(struct realtek_smi *smi, u8 data) static int realtek_smi_write_byte_noack(struct realtek_priv *priv, u8 data)
{ {
realtek_smi_write_bits(smi, data, 8); realtek_smi_write_bits(priv, data, 8);
return 0; return 0;
} }
static int realtek_smi_read_byte0(struct realtek_smi *smi, u8 *data) static int realtek_smi_read_byte0(struct realtek_priv *priv, u8 *data)
{ {
u32 t; u32 t;
/* Read data */ /* Read data */
realtek_smi_read_bits(smi, 8, &t); realtek_smi_read_bits(priv, 8, &t);
*data = (t & 0xff); *data = (t & 0xff);
/* Send an ACK */ /* Send an ACK */
realtek_smi_write_bits(smi, 0x00, 1); realtek_smi_write_bits(priv, 0x00, 1);
return 0; return 0;
} }
static int realtek_smi_read_byte1(struct realtek_smi *smi, u8 *data) static int realtek_smi_read_byte1(struct realtek_priv *priv, u8 *data)
{ {
u32 t; u32 t;
/* Read data */ /* Read data */
realtek_smi_read_bits(smi, 8, &t); realtek_smi_read_bits(priv, 8, &t);
*data = (t & 0xff); *data = (t & 0xff);
/* Send an ACK */ /* Send an ACK */
realtek_smi_write_bits(smi, 0x01, 1); realtek_smi_write_bits(priv, 0x01, 1);
return 0; return 0;
} }
static int realtek_smi_read_reg(struct realtek_smi *smi, u32 addr, u32 *data) static int realtek_smi_read_reg(struct realtek_priv *priv, u32 addr, u32 *data)
{ {
unsigned long flags; unsigned long flags;
u8 lo = 0; u8 lo = 0;
u8 hi = 0; u8 hi = 0;
int ret; int ret;
spin_lock_irqsave(&smi->lock, flags); spin_lock_irqsave(&priv->lock, flags);
realtek_smi_start(smi); realtek_smi_start(priv);
/* Send READ command */ /* Send READ command */
ret = realtek_smi_write_byte(smi, smi->cmd_read); ret = realtek_smi_write_byte(priv, priv->cmd_read);
if (ret) if (ret)
goto out; goto out;
/* Set ADDR[7:0] */ /* Set ADDR[7:0] */
ret = realtek_smi_write_byte(smi, addr & 0xff); ret = realtek_smi_write_byte(priv, addr & 0xff);
if (ret) if (ret)
goto out; goto out;
/* Set ADDR[15:8] */ /* Set ADDR[15:8] */
ret = realtek_smi_write_byte(smi, addr >> 8); ret = realtek_smi_write_byte(priv, addr >> 8);
if (ret) if (ret)
goto out; goto out;
/* Read DATA[7:0] */ /* Read DATA[7:0] */
realtek_smi_read_byte0(smi, &lo); realtek_smi_read_byte0(priv, &lo);
/* Read DATA[15:8] */ /* Read DATA[15:8] */
realtek_smi_read_byte1(smi, &hi); realtek_smi_read_byte1(priv, &hi);
*data = ((u32)lo) | (((u32)hi) << 8); *data = ((u32)lo) | (((u32)hi) << 8);
ret = 0; ret = 0;
out: out:
realtek_smi_stop(smi); realtek_smi_stop(priv);
spin_unlock_irqrestore(&smi->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
return ret; return ret;
} }
static int realtek_smi_write_reg(struct realtek_smi *smi, static int realtek_smi_write_reg(struct realtek_priv *priv,
u32 addr, u32 data, bool ack) u32 addr, u32 data, bool ack)
{ {
unsigned long flags; unsigned long flags;
int ret; int ret;
spin_lock_irqsave(&smi->lock, flags); spin_lock_irqsave(&priv->lock, flags);
realtek_smi_start(smi); realtek_smi_start(priv);
/* Send WRITE command */ /* Send WRITE command */
ret = realtek_smi_write_byte(smi, smi->cmd_write); ret = realtek_smi_write_byte(priv, priv->cmd_write);
if (ret) if (ret)
goto out; goto out;
/* Set ADDR[7:0] */ /* Set ADDR[7:0] */
ret = realtek_smi_write_byte(smi, addr & 0xff); ret = realtek_smi_write_byte(priv, addr & 0xff);
if (ret) if (ret)
goto out; goto out;
/* Set ADDR[15:8] */ /* Set ADDR[15:8] */
ret = realtek_smi_write_byte(smi, addr >> 8); ret = realtek_smi_write_byte(priv, addr >> 8);
if (ret) if (ret)
goto out; goto out;
/* Write DATA[7:0] */ /* Write DATA[7:0] */
ret = realtek_smi_write_byte(smi, data & 0xff); ret = realtek_smi_write_byte(priv, data & 0xff);
if (ret) if (ret)
goto out; goto out;
/* Write DATA[15:8] */ /* Write DATA[15:8] */
if (ack) if (ack)
ret = realtek_smi_write_byte(smi, data >> 8); ret = realtek_smi_write_byte(priv, data >> 8);
else else
ret = realtek_smi_write_byte_noack(smi, data >> 8); ret = realtek_smi_write_byte_noack(priv, data >> 8);
if (ret) if (ret)
goto out; goto out;
ret = 0; ret = 0;
out: out:
realtek_smi_stop(smi); realtek_smi_stop(priv);
spin_unlock_irqrestore(&smi->lock, flags); spin_unlock_irqrestore(&priv->lock, flags);
return ret; return ret;
} }
...@@ -292,27 +292,25 @@ static int realtek_smi_write_reg(struct realtek_smi *smi, ...@@ -292,27 +292,25 @@ static int realtek_smi_write_reg(struct realtek_smi *smi,
* is when issueing soft reset. Since the device reset as soon as we write * is when issueing soft reset. Since the device reset as soon as we write
* that bit, no ACK will come back for natural reasons. * that bit, no ACK will come back for natural reasons.
*/ */
int realtek_smi_write_reg_noack(struct realtek_smi *smi, u32 addr, static int realtek_smi_write_reg_noack(void *ctx, u32 reg, u32 val)
u32 data)
{ {
return realtek_smi_write_reg(smi, addr, data, false); return realtek_smi_write_reg(ctx, reg, val, false);
} }
EXPORT_SYMBOL_GPL(realtek_smi_write_reg_noack);
/* Regmap accessors */ /* Regmap accessors */
static int realtek_smi_write(void *ctx, u32 reg, u32 val) static int realtek_smi_write(void *ctx, u32 reg, u32 val)
{ {
struct realtek_smi *smi = ctx; struct realtek_priv *priv = ctx;
return realtek_smi_write_reg(smi, reg, val, true); return realtek_smi_write_reg(priv, reg, val, true);
} }
static int realtek_smi_read(void *ctx, u32 reg, u32 *val) static int realtek_smi_read(void *ctx, u32 reg, u32 *val)
{ {
struct realtek_smi *smi = ctx; struct realtek_priv *priv = ctx;
return realtek_smi_read_reg(smi, reg, val); return realtek_smi_read_reg(priv, reg, val);
} }
static const struct regmap_config realtek_smi_mdio_regmap_config = { static const struct regmap_config realtek_smi_mdio_regmap_config = {
...@@ -329,49 +327,50 @@ static const struct regmap_config realtek_smi_mdio_regmap_config = { ...@@ -329,49 +327,50 @@ static const struct regmap_config realtek_smi_mdio_regmap_config = {
static int realtek_smi_mdio_read(struct mii_bus *bus, int addr, int regnum) static int realtek_smi_mdio_read(struct mii_bus *bus, int addr, int regnum)
{ {
struct realtek_smi *smi = bus->priv; struct realtek_priv *priv = bus->priv;
return smi->ops->phy_read(smi, addr, regnum); return priv->ops->phy_read(priv, addr, regnum);
} }
static int realtek_smi_mdio_write(struct mii_bus *bus, int addr, int regnum, static int realtek_smi_mdio_write(struct mii_bus *bus, int addr, int regnum,
u16 val) u16 val)
{ {
struct realtek_smi *smi = bus->priv; struct realtek_priv *priv = bus->priv;
return smi->ops->phy_write(smi, addr, regnum, val); return priv->ops->phy_write(priv, addr, regnum, val);
} }
int realtek_smi_setup_mdio(struct realtek_smi *smi) static int realtek_smi_setup_mdio(struct dsa_switch *ds)
{ {
struct realtek_priv *priv = ds->priv;
struct device_node *mdio_np; struct device_node *mdio_np;
int ret; int ret;
mdio_np = of_get_compatible_child(smi->dev->of_node, "realtek,smi-mdio"); mdio_np = of_get_compatible_child(priv->dev->of_node, "realtek,smi-mdio");
if (!mdio_np) { if (!mdio_np) {
dev_err(smi->dev, "no MDIO bus node\n"); dev_err(priv->dev, "no MDIO bus node\n");
return -ENODEV; return -ENODEV;
} }
smi->slave_mii_bus = devm_mdiobus_alloc(smi->dev); priv->slave_mii_bus = devm_mdiobus_alloc(priv->dev);
if (!smi->slave_mii_bus) { if (!priv->slave_mii_bus) {
ret = -ENOMEM; ret = -ENOMEM;
goto err_put_node; goto err_put_node;
} }
smi->slave_mii_bus->priv = smi; priv->slave_mii_bus->priv = priv;
smi->slave_mii_bus->name = "SMI slave MII"; priv->slave_mii_bus->name = "SMI slave MII";
smi->slave_mii_bus->read = realtek_smi_mdio_read; priv->slave_mii_bus->read = realtek_smi_mdio_read;
smi->slave_mii_bus->write = realtek_smi_mdio_write; priv->slave_mii_bus->write = realtek_smi_mdio_write;
snprintf(smi->slave_mii_bus->id, MII_BUS_ID_SIZE, "SMI-%d", snprintf(priv->slave_mii_bus->id, MII_BUS_ID_SIZE, "SMI-%d",
smi->ds->index); ds->index);
smi->slave_mii_bus->dev.of_node = mdio_np; priv->slave_mii_bus->dev.of_node = mdio_np;
smi->slave_mii_bus->parent = smi->dev; priv->slave_mii_bus->parent = priv->dev;
smi->ds->slave_mii_bus = smi->slave_mii_bus; ds->slave_mii_bus = priv->slave_mii_bus;
ret = devm_of_mdiobus_register(smi->dev, smi->slave_mii_bus, mdio_np); ret = devm_of_mdiobus_register(priv->dev, priv->slave_mii_bus, mdio_np);
if (ret) { if (ret) {
dev_err(smi->dev, "unable to register MDIO bus %s\n", dev_err(priv->dev, "unable to register MDIO bus %s\n",
smi->slave_mii_bus->id); priv->slave_mii_bus->id);
goto err_put_node; goto err_put_node;
} }
...@@ -385,76 +384,79 @@ int realtek_smi_setup_mdio(struct realtek_smi *smi) ...@@ -385,76 +384,79 @@ int realtek_smi_setup_mdio(struct realtek_smi *smi)
static int realtek_smi_probe(struct platform_device *pdev) static int realtek_smi_probe(struct platform_device *pdev)
{ {
const struct realtek_smi_variant *var; const struct realtek_variant *var;
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct realtek_smi *smi; struct realtek_priv *priv;
struct device_node *np; struct device_node *np;
int ret; int ret;
var = of_device_get_match_data(dev); var = of_device_get_match_data(dev);
np = dev->of_node; np = dev->of_node;
smi = devm_kzalloc(dev, sizeof(*smi) + var->chip_data_sz, GFP_KERNEL); priv = devm_kzalloc(dev, sizeof(*priv) + var->chip_data_sz, GFP_KERNEL);
if (!smi) if (!priv)
return -ENOMEM; return -ENOMEM;
smi->chip_data = (void *)smi + sizeof(*smi); priv->chip_data = (void *)priv + sizeof(*priv);
smi->map = devm_regmap_init(dev, NULL, smi, priv->map = devm_regmap_init(dev, NULL, priv,
&realtek_smi_mdio_regmap_config); &realtek_smi_mdio_regmap_config);
if (IS_ERR(smi->map)) { if (IS_ERR(priv->map)) {
ret = PTR_ERR(smi->map); ret = PTR_ERR(priv->map);
dev_err(dev, "regmap init failed: %d\n", ret); dev_err(dev, "regmap init failed: %d\n", ret);
return ret; return ret;
} }
/* Link forward and backward */ /* Link forward and backward */
smi->dev = dev; priv->dev = dev;
smi->clk_delay = var->clk_delay; priv->clk_delay = var->clk_delay;
smi->cmd_read = var->cmd_read; priv->cmd_read = var->cmd_read;
smi->cmd_write = var->cmd_write; priv->cmd_write = var->cmd_write;
smi->ops = var->ops; priv->ops = var->ops;
dev_set_drvdata(dev, smi); priv->setup_interface = realtek_smi_setup_mdio;
spin_lock_init(&smi->lock); priv->write_reg_noack = realtek_smi_write_reg_noack;
dev_set_drvdata(dev, priv);
spin_lock_init(&priv->lock);
/* TODO: if power is software controlled, set up any regulators here */ /* TODO: if power is software controlled, set up any regulators here */
/* Assert then deassert RESET */ /* Assert then deassert RESET */
smi->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH); priv->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_HIGH);
if (IS_ERR(smi->reset)) { if (IS_ERR(priv->reset)) {
dev_err(dev, "failed to get RESET GPIO\n"); dev_err(dev, "failed to get RESET GPIO\n");
return PTR_ERR(smi->reset); return PTR_ERR(priv->reset);
} }
msleep(REALTEK_SMI_HW_STOP_DELAY); msleep(REALTEK_SMI_HW_STOP_DELAY);
gpiod_set_value(smi->reset, 0); gpiod_set_value(priv->reset, 0);
msleep(REALTEK_SMI_HW_START_DELAY); msleep(REALTEK_SMI_HW_START_DELAY);
dev_info(dev, "deasserted RESET\n"); dev_info(dev, "deasserted RESET\n");
/* Fetch MDIO pins */ /* Fetch MDIO pins */
smi->mdc = devm_gpiod_get_optional(dev, "mdc", GPIOD_OUT_LOW); priv->mdc = devm_gpiod_get_optional(dev, "mdc", GPIOD_OUT_LOW);
if (IS_ERR(smi->mdc)) if (IS_ERR(priv->mdc))
return PTR_ERR(smi->mdc); return PTR_ERR(priv->mdc);
smi->mdio = devm_gpiod_get_optional(dev, "mdio", GPIOD_OUT_LOW); priv->mdio = devm_gpiod_get_optional(dev, "mdio", GPIOD_OUT_LOW);
if (IS_ERR(smi->mdio)) if (IS_ERR(priv->mdio))
return PTR_ERR(smi->mdio); return PTR_ERR(priv->mdio);
smi->leds_disabled = of_property_read_bool(np, "realtek,disable-leds"); priv->leds_disabled = of_property_read_bool(np, "realtek,disable-leds");
ret = smi->ops->detect(smi); ret = priv->ops->detect(priv);
if (ret) { if (ret) {
dev_err(dev, "unable to detect switch\n"); dev_err(dev, "unable to detect switch\n");
return ret; return ret;
} }
smi->ds = devm_kzalloc(dev, sizeof(*smi->ds), GFP_KERNEL); priv->ds = devm_kzalloc(dev, sizeof(*priv->ds), GFP_KERNEL);
if (!smi->ds) if (!priv->ds)
return -ENOMEM; return -ENOMEM;
smi->ds->dev = dev; priv->ds->dev = dev;
smi->ds->num_ports = smi->num_ports; priv->ds->num_ports = priv->num_ports;
smi->ds->priv = smi; priv->ds->priv = priv;
smi->ds->ops = var->ds_ops; priv->ds->ops = var->ds_ops_smi;
ret = dsa_register_switch(smi->ds); ret = dsa_register_switch(priv->ds);
if (ret) { if (ret) {
dev_err_probe(dev, ret, "unable to register switch\n"); dev_err_probe(dev, ret, "unable to register switch\n");
return ret; return ret;
...@@ -464,15 +466,15 @@ static int realtek_smi_probe(struct platform_device *pdev) ...@@ -464,15 +466,15 @@ static int realtek_smi_probe(struct platform_device *pdev)
static int realtek_smi_remove(struct platform_device *pdev) static int realtek_smi_remove(struct platform_device *pdev)
{ {
struct realtek_smi *smi = platform_get_drvdata(pdev); struct realtek_priv *priv = platform_get_drvdata(pdev);
if (!smi) if (!priv)
return 0; return 0;
dsa_unregister_switch(smi->ds); dsa_unregister_switch(priv->ds);
if (smi->slave_mii_bus) if (priv->slave_mii_bus)
of_node_put(smi->slave_mii_bus->dev.of_node); of_node_put(priv->slave_mii_bus->dev.of_node);
gpiod_set_value(smi->reset, 1); gpiod_set_value(priv->reset, 1);
platform_set_drvdata(pdev, NULL); platform_set_drvdata(pdev, NULL);
...@@ -481,30 +483,38 @@ static int realtek_smi_remove(struct platform_device *pdev) ...@@ -481,30 +483,38 @@ static int realtek_smi_remove(struct platform_device *pdev)
static void realtek_smi_shutdown(struct platform_device *pdev) static void realtek_smi_shutdown(struct platform_device *pdev)
{ {
struct realtek_smi *smi = platform_get_drvdata(pdev); struct realtek_priv *priv = platform_get_drvdata(pdev);
if (!smi) if (!priv)
return; return;
dsa_switch_shutdown(smi->ds); dsa_switch_shutdown(priv->ds);
platform_set_drvdata(pdev, NULL); platform_set_drvdata(pdev, NULL);
} }
static const struct of_device_id realtek_smi_of_match[] = { static const struct of_device_id realtek_smi_of_match[] = {
#if IS_ENABLED(CONFIG_NET_DSA_REALTEK_RTL8366RB)
{ {
.compatible = "realtek,rtl8366rb", .compatible = "realtek,rtl8366rb",
.data = &rtl8366rb_variant, .data = &rtl8366rb_variant,
}, },
#endif
{ {
/* FIXME: add support for RTL8366S and more */ /* FIXME: add support for RTL8366S and more */
.compatible = "realtek,rtl8366s", .compatible = "realtek,rtl8366s",
.data = NULL, .data = NULL,
}, },
#if IS_ENABLED(CONFIG_NET_DSA_REALTEK_RTL8365MB)
{ {
.compatible = "realtek,rtl8365mb", .compatible = "realtek,rtl8365mb",
.data = &rtl8365mb_variant, .data = &rtl8365mb_variant,
}, },
{
.compatible = "realtek,rtl8367s",
.data = &rtl8365mb_variant,
},
#endif
{ /* sentinel */ }, { /* sentinel */ },
}; };
MODULE_DEVICE_TABLE(of, realtek_smi_of_match); MODULE_DEVICE_TABLE(of, realtek_smi_of_match);
...@@ -520,4 +530,6 @@ static struct platform_driver realtek_smi_driver = { ...@@ -520,4 +530,6 @@ static struct platform_driver realtek_smi_driver = {
}; };
module_platform_driver(realtek_smi_driver); module_platform_driver(realtek_smi_driver);
MODULE_AUTHOR("Linus Walleij <linus.walleij@linaro.org>");
MODULE_DESCRIPTION("Driver for Realtek ethernet switch connected via SMI interface");
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
...@@ -13,7 +13,7 @@ ...@@ -13,7 +13,7 @@
#include <linux/gpio/consumer.h> #include <linux/gpio/consumer.h>
#include <net/dsa.h> #include <net/dsa.h>
struct realtek_smi_ops; struct realtek_ops;
struct dentry; struct dentry;
struct inode; struct inode;
struct file; struct file;
...@@ -25,7 +25,7 @@ struct rtl8366_mib_counter { ...@@ -25,7 +25,7 @@ struct rtl8366_mib_counter {
const char *name; const char *name;
}; };
/** /*
* struct rtl8366_vlan_mc - Virtual LAN member configuration * struct rtl8366_vlan_mc - Virtual LAN member configuration
*/ */
struct rtl8366_vlan_mc { struct rtl8366_vlan_mc {
...@@ -43,13 +43,15 @@ struct rtl8366_vlan_4k { ...@@ -43,13 +43,15 @@ struct rtl8366_vlan_4k {
u8 fid; u8 fid;
}; };
struct realtek_smi { struct realtek_priv {
struct device *dev; struct device *dev;
struct gpio_desc *reset; struct gpio_desc *reset;
struct gpio_desc *mdc; struct gpio_desc *mdc;
struct gpio_desc *mdio; struct gpio_desc *mdio;
struct regmap *map; struct regmap *map;
struct mii_bus *slave_mii_bus; struct mii_bus *slave_mii_bus;
struct mii_bus *bus;
int mdio_addr;
unsigned int clk_delay; unsigned int clk_delay;
u8 cmd_read; u8 cmd_read;
...@@ -65,7 +67,9 @@ struct realtek_smi { ...@@ -65,7 +67,9 @@ struct realtek_smi {
unsigned int num_mib_counters; unsigned int num_mib_counters;
struct rtl8366_mib_counter *mib_counters; struct rtl8366_mib_counter *mib_counters;
const struct realtek_smi_ops *ops; const struct realtek_ops *ops;
int (*setup_interface)(struct dsa_switch *ds);
int (*write_reg_noack)(void *ctx, u32 addr, u32 data);
int vlan_enabled; int vlan_enabled;
int vlan4k_enabled; int vlan4k_enabled;
...@@ -74,61 +78,57 @@ struct realtek_smi { ...@@ -74,61 +78,57 @@ struct realtek_smi {
void *chip_data; /* Per-chip extra variant data */ void *chip_data; /* Per-chip extra variant data */
}; };
/** /*
* struct realtek_smi_ops - vtable for the per-SMI-chiptype operations * struct realtek_ops - vtable for the per-SMI-chiptype operations
* @detect: detects the chiptype * @detect: detects the chiptype
*/ */
struct realtek_smi_ops { struct realtek_ops {
int (*detect)(struct realtek_smi *smi); int (*detect)(struct realtek_priv *priv);
int (*reset_chip)(struct realtek_smi *smi); int (*reset_chip)(struct realtek_priv *priv);
int (*setup)(struct realtek_smi *smi); int (*setup)(struct realtek_priv *priv);
void (*cleanup)(struct realtek_smi *smi); void (*cleanup)(struct realtek_priv *priv);
int (*get_mib_counter)(struct realtek_smi *smi, int (*get_mib_counter)(struct realtek_priv *priv,
int port, int port,
struct rtl8366_mib_counter *mib, struct rtl8366_mib_counter *mib,
u64 *mibvalue); u64 *mibvalue);
int (*get_vlan_mc)(struct realtek_smi *smi, u32 index, int (*get_vlan_mc)(struct realtek_priv *priv, u32 index,
struct rtl8366_vlan_mc *vlanmc); struct rtl8366_vlan_mc *vlanmc);
int (*set_vlan_mc)(struct realtek_smi *smi, u32 index, int (*set_vlan_mc)(struct realtek_priv *priv, u32 index,
const struct rtl8366_vlan_mc *vlanmc); const struct rtl8366_vlan_mc *vlanmc);
int (*get_vlan_4k)(struct realtek_smi *smi, u32 vid, int (*get_vlan_4k)(struct realtek_priv *priv, u32 vid,
struct rtl8366_vlan_4k *vlan4k); struct rtl8366_vlan_4k *vlan4k);
int (*set_vlan_4k)(struct realtek_smi *smi, int (*set_vlan_4k)(struct realtek_priv *priv,
const struct rtl8366_vlan_4k *vlan4k); const struct rtl8366_vlan_4k *vlan4k);
int (*get_mc_index)(struct realtek_smi *smi, int port, int *val); int (*get_mc_index)(struct realtek_priv *priv, int port, int *val);
int (*set_mc_index)(struct realtek_smi *smi, int port, int index); int (*set_mc_index)(struct realtek_priv *priv, int port, int index);
bool (*is_vlan_valid)(struct realtek_smi *smi, unsigned int vlan); bool (*is_vlan_valid)(struct realtek_priv *priv, unsigned int vlan);
int (*enable_vlan)(struct realtek_smi *smi, bool enable); int (*enable_vlan)(struct realtek_priv *priv, bool enable);
int (*enable_vlan4k)(struct realtek_smi *smi, bool enable); int (*enable_vlan4k)(struct realtek_priv *priv, bool enable);
int (*enable_port)(struct realtek_smi *smi, int port, bool enable); int (*enable_port)(struct realtek_priv *priv, int port, bool enable);
int (*phy_read)(struct realtek_smi *smi, int phy, int regnum); int (*phy_read)(struct realtek_priv *priv, int phy, int regnum);
int (*phy_write)(struct realtek_smi *smi, int phy, int regnum, int (*phy_write)(struct realtek_priv *priv, int phy, int regnum,
u16 val); u16 val);
}; };
struct realtek_smi_variant { struct realtek_variant {
const struct dsa_switch_ops *ds_ops; const struct dsa_switch_ops *ds_ops_smi;
const struct realtek_smi_ops *ops; const struct dsa_switch_ops *ds_ops_mdio;
const struct realtek_ops *ops;
unsigned int clk_delay; unsigned int clk_delay;
u8 cmd_read; u8 cmd_read;
u8 cmd_write; u8 cmd_write;
size_t chip_data_sz; size_t chip_data_sz;
}; };
/* SMI core calls */
int realtek_smi_write_reg_noack(struct realtek_smi *smi, u32 addr,
u32 data);
int realtek_smi_setup_mdio(struct realtek_smi *smi);
/* RTL8366 library helpers */ /* RTL8366 library helpers */
int rtl8366_mc_is_used(struct realtek_smi *smi, int mc_index, int *used); int rtl8366_mc_is_used(struct realtek_priv *priv, int mc_index, int *used);
int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member, int rtl8366_set_vlan(struct realtek_priv *priv, int vid, u32 member,
u32 untag, u32 fid); u32 untag, u32 fid);
int rtl8366_set_pvid(struct realtek_smi *smi, unsigned int port, int rtl8366_set_pvid(struct realtek_priv *priv, unsigned int port,
unsigned int vid); unsigned int vid);
int rtl8366_enable_vlan4k(struct realtek_smi *smi, bool enable); int rtl8366_enable_vlan4k(struct realtek_priv *priv, bool enable);
int rtl8366_enable_vlan(struct realtek_smi *smi, bool enable); int rtl8366_enable_vlan(struct realtek_priv *priv, bool enable);
int rtl8366_reset_vlan(struct realtek_smi *smi); int rtl8366_reset_vlan(struct realtek_priv *priv);
int rtl8366_vlan_add(struct dsa_switch *ds, int port, int rtl8366_vlan_add(struct dsa_switch *ds, int port,
const struct switchdev_obj_port_vlan *vlan, const struct switchdev_obj_port_vlan *vlan,
struct netlink_ext_ack *extack); struct netlink_ext_ack *extack);
...@@ -139,7 +139,7 @@ void rtl8366_get_strings(struct dsa_switch *ds, int port, u32 stringset, ...@@ -139,7 +139,7 @@ void rtl8366_get_strings(struct dsa_switch *ds, int port, u32 stringset,
int rtl8366_get_sset_count(struct dsa_switch *ds, int port, int sset); int rtl8366_get_sset_count(struct dsa_switch *ds, int port, int sset);
void rtl8366_get_ethtool_stats(struct dsa_switch *ds, int port, uint64_t *data); void rtl8366_get_ethtool_stats(struct dsa_switch *ds, int port, uint64_t *data);
extern const struct realtek_smi_variant rtl8366rb_variant; extern const struct realtek_variant rtl8366rb_variant;
extern const struct realtek_smi_variant rtl8365mb_variant; extern const struct realtek_variant rtl8365mb_variant;
#endif /* _REALTEK_SMI_H */ #endif /* _REALTEK_SMI_H */
...@@ -99,18 +99,28 @@ ...@@ -99,18 +99,28 @@
#include <linux/regmap.h> #include <linux/regmap.h>
#include <linux/if_bridge.h> #include <linux/if_bridge.h>
#include "realtek-smi-core.h" #include "realtek.h"
/* Chip-specific data and limits */ /* Chip-specific data and limits */
#define RTL8365MB_CHIP_ID_8365MB_VC 0x6367 #define RTL8365MB_CHIP_ID_8365MB_VC 0x6367
#define RTL8365MB_CPU_PORT_NUM_8365MB_VC 6 #define RTL8365MB_CHIP_VER_8365MB_VC 0x0040
#define RTL8365MB_LEARN_LIMIT_MAX_8365MB_VC 2112
#define RTL8365MB_CHIP_ID_8367S 0x6367
#define RTL8365MB_CHIP_VER_8367S 0x00A0
#define RTL8365MB_CHIP_ID_8367RB 0x6367
#define RTL8365MB_CHIP_VER_8367RB 0x0020
/* Family-specific data and limits */ /* Family-specific data and limits */
#define RTL8365MB_PHYADDRMAX 7 #define RTL8365MB_PHYADDRMAX 7
#define RTL8365MB_NUM_PHYREGS 32 #define RTL8365MB_NUM_PHYREGS 32
#define RTL8365MB_PHYREGMAX (RTL8365MB_NUM_PHYREGS - 1) #define RTL8365MB_PHYREGMAX (RTL8365MB_NUM_PHYREGS - 1)
#define RTL8365MB_MAX_NUM_PORTS (RTL8365MB_CPU_PORT_NUM_8365MB_VC + 1) /* RTL8370MB and RTL8310SR, possibly suportable by this driver, have 10 ports */
#define RTL8365MB_MAX_NUM_PORTS 10
#define RTL8365MB_LEARN_LIMIT_MAX 2112
/* valid for all 6-port or less variants */
static const int rtl8365mb_extint_port_map[] = { -1, -1, -1, -1, -1, -1, 1, 2, -1, -1};
/* Chip identification registers */ /* Chip identification registers */
#define RTL8365MB_CHIP_ID_REG 0x1300 #define RTL8365MB_CHIP_ID_REG 0x1300
...@@ -191,7 +201,7 @@ ...@@ -191,7 +201,7 @@
/* The PHY OCP addresses of PHY registers 0~31 start here */ /* The PHY OCP addresses of PHY registers 0~31 start here */
#define RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE 0xA400 #define RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE 0xA400
/* EXT port interface mode values - used in DIGITAL_INTERFACE_SELECT */ /* EXT interface port mode values - used in DIGITAL_INTERFACE_SELECT */
#define RTL8365MB_EXT_PORT_MODE_DISABLE 0 #define RTL8365MB_EXT_PORT_MODE_DISABLE 0
#define RTL8365MB_EXT_PORT_MODE_RGMII 1 #define RTL8365MB_EXT_PORT_MODE_RGMII 1
#define RTL8365MB_EXT_PORT_MODE_MII_MAC 2 #define RTL8365MB_EXT_PORT_MODE_MII_MAC 2
...@@ -207,39 +217,56 @@ ...@@ -207,39 +217,56 @@
#define RTL8365MB_EXT_PORT_MODE_1000X 12 #define RTL8365MB_EXT_PORT_MODE_1000X 12
#define RTL8365MB_EXT_PORT_MODE_100FX 13 #define RTL8365MB_EXT_PORT_MODE_100FX 13
/* EXT port interface mode configuration registers 0~1 */ /* Realtek docs and driver uses logic number as EXT_PORT0=16, EXT_PORT1=17,
#define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG0 0x1305 * EXT_PORT2=18, to interact with switch ports. That logic number is internally
#define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG1 0x13C3 * converted to either a physical port number (0..9) or an external interface id (0..2),
#define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG(_extport) \ * depending on which function was called. The external interface id is calculated as
(RTL8365MB_DIGITAL_INTERFACE_SELECT_REG0 + \ * (ext_id=logic_port-15), while the logical to physical map depends on the chip id/version.
((_extport) >> 1) * (0x13C3 - 0x1305)) *
#define RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_MASK(_extport) \ * EXT_PORT0 mentioned in datasheets and rtl8367c driver is used in this driver
(0xF << (((_extport) % 2))) * as extid==1, EXT_PORT2, mentioned in Realtek rtl8367c driver for 10-port switches,
#define RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_OFFSET(_extport) \ * would have an ext_id of 3 (out of range for most extint macros) and ext_id 0 does
(((_extport) % 2) * 4) * not seem to be used as well for this family.
*/
/* EXT port RGMII TX/RX delay configuration registers 1~2 */
#define RTL8365MB_EXT_RGMXF_REG1 0x1307 /* EXT interface mode configuration registers 0~1 */
#define RTL8365MB_EXT_RGMXF_REG2 0x13C5 #define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG0 0x1305 /* EXT1 */
#define RTL8365MB_EXT_RGMXF_REG(_extport) \ #define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG1 0x13C3 /* EXT2 */
(RTL8365MB_EXT_RGMXF_REG1 + \ #define RTL8365MB_DIGITAL_INTERFACE_SELECT_REG(_extint) \
(((_extport) >> 1) * (0x13C5 - 0x1307))) ((_extint) == 1 ? RTL8365MB_DIGITAL_INTERFACE_SELECT_REG0 : \
(_extint) == 2 ? RTL8365MB_DIGITAL_INTERFACE_SELECT_REG1 : \
0x0)
#define RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_MASK(_extint) \
(0xF << (((_extint) % 2)))
#define RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_OFFSET(_extint) \
(((_extint) % 2) * 4)
/* EXT interface RGMII TX/RX delay configuration registers 0~2 */
#define RTL8365MB_EXT_RGMXF_REG0 0x1306 /* EXT0 */
#define RTL8365MB_EXT_RGMXF_REG1 0x1307 /* EXT1 */
#define RTL8365MB_EXT_RGMXF_REG2 0x13C5 /* EXT2 */
#define RTL8365MB_EXT_RGMXF_REG(_extint) \
((_extint) == 0 ? RTL8365MB_EXT_RGMXF_REG0 : \
(_extint) == 1 ? RTL8365MB_EXT_RGMXF_REG1 : \
(_extint) == 2 ? RTL8365MB_EXT_RGMXF_REG2 : \
0x0)
#define RTL8365MB_EXT_RGMXF_RXDELAY_MASK 0x0007 #define RTL8365MB_EXT_RGMXF_RXDELAY_MASK 0x0007
#define RTL8365MB_EXT_RGMXF_TXDELAY_MASK 0x0008 #define RTL8365MB_EXT_RGMXF_TXDELAY_MASK 0x0008
/* External port speed values - used in DIGITAL_INTERFACE_FORCE */ /* External interface port speed values - used in DIGITAL_INTERFACE_FORCE */
#define RTL8365MB_PORT_SPEED_10M 0 #define RTL8365MB_PORT_SPEED_10M 0
#define RTL8365MB_PORT_SPEED_100M 1 #define RTL8365MB_PORT_SPEED_100M 1
#define RTL8365MB_PORT_SPEED_1000M 2 #define RTL8365MB_PORT_SPEED_1000M 2
/* EXT port force configuration registers 0~2 */ /* EXT interface force configuration registers 0~2 */
#define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG0 0x1310 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG0 0x1310 /* EXT0 */
#define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG1 0x1311 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG1 0x1311 /* EXT1 */
#define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG2 0x13C4 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG2 0x13C4 /* EXT2 */
#define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG(_extport) \ #define RTL8365MB_DIGITAL_INTERFACE_FORCE_REG(_extint) \
(RTL8365MB_DIGITAL_INTERFACE_FORCE_REG0 + \ ((_extint) == 0 ? RTL8365MB_DIGITAL_INTERFACE_FORCE_REG0 : \
((_extport) & 0x1) + \ (_extint) == 1 ? RTL8365MB_DIGITAL_INTERFACE_FORCE_REG1 : \
((((_extport) >> 1) & 0x1) * (0x13C4 - 0x1310))) (_extint) == 2 ? RTL8365MB_DIGITAL_INTERFACE_FORCE_REG2 : \
0x0)
#define RTL8365MB_DIGITAL_INTERFACE_FORCE_EN_MASK 0x1000 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_EN_MASK 0x1000
#define RTL8365MB_DIGITAL_INTERFACE_FORCE_NWAY_MASK 0x0080 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_NWAY_MASK 0x0080
#define RTL8365MB_DIGITAL_INTERFACE_FORCE_TXPAUSE_MASK 0x0040 #define RTL8365MB_DIGITAL_INTERFACE_FORCE_TXPAUSE_MASK 0x0040
...@@ -516,7 +543,7 @@ struct rtl8365mb_cpu { ...@@ -516,7 +543,7 @@ struct rtl8365mb_cpu {
/** /**
* struct rtl8365mb_port - private per-port data * struct rtl8365mb_port - private per-port data
* @smi: pointer to parent realtek_smi data * @priv: pointer to parent realtek_priv data
* @index: DSA port index, same as dsa_port::index * @index: DSA port index, same as dsa_port::index
* @stats: link statistics populated by rtl8365mb_stats_poll, ready for atomic * @stats: link statistics populated by rtl8365mb_stats_poll, ready for atomic
* access via rtl8365mb_get_stats64 * access via rtl8365mb_get_stats64
...@@ -524,7 +551,7 @@ struct rtl8365mb_cpu { ...@@ -524,7 +551,7 @@ struct rtl8365mb_cpu {
* @mib_work: delayed work for polling MIB counters * @mib_work: delayed work for polling MIB counters
*/ */
struct rtl8365mb_port { struct rtl8365mb_port {
struct realtek_smi *smi; struct realtek_priv *priv;
unsigned int index; unsigned int index;
struct rtnl_link_stats64 stats; struct rtnl_link_stats64 stats;
spinlock_t stats_lock; spinlock_t stats_lock;
...@@ -533,13 +560,12 @@ struct rtl8365mb_port { ...@@ -533,13 +560,12 @@ struct rtl8365mb_port {
/** /**
* struct rtl8365mb - private chip-specific driver data * struct rtl8365mb - private chip-specific driver data
* @smi: pointer to parent realtek_smi data * @priv: pointer to parent realtek_priv data
* @irq: registered IRQ or zero * @irq: registered IRQ or zero
* @chip_id: chip identifier * @chip_id: chip identifier
* @chip_ver: chip silicon revision * @chip_ver: chip silicon revision
* @port_mask: mask of all ports * @port_mask: mask of all ports
* @learn_limit_max: maximum number of L2 addresses the chip can learn * @learn_limit_max: maximum number of L2 addresses the chip can learn
* @cpu: CPU tagging and CPU port configuration for this chip
* @mib_lock: prevent concurrent reads of MIB counters * @mib_lock: prevent concurrent reads of MIB counters
* @ports: per-port data * @ports: per-port data
* @jam_table: chip-specific initialization jam table * @jam_table: chip-specific initialization jam table
...@@ -548,29 +574,28 @@ struct rtl8365mb_port { ...@@ -548,29 +574,28 @@ struct rtl8365mb_port {
* Private data for this driver. * Private data for this driver.
*/ */
struct rtl8365mb { struct rtl8365mb {
struct realtek_smi *smi; struct realtek_priv *priv;
int irq; int irq;
u32 chip_id; u32 chip_id;
u32 chip_ver; u32 chip_ver;
u32 port_mask; u32 port_mask;
u32 learn_limit_max; u32 learn_limit_max;
struct rtl8365mb_cpu cpu;
struct mutex mib_lock; struct mutex mib_lock;
struct rtl8365mb_port ports[RTL8365MB_MAX_NUM_PORTS]; struct rtl8365mb_port ports[RTL8365MB_MAX_NUM_PORTS];
const struct rtl8365mb_jam_tbl_entry *jam_table; const struct rtl8365mb_jam_tbl_entry *jam_table;
size_t jam_size; size_t jam_size;
}; };
static int rtl8365mb_phy_poll_busy(struct realtek_smi *smi) static int rtl8365mb_phy_poll_busy(struct realtek_priv *priv)
{ {
u32 val; u32 val;
return regmap_read_poll_timeout(smi->map, return regmap_read_poll_timeout(priv->map,
RTL8365MB_INDIRECT_ACCESS_STATUS_REG, RTL8365MB_INDIRECT_ACCESS_STATUS_REG,
val, !val, 10, 100); val, !val, 10, 100);
} }
static int rtl8365mb_phy_ocp_prepare(struct realtek_smi *smi, int phy, static int rtl8365mb_phy_ocp_prepare(struct realtek_priv *priv, int phy,
u32 ocp_addr) u32 ocp_addr)
{ {
u32 val; u32 val;
...@@ -579,7 +604,7 @@ static int rtl8365mb_phy_ocp_prepare(struct realtek_smi *smi, int phy, ...@@ -579,7 +604,7 @@ static int rtl8365mb_phy_ocp_prepare(struct realtek_smi *smi, int phy,
/* Set OCP prefix */ /* Set OCP prefix */
val = FIELD_GET(RTL8365MB_PHY_OCP_ADDR_PREFIX_MASK, ocp_addr); val = FIELD_GET(RTL8365MB_PHY_OCP_ADDR_PREFIX_MASK, ocp_addr);
ret = regmap_update_bits( ret = regmap_update_bits(
smi->map, RTL8365MB_GPHY_OCP_MSB_0_REG, priv->map, RTL8365MB_GPHY_OCP_MSB_0_REG,
RTL8365MB_GPHY_OCP_MSB_0_CFG_CPU_OCPADR_MASK, RTL8365MB_GPHY_OCP_MSB_0_CFG_CPU_OCPADR_MASK,
FIELD_PREP(RTL8365MB_GPHY_OCP_MSB_0_CFG_CPU_OCPADR_MASK, val)); FIELD_PREP(RTL8365MB_GPHY_OCP_MSB_0_CFG_CPU_OCPADR_MASK, val));
if (ret) if (ret)
...@@ -592,7 +617,7 @@ static int rtl8365mb_phy_ocp_prepare(struct realtek_smi *smi, int phy, ...@@ -592,7 +617,7 @@ static int rtl8365mb_phy_ocp_prepare(struct realtek_smi *smi, int phy,
ocp_addr >> 1); ocp_addr >> 1);
val |= FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_ADDRESS_OCPADR_9_6_MASK, val |= FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_ADDRESS_OCPADR_9_6_MASK,
ocp_addr >> 6); ocp_addr >> 6);
ret = regmap_write(smi->map, RTL8365MB_INDIRECT_ACCESS_ADDRESS_REG, ret = regmap_write(priv->map, RTL8365MB_INDIRECT_ACCESS_ADDRESS_REG,
val); val);
if (ret) if (ret)
return ret; return ret;
...@@ -600,17 +625,17 @@ static int rtl8365mb_phy_ocp_prepare(struct realtek_smi *smi, int phy, ...@@ -600,17 +625,17 @@ static int rtl8365mb_phy_ocp_prepare(struct realtek_smi *smi, int phy,
return 0; return 0;
} }
static int rtl8365mb_phy_ocp_read(struct realtek_smi *smi, int phy, static int rtl8365mb_phy_ocp_read(struct realtek_priv *priv, int phy,
u32 ocp_addr, u16 *data) u32 ocp_addr, u16 *data)
{ {
u32 val; u32 val;
int ret; int ret;
ret = rtl8365mb_phy_poll_busy(smi); ret = rtl8365mb_phy_poll_busy(priv);
if (ret) if (ret)
return ret; return ret;
ret = rtl8365mb_phy_ocp_prepare(smi, phy, ocp_addr); ret = rtl8365mb_phy_ocp_prepare(priv, phy, ocp_addr);
if (ret) if (ret)
return ret; return ret;
...@@ -619,16 +644,16 @@ static int rtl8365mb_phy_ocp_read(struct realtek_smi *smi, int phy, ...@@ -619,16 +644,16 @@ static int rtl8365mb_phy_ocp_read(struct realtek_smi *smi, int phy,
RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_VALUE) | RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_VALUE) |
FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_RW_MASK, FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_RW_MASK,
RTL8365MB_INDIRECT_ACCESS_CTRL_RW_READ); RTL8365MB_INDIRECT_ACCESS_CTRL_RW_READ);
ret = regmap_write(smi->map, RTL8365MB_INDIRECT_ACCESS_CTRL_REG, val); ret = regmap_write(priv->map, RTL8365MB_INDIRECT_ACCESS_CTRL_REG, val);
if (ret) if (ret)
return ret; return ret;
ret = rtl8365mb_phy_poll_busy(smi); ret = rtl8365mb_phy_poll_busy(priv);
if (ret) if (ret)
return ret; return ret;
/* Get PHY register data */ /* Get PHY register data */
ret = regmap_read(smi->map, RTL8365MB_INDIRECT_ACCESS_READ_DATA_REG, ret = regmap_read(priv->map, RTL8365MB_INDIRECT_ACCESS_READ_DATA_REG,
&val); &val);
if (ret) if (ret)
return ret; return ret;
...@@ -638,22 +663,22 @@ static int rtl8365mb_phy_ocp_read(struct realtek_smi *smi, int phy, ...@@ -638,22 +663,22 @@ static int rtl8365mb_phy_ocp_read(struct realtek_smi *smi, int phy,
return 0; return 0;
} }
static int rtl8365mb_phy_ocp_write(struct realtek_smi *smi, int phy, static int rtl8365mb_phy_ocp_write(struct realtek_priv *priv, int phy,
u32 ocp_addr, u16 data) u32 ocp_addr, u16 data)
{ {
u32 val; u32 val;
int ret; int ret;
ret = rtl8365mb_phy_poll_busy(smi); ret = rtl8365mb_phy_poll_busy(priv);
if (ret) if (ret)
return ret; return ret;
ret = rtl8365mb_phy_ocp_prepare(smi, phy, ocp_addr); ret = rtl8365mb_phy_ocp_prepare(priv, phy, ocp_addr);
if (ret) if (ret)
return ret; return ret;
/* Set PHY register data */ /* Set PHY register data */
ret = regmap_write(smi->map, RTL8365MB_INDIRECT_ACCESS_WRITE_DATA_REG, ret = regmap_write(priv->map, RTL8365MB_INDIRECT_ACCESS_WRITE_DATA_REG,
data); data);
if (ret) if (ret)
return ret; return ret;
...@@ -663,18 +688,18 @@ static int rtl8365mb_phy_ocp_write(struct realtek_smi *smi, int phy, ...@@ -663,18 +688,18 @@ static int rtl8365mb_phy_ocp_write(struct realtek_smi *smi, int phy,
RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_VALUE) | RTL8365MB_INDIRECT_ACCESS_CTRL_CMD_VALUE) |
FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_RW_MASK, FIELD_PREP(RTL8365MB_INDIRECT_ACCESS_CTRL_RW_MASK,
RTL8365MB_INDIRECT_ACCESS_CTRL_RW_WRITE); RTL8365MB_INDIRECT_ACCESS_CTRL_RW_WRITE);
ret = regmap_write(smi->map, RTL8365MB_INDIRECT_ACCESS_CTRL_REG, val); ret = regmap_write(priv->map, RTL8365MB_INDIRECT_ACCESS_CTRL_REG, val);
if (ret) if (ret)
return ret; return ret;
ret = rtl8365mb_phy_poll_busy(smi); ret = rtl8365mb_phy_poll_busy(priv);
if (ret) if (ret)
return ret; return ret;
return 0; return 0;
} }
static int rtl8365mb_phy_read(struct realtek_smi *smi, int phy, int regnum) static int rtl8365mb_phy_read(struct realtek_priv *priv, int phy, int regnum)
{ {
u32 ocp_addr; u32 ocp_addr;
u16 val; u16 val;
...@@ -688,21 +713,21 @@ static int rtl8365mb_phy_read(struct realtek_smi *smi, int phy, int regnum) ...@@ -688,21 +713,21 @@ static int rtl8365mb_phy_read(struct realtek_smi *smi, int phy, int regnum)
ocp_addr = RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE + regnum * 2; ocp_addr = RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE + regnum * 2;
ret = rtl8365mb_phy_ocp_read(smi, phy, ocp_addr, &val); ret = rtl8365mb_phy_ocp_read(priv, phy, ocp_addr, &val);
if (ret) { if (ret) {
dev_err(smi->dev, dev_err(priv->dev,
"failed to read PHY%d reg %02x @ %04x, ret %d\n", phy, "failed to read PHY%d reg %02x @ %04x, ret %d\n", phy,
regnum, ocp_addr, ret); regnum, ocp_addr, ret);
return ret; return ret;
} }
dev_dbg(smi->dev, "read PHY%d register 0x%02x @ %04x, val <- %04x\n", dev_dbg(priv->dev, "read PHY%d register 0x%02x @ %04x, val <- %04x\n",
phy, regnum, ocp_addr, val); phy, regnum, ocp_addr, val);
return val; return val;
} }
static int rtl8365mb_phy_write(struct realtek_smi *smi, int phy, int regnum, static int rtl8365mb_phy_write(struct realtek_priv *priv, int phy, int regnum,
u16 val) u16 val)
{ {
u32 ocp_addr; u32 ocp_addr;
...@@ -716,20 +741,31 @@ static int rtl8365mb_phy_write(struct realtek_smi *smi, int phy, int regnum, ...@@ -716,20 +741,31 @@ static int rtl8365mb_phy_write(struct realtek_smi *smi, int phy, int regnum,
ocp_addr = RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE + regnum * 2; ocp_addr = RTL8365MB_PHY_OCP_ADDR_PHYREG_BASE + regnum * 2;
ret = rtl8365mb_phy_ocp_write(smi, phy, ocp_addr, val); ret = rtl8365mb_phy_ocp_write(priv, phy, ocp_addr, val);
if (ret) { if (ret) {
dev_err(smi->dev, dev_err(priv->dev,
"failed to write PHY%d reg %02x @ %04x, ret %d\n", phy, "failed to write PHY%d reg %02x @ %04x, ret %d\n", phy,
regnum, ocp_addr, ret); regnum, ocp_addr, ret);
return ret; return ret;
} }
dev_dbg(smi->dev, "write PHY%d register 0x%02x @ %04x, val -> %04x\n", dev_dbg(priv->dev, "write PHY%d register 0x%02x @ %04x, val -> %04x\n",
phy, regnum, ocp_addr, val); phy, regnum, ocp_addr, val);
return 0; return 0;
} }
static int rtl8365mb_dsa_phy_read(struct dsa_switch *ds, int phy, int regnum)
{
return rtl8365mb_phy_read(ds->priv, phy, regnum);
}
static int rtl8365mb_dsa_phy_write(struct dsa_switch *ds, int phy, int regnum,
u16 val)
{
return rtl8365mb_phy_write(ds->priv, phy, regnum, val);
}
static enum dsa_tag_protocol static enum dsa_tag_protocol
rtl8365mb_get_tag_protocol(struct dsa_switch *ds, int port, rtl8365mb_get_tag_protocol(struct dsa_switch *ds, int port,
enum dsa_tag_protocol mp) enum dsa_tag_protocol mp)
...@@ -737,25 +773,25 @@ rtl8365mb_get_tag_protocol(struct dsa_switch *ds, int port, ...@@ -737,25 +773,25 @@ rtl8365mb_get_tag_protocol(struct dsa_switch *ds, int port,
return DSA_TAG_PROTO_RTL8_4; return DSA_TAG_PROTO_RTL8_4;
} }
static int rtl8365mb_ext_config_rgmii(struct realtek_smi *smi, int port, static int rtl8365mb_ext_config_rgmii(struct realtek_priv *priv, int port,
phy_interface_t interface) phy_interface_t interface)
{ {
struct device_node *dn; struct device_node *dn;
struct dsa_port *dp; struct dsa_port *dp;
int tx_delay = 0; int tx_delay = 0;
int rx_delay = 0; int rx_delay = 0;
int ext_port; int ext_int;
u32 val; u32 val;
int ret; int ret;
if (port == smi->cpu_port) { ext_int = rtl8365mb_extint_port_map[port];
ext_port = 1;
} else { if (ext_int <= 0) {
dev_err(smi->dev, "only one EXT port is currently supported\n"); dev_err(priv->dev, "Port %d is not an external interface port\n", port);
return -EINVAL; return -EINVAL;
} }
dp = dsa_to_port(smi->ds, port); dp = dsa_to_port(priv->ds, port);
dn = dp->dn; dn = dp->dn;
/* Set the RGMII TX/RX delay /* Set the RGMII TX/RX delay
...@@ -786,8 +822,8 @@ static int rtl8365mb_ext_config_rgmii(struct realtek_smi *smi, int port, ...@@ -786,8 +822,8 @@ static int rtl8365mb_ext_config_rgmii(struct realtek_smi *smi, int port,
if (val == 0 || val == 2) if (val == 0 || val == 2)
tx_delay = val / 2; tx_delay = val / 2;
else else
dev_warn(smi->dev, dev_warn(priv->dev,
"EXT port TX delay must be 0 or 2 ns\n"); "EXT interface TX delay must be 0 or 2 ns\n");
} }
if (!of_property_read_u32(dn, "rx-internal-delay-ps", &val)) { if (!of_property_read_u32(dn, "rx-internal-delay-ps", &val)) {
...@@ -796,12 +832,12 @@ static int rtl8365mb_ext_config_rgmii(struct realtek_smi *smi, int port, ...@@ -796,12 +832,12 @@ static int rtl8365mb_ext_config_rgmii(struct realtek_smi *smi, int port,
if (val <= 7) if (val <= 7)
rx_delay = val; rx_delay = val;
else else
dev_warn(smi->dev, dev_warn(priv->dev,
"EXT port RX delay must be 0 to 2.1 ns\n"); "EXT interface RX delay must be 0 to 2.1 ns\n");
} }
ret = regmap_update_bits( ret = regmap_update_bits(
smi->map, RTL8365MB_EXT_RGMXF_REG(ext_port), priv->map, RTL8365MB_EXT_RGMXF_REG(ext_int),
RTL8365MB_EXT_RGMXF_TXDELAY_MASK | RTL8365MB_EXT_RGMXF_TXDELAY_MASK |
RTL8365MB_EXT_RGMXF_RXDELAY_MASK, RTL8365MB_EXT_RGMXF_RXDELAY_MASK,
FIELD_PREP(RTL8365MB_EXT_RGMXF_TXDELAY_MASK, tx_delay) | FIELD_PREP(RTL8365MB_EXT_RGMXF_TXDELAY_MASK, tx_delay) |
...@@ -810,18 +846,18 @@ static int rtl8365mb_ext_config_rgmii(struct realtek_smi *smi, int port, ...@@ -810,18 +846,18 @@ static int rtl8365mb_ext_config_rgmii(struct realtek_smi *smi, int port,
return ret; return ret;
ret = regmap_update_bits( ret = regmap_update_bits(
smi->map, RTL8365MB_DIGITAL_INTERFACE_SELECT_REG(ext_port), priv->map, RTL8365MB_DIGITAL_INTERFACE_SELECT_REG(ext_int),
RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_MASK(ext_port), RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_MASK(ext_int),
RTL8365MB_EXT_PORT_MODE_RGMII RTL8365MB_EXT_PORT_MODE_RGMII
<< RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_OFFSET( << RTL8365MB_DIGITAL_INTERFACE_SELECT_MODE_OFFSET(
ext_port)); ext_int));
if (ret) if (ret)
return ret; return ret;
return 0; return 0;
} }
static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port, static int rtl8365mb_ext_config_forcemode(struct realtek_priv *priv, int port,
bool link, int speed, int duplex, bool link, int speed, int duplex,
bool tx_pause, bool rx_pause) bool tx_pause, bool rx_pause)
{ {
...@@ -830,14 +866,14 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port, ...@@ -830,14 +866,14 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port,
u32 r_duplex; u32 r_duplex;
u32 r_speed; u32 r_speed;
u32 r_link; u32 r_link;
int ext_port; int ext_int;
int val; int val;
int ret; int ret;
if (port == smi->cpu_port) { ext_int = rtl8365mb_extint_port_map[port];
ext_port = 1;
} else { if (ext_int <= 0) {
dev_err(smi->dev, "only one EXT port is currently supported\n"); dev_err(priv->dev, "Port %d is not an external interface port\n", port);
return -EINVAL; return -EINVAL;
} }
...@@ -854,7 +890,7 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port, ...@@ -854,7 +890,7 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port,
} else if (speed == SPEED_10) { } else if (speed == SPEED_10) {
r_speed = RTL8365MB_PORT_SPEED_10M; r_speed = RTL8365MB_PORT_SPEED_10M;
} else { } else {
dev_err(smi->dev, "unsupported port speed %s\n", dev_err(priv->dev, "unsupported port speed %s\n",
phy_speed_to_str(speed)); phy_speed_to_str(speed));
return -EINVAL; return -EINVAL;
} }
...@@ -864,7 +900,7 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port, ...@@ -864,7 +900,7 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port,
} else if (duplex == DUPLEX_HALF) { } else if (duplex == DUPLEX_HALF) {
r_duplex = 0; r_duplex = 0;
} else { } else {
dev_err(smi->dev, "unsupported duplex %s\n", dev_err(priv->dev, "unsupported duplex %s\n",
phy_duplex_to_str(duplex)); phy_duplex_to_str(duplex));
return -EINVAL; return -EINVAL;
} }
...@@ -886,8 +922,8 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port, ...@@ -886,8 +922,8 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port,
FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_DUPLEX_MASK, FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_DUPLEX_MASK,
r_duplex) | r_duplex) |
FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_SPEED_MASK, r_speed); FIELD_PREP(RTL8365MB_DIGITAL_INTERFACE_FORCE_SPEED_MASK, r_speed);
ret = regmap_write(smi->map, ret = regmap_write(priv->map,
RTL8365MB_DIGITAL_INTERFACE_FORCE_REG(ext_port), RTL8365MB_DIGITAL_INTERFACE_FORCE_REG(ext_int),
val); val);
if (ret) if (ret)
return ret; return ret;
...@@ -898,13 +934,17 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port, ...@@ -898,13 +934,17 @@ static int rtl8365mb_ext_config_forcemode(struct realtek_smi *smi, int port,
static bool rtl8365mb_phy_mode_supported(struct dsa_switch *ds, int port, static bool rtl8365mb_phy_mode_supported(struct dsa_switch *ds, int port,
phy_interface_t interface) phy_interface_t interface)
{ {
if (dsa_is_user_port(ds, port) && int ext_int;
ext_int = rtl8365mb_extint_port_map[port];
if (ext_int < 0 &&
(interface == PHY_INTERFACE_MODE_NA || (interface == PHY_INTERFACE_MODE_NA ||
interface == PHY_INTERFACE_MODE_INTERNAL || interface == PHY_INTERFACE_MODE_INTERNAL ||
interface == PHY_INTERFACE_MODE_GMII)) interface == PHY_INTERFACE_MODE_GMII))
/* Internal PHY */ /* Internal PHY */
return true; return true;
else if (dsa_is_cpu_port(ds, port) && else if ((ext_int >= 1) &&
phy_interface_mode_is_rgmii(interface)) phy_interface_mode_is_rgmii(interface))
/* Extension MAC */ /* Extension MAC */
return true; return true;
...@@ -916,7 +956,7 @@ static void rtl8365mb_phylink_validate(struct dsa_switch *ds, int port, ...@@ -916,7 +956,7 @@ static void rtl8365mb_phylink_validate(struct dsa_switch *ds, int port,
unsigned long *supported, unsigned long *supported,
struct phylink_link_state *state) struct phylink_link_state *state)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
__ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0 }; __ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0 };
/* include/linux/phylink.h says: /* include/linux/phylink.h says:
...@@ -925,7 +965,7 @@ static void rtl8365mb_phylink_validate(struct dsa_switch *ds, int port, ...@@ -925,7 +965,7 @@ static void rtl8365mb_phylink_validate(struct dsa_switch *ds, int port,
*/ */
if (state->interface != PHY_INTERFACE_MODE_NA && if (state->interface != PHY_INTERFACE_MODE_NA &&
!rtl8365mb_phy_mode_supported(ds, port, state->interface)) { !rtl8365mb_phy_mode_supported(ds, port, state->interface)) {
dev_err(smi->dev, "phy mode %s is unsupported on port %d\n", dev_err(priv->dev, "phy mode %s is unsupported on port %d\n",
phy_modes(state->interface), port); phy_modes(state->interface), port);
linkmode_zero(supported); linkmode_zero(supported);
return; return;
...@@ -951,26 +991,26 @@ static void rtl8365mb_phylink_mac_config(struct dsa_switch *ds, int port, ...@@ -951,26 +991,26 @@ static void rtl8365mb_phylink_mac_config(struct dsa_switch *ds, int port,
unsigned int mode, unsigned int mode,
const struct phylink_link_state *state) const struct phylink_link_state *state)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int ret; int ret;
if (!rtl8365mb_phy_mode_supported(ds, port, state->interface)) { if (!rtl8365mb_phy_mode_supported(ds, port, state->interface)) {
dev_err(smi->dev, "phy mode %s is unsupported on port %d\n", dev_err(priv->dev, "phy mode %s is unsupported on port %d\n",
phy_modes(state->interface), port); phy_modes(state->interface), port);
return; return;
} }
if (mode != MLO_AN_PHY && mode != MLO_AN_FIXED) { if (mode != MLO_AN_PHY && mode != MLO_AN_FIXED) {
dev_err(smi->dev, dev_err(priv->dev,
"port %d supports only conventional PHY or fixed-link\n", "port %d supports only conventional PHY or fixed-link\n",
port); port);
return; return;
} }
if (phy_interface_mode_is_rgmii(state->interface)) { if (phy_interface_mode_is_rgmii(state->interface)) {
ret = rtl8365mb_ext_config_rgmii(smi, port, state->interface); ret = rtl8365mb_ext_config_rgmii(priv, port, state->interface);
if (ret) if (ret)
dev_err(smi->dev, dev_err(priv->dev,
"failed to configure RGMII mode on port %d: %d\n", "failed to configure RGMII mode on port %d: %d\n",
port, ret); port, ret);
return; return;
...@@ -985,20 +1025,20 @@ static void rtl8365mb_phylink_mac_link_down(struct dsa_switch *ds, int port, ...@@ -985,20 +1025,20 @@ static void rtl8365mb_phylink_mac_link_down(struct dsa_switch *ds, int port,
unsigned int mode, unsigned int mode,
phy_interface_t interface) phy_interface_t interface)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb_port *p; struct rtl8365mb_port *p;
struct rtl8365mb *mb; struct rtl8365mb *mb;
int ret; int ret;
mb = smi->chip_data; mb = priv->chip_data;
p = &mb->ports[port]; p = &mb->ports[port];
cancel_delayed_work_sync(&p->mib_work); cancel_delayed_work_sync(&p->mib_work);
if (phy_interface_mode_is_rgmii(interface)) { if (phy_interface_mode_is_rgmii(interface)) {
ret = rtl8365mb_ext_config_forcemode(smi, port, false, 0, 0, ret = rtl8365mb_ext_config_forcemode(priv, port, false, 0, 0,
false, false); false, false);
if (ret) if (ret)
dev_err(smi->dev, dev_err(priv->dev,
"failed to reset forced mode on port %d: %d\n", "failed to reset forced mode on port %d: %d\n",
port, ret); port, ret);
...@@ -1013,21 +1053,21 @@ static void rtl8365mb_phylink_mac_link_up(struct dsa_switch *ds, int port, ...@@ -1013,21 +1053,21 @@ static void rtl8365mb_phylink_mac_link_up(struct dsa_switch *ds, int port,
int duplex, bool tx_pause, int duplex, bool tx_pause,
bool rx_pause) bool rx_pause)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb_port *p; struct rtl8365mb_port *p;
struct rtl8365mb *mb; struct rtl8365mb *mb;
int ret; int ret;
mb = smi->chip_data; mb = priv->chip_data;
p = &mb->ports[port]; p = &mb->ports[port];
schedule_delayed_work(&p->mib_work, 0); schedule_delayed_work(&p->mib_work, 0);
if (phy_interface_mode_is_rgmii(interface)) { if (phy_interface_mode_is_rgmii(interface)) {
ret = rtl8365mb_ext_config_forcemode(smi, port, true, speed, ret = rtl8365mb_ext_config_forcemode(priv, port, true, speed,
duplex, tx_pause, duplex, tx_pause,
rx_pause); rx_pause);
if (ret) if (ret)
dev_err(smi->dev, dev_err(priv->dev,
"failed to force mode on port %d: %d\n", port, "failed to force mode on port %d: %d\n", port,
ret); ret);
...@@ -1038,7 +1078,7 @@ static void rtl8365mb_phylink_mac_link_up(struct dsa_switch *ds, int port, ...@@ -1038,7 +1078,7 @@ static void rtl8365mb_phylink_mac_link_up(struct dsa_switch *ds, int port,
static void rtl8365mb_port_stp_state_set(struct dsa_switch *ds, int port, static void rtl8365mb_port_stp_state_set(struct dsa_switch *ds, int port,
u8 state) u8 state)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
enum rtl8365mb_stp_state val; enum rtl8365mb_stp_state val;
int msti = 0; int msti = 0;
...@@ -1057,36 +1097,36 @@ static void rtl8365mb_port_stp_state_set(struct dsa_switch *ds, int port, ...@@ -1057,36 +1097,36 @@ static void rtl8365mb_port_stp_state_set(struct dsa_switch *ds, int port,
val = RTL8365MB_STP_STATE_FORWARDING; val = RTL8365MB_STP_STATE_FORWARDING;
break; break;
default: default:
dev_err(smi->dev, "invalid STP state: %u\n", state); dev_err(priv->dev, "invalid STP state: %u\n", state);
return; return;
} }
regmap_update_bits(smi->map, RTL8365MB_MSTI_CTRL_REG(msti, port), regmap_update_bits(priv->map, RTL8365MB_MSTI_CTRL_REG(msti, port),
RTL8365MB_MSTI_CTRL_PORT_STATE_MASK(port), RTL8365MB_MSTI_CTRL_PORT_STATE_MASK(port),
val << RTL8365MB_MSTI_CTRL_PORT_STATE_OFFSET(port)); val << RTL8365MB_MSTI_CTRL_PORT_STATE_OFFSET(port));
} }
static int rtl8365mb_port_set_learning(struct realtek_smi *smi, int port, static int rtl8365mb_port_set_learning(struct realtek_priv *priv, int port,
bool enable) bool enable)
{ {
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
/* Enable/disable learning by limiting the number of L2 addresses the /* Enable/disable learning by limiting the number of L2 addresses the
* port can learn. Realtek documentation states that a limit of zero * port can learn. Realtek documentation states that a limit of zero
* disables learning. When enabling learning, set it to the chip's * disables learning. When enabling learning, set it to the chip's
* maximum. * maximum.
*/ */
return regmap_write(smi->map, RTL8365MB_LUT_PORT_LEARN_LIMIT_REG(port), return regmap_write(priv->map, RTL8365MB_LUT_PORT_LEARN_LIMIT_REG(port),
enable ? mb->learn_limit_max : 0); enable ? mb->learn_limit_max : 0);
} }
static int rtl8365mb_port_set_isolation(struct realtek_smi *smi, int port, static int rtl8365mb_port_set_isolation(struct realtek_priv *priv, int port,
u32 mask) u32 mask)
{ {
return regmap_write(smi->map, RTL8365MB_PORT_ISOLATION_REG(port), mask); return regmap_write(priv->map, RTL8365MB_PORT_ISOLATION_REG(port), mask);
} }
static int rtl8365mb_mib_counter_read(struct realtek_smi *smi, int port, static int rtl8365mb_mib_counter_read(struct realtek_priv *priv, int port,
u32 offset, u32 length, u64 *mibvalue) u32 offset, u32 length, u64 *mibvalue)
{ {
u64 tmpvalue = 0; u64 tmpvalue = 0;
...@@ -1098,13 +1138,13 @@ static int rtl8365mb_mib_counter_read(struct realtek_smi *smi, int port, ...@@ -1098,13 +1138,13 @@ static int rtl8365mb_mib_counter_read(struct realtek_smi *smi, int port,
* and then poll the control register before reading the value from some * and then poll the control register before reading the value from some
* counter registers. * counter registers.
*/ */
ret = regmap_write(smi->map, RTL8365MB_MIB_ADDRESS_REG, ret = regmap_write(priv->map, RTL8365MB_MIB_ADDRESS_REG,
RTL8365MB_MIB_ADDRESS(port, offset)); RTL8365MB_MIB_ADDRESS(port, offset));
if (ret) if (ret)
return ret; return ret;
/* Poll for completion */ /* Poll for completion */
ret = regmap_read_poll_timeout(smi->map, RTL8365MB_MIB_CTRL0_REG, val, ret = regmap_read_poll_timeout(priv->map, RTL8365MB_MIB_CTRL0_REG, val,
!(val & RTL8365MB_MIB_CTRL0_BUSY_MASK), !(val & RTL8365MB_MIB_CTRL0_BUSY_MASK),
10, 100); 10, 100);
if (ret) if (ret)
...@@ -1126,7 +1166,7 @@ static int rtl8365mb_mib_counter_read(struct realtek_smi *smi, int port, ...@@ -1126,7 +1166,7 @@ static int rtl8365mb_mib_counter_read(struct realtek_smi *smi, int port,
/* Read the MIB counter 16 bits at a time */ /* Read the MIB counter 16 bits at a time */
for (i = 0; i < length; i++) { for (i = 0; i < length; i++) {
ret = regmap_read(smi->map, ret = regmap_read(priv->map,
RTL8365MB_MIB_COUNTER_REG(offset - i), &val); RTL8365MB_MIB_COUNTER_REG(offset - i), &val);
if (ret) if (ret)
return ret; return ret;
...@@ -1142,21 +1182,21 @@ static int rtl8365mb_mib_counter_read(struct realtek_smi *smi, int port, ...@@ -1142,21 +1182,21 @@ static int rtl8365mb_mib_counter_read(struct realtek_smi *smi, int port,
static void rtl8365mb_get_ethtool_stats(struct dsa_switch *ds, int port, u64 *data) static void rtl8365mb_get_ethtool_stats(struct dsa_switch *ds, int port, u64 *data)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb *mb; struct rtl8365mb *mb;
int ret; int ret;
int i; int i;
mb = smi->chip_data; mb = priv->chip_data;
mutex_lock(&mb->mib_lock); mutex_lock(&mb->mib_lock);
for (i = 0; i < RTL8365MB_MIB_END; i++) { for (i = 0; i < RTL8365MB_MIB_END; i++) {
struct rtl8365mb_mib_counter *mib = &rtl8365mb_mib_counters[i]; struct rtl8365mb_mib_counter *mib = &rtl8365mb_mib_counters[i];
ret = rtl8365mb_mib_counter_read(smi, port, mib->offset, ret = rtl8365mb_mib_counter_read(priv, port, mib->offset,
mib->length, &data[i]); mib->length, &data[i]);
if (ret) { if (ret) {
dev_err(smi->dev, dev_err(priv->dev,
"failed to read port %d counters: %d\n", port, "failed to read port %d counters: %d\n", port,
ret); ret);
break; break;
...@@ -1190,15 +1230,15 @@ static int rtl8365mb_get_sset_count(struct dsa_switch *ds, int port, int sset) ...@@ -1190,15 +1230,15 @@ static int rtl8365mb_get_sset_count(struct dsa_switch *ds, int port, int sset)
static void rtl8365mb_get_phy_stats(struct dsa_switch *ds, int port, static void rtl8365mb_get_phy_stats(struct dsa_switch *ds, int port,
struct ethtool_eth_phy_stats *phy_stats) struct ethtool_eth_phy_stats *phy_stats)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb_mib_counter *mib; struct rtl8365mb_mib_counter *mib;
struct rtl8365mb *mb; struct rtl8365mb *mb;
mb = smi->chip_data; mb = priv->chip_data;
mib = &rtl8365mb_mib_counters[RTL8365MB_MIB_dot3StatsSymbolErrors]; mib = &rtl8365mb_mib_counters[RTL8365MB_MIB_dot3StatsSymbolErrors];
mutex_lock(&mb->mib_lock); mutex_lock(&mb->mib_lock);
rtl8365mb_mib_counter_read(smi, port, mib->offset, mib->length, rtl8365mb_mib_counter_read(priv, port, mib->offset, mib->length,
&phy_stats->SymbolErrorDuringCarrier); &phy_stats->SymbolErrorDuringCarrier);
mutex_unlock(&mb->mib_lock); mutex_unlock(&mb->mib_lock);
} }
...@@ -1226,12 +1266,12 @@ static void rtl8365mb_get_mac_stats(struct dsa_switch *ds, int port, ...@@ -1226,12 +1266,12 @@ static void rtl8365mb_get_mac_stats(struct dsa_switch *ds, int port,
[RTL8365MB_MIB_dot3StatsExcessiveCollisions] = 1, [RTL8365MB_MIB_dot3StatsExcessiveCollisions] = 1,
}; };
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb *mb; struct rtl8365mb *mb;
int ret; int ret;
int i; int i;
mb = smi->chip_data; mb = priv->chip_data;
mutex_lock(&mb->mib_lock); mutex_lock(&mb->mib_lock);
for (i = 0; i < RTL8365MB_MIB_END; i++) { for (i = 0; i < RTL8365MB_MIB_END; i++) {
...@@ -1241,7 +1281,7 @@ static void rtl8365mb_get_mac_stats(struct dsa_switch *ds, int port, ...@@ -1241,7 +1281,7 @@ static void rtl8365mb_get_mac_stats(struct dsa_switch *ds, int port,
if (!cnt[i]) if (!cnt[i])
continue; continue;
ret = rtl8365mb_mib_counter_read(smi, port, mib->offset, ret = rtl8365mb_mib_counter_read(priv, port, mib->offset,
mib->length, &cnt[i]); mib->length, &cnt[i]);
if (ret) if (ret)
break; break;
...@@ -1291,20 +1331,20 @@ static void rtl8365mb_get_mac_stats(struct dsa_switch *ds, int port, ...@@ -1291,20 +1331,20 @@ static void rtl8365mb_get_mac_stats(struct dsa_switch *ds, int port,
static void rtl8365mb_get_ctrl_stats(struct dsa_switch *ds, int port, static void rtl8365mb_get_ctrl_stats(struct dsa_switch *ds, int port,
struct ethtool_eth_ctrl_stats *ctrl_stats) struct ethtool_eth_ctrl_stats *ctrl_stats)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb_mib_counter *mib; struct rtl8365mb_mib_counter *mib;
struct rtl8365mb *mb; struct rtl8365mb *mb;
mb = smi->chip_data; mb = priv->chip_data;
mib = &rtl8365mb_mib_counters[RTL8365MB_MIB_dot3ControlInUnknownOpcodes]; mib = &rtl8365mb_mib_counters[RTL8365MB_MIB_dot3ControlInUnknownOpcodes];
mutex_lock(&mb->mib_lock); mutex_lock(&mb->mib_lock);
rtl8365mb_mib_counter_read(smi, port, mib->offset, mib->length, rtl8365mb_mib_counter_read(priv, port, mib->offset, mib->length,
&ctrl_stats->UnsupportedOpcodesReceived); &ctrl_stats->UnsupportedOpcodesReceived);
mutex_unlock(&mb->mib_lock); mutex_unlock(&mb->mib_lock);
} }
static void rtl8365mb_stats_update(struct realtek_smi *smi, int port) static void rtl8365mb_stats_update(struct realtek_priv *priv, int port)
{ {
u64 cnt[RTL8365MB_MIB_END] = { u64 cnt[RTL8365MB_MIB_END] = {
[RTL8365MB_MIB_ifOutOctets] = 1, [RTL8365MB_MIB_ifOutOctets] = 1,
...@@ -1323,7 +1363,7 @@ static void rtl8365mb_stats_update(struct realtek_smi *smi, int port) ...@@ -1323,7 +1363,7 @@ static void rtl8365mb_stats_update(struct realtek_smi *smi, int port)
[RTL8365MB_MIB_dot3StatsFCSErrors] = 1, [RTL8365MB_MIB_dot3StatsFCSErrors] = 1,
[RTL8365MB_MIB_dot3StatsLateCollisions] = 1, [RTL8365MB_MIB_dot3StatsLateCollisions] = 1,
}; };
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
struct rtnl_link_stats64 *stats; struct rtnl_link_stats64 *stats;
int ret; int ret;
int i; int i;
...@@ -1338,7 +1378,7 @@ static void rtl8365mb_stats_update(struct realtek_smi *smi, int port) ...@@ -1338,7 +1378,7 @@ static void rtl8365mb_stats_update(struct realtek_smi *smi, int port)
if (!cnt[i]) if (!cnt[i])
continue; continue;
ret = rtl8365mb_mib_counter_read(smi, port, c->offset, ret = rtl8365mb_mib_counter_read(priv, port, c->offset,
c->length, &cnt[i]); c->length, &cnt[i]);
if (ret) if (ret)
break; break;
...@@ -1388,9 +1428,9 @@ static void rtl8365mb_stats_poll(struct work_struct *work) ...@@ -1388,9 +1428,9 @@ static void rtl8365mb_stats_poll(struct work_struct *work)
struct rtl8365mb_port *p = container_of(to_delayed_work(work), struct rtl8365mb_port *p = container_of(to_delayed_work(work),
struct rtl8365mb_port, struct rtl8365mb_port,
mib_work); mib_work);
struct realtek_smi *smi = p->smi; struct realtek_priv *priv = p->priv;
rtl8365mb_stats_update(smi, p->index); rtl8365mb_stats_update(priv, p->index);
schedule_delayed_work(&p->mib_work, RTL8365MB_STATS_INTERVAL_JIFFIES); schedule_delayed_work(&p->mib_work, RTL8365MB_STATS_INTERVAL_JIFFIES);
} }
...@@ -1398,11 +1438,11 @@ static void rtl8365mb_stats_poll(struct work_struct *work) ...@@ -1398,11 +1438,11 @@ static void rtl8365mb_stats_poll(struct work_struct *work)
static void rtl8365mb_get_stats64(struct dsa_switch *ds, int port, static void rtl8365mb_get_stats64(struct dsa_switch *ds, int port,
struct rtnl_link_stats64 *s) struct rtnl_link_stats64 *s)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb_port *p; struct rtl8365mb_port *p;
struct rtl8365mb *mb; struct rtl8365mb *mb;
mb = smi->chip_data; mb = priv->chip_data;
p = &mb->ports[port]; p = &mb->ports[port];
spin_lock(&p->stats_lock); spin_lock(&p->stats_lock);
...@@ -1410,9 +1450,9 @@ static void rtl8365mb_get_stats64(struct dsa_switch *ds, int port, ...@@ -1410,9 +1450,9 @@ static void rtl8365mb_get_stats64(struct dsa_switch *ds, int port,
spin_unlock(&p->stats_lock); spin_unlock(&p->stats_lock);
} }
static void rtl8365mb_stats_setup(struct realtek_smi *smi) static void rtl8365mb_stats_setup(struct realtek_priv *priv)
{ {
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
int i; int i;
/* Per-chip global mutex to protect MIB counter access, since doing /* Per-chip global mutex to protect MIB counter access, since doing
...@@ -1420,10 +1460,10 @@ static void rtl8365mb_stats_setup(struct realtek_smi *smi) ...@@ -1420,10 +1460,10 @@ static void rtl8365mb_stats_setup(struct realtek_smi *smi)
*/ */
mutex_init(&mb->mib_lock); mutex_init(&mb->mib_lock);
for (i = 0; i < smi->num_ports; i++) { for (i = 0; i < priv->num_ports; i++) {
struct rtl8365mb_port *p = &mb->ports[i]; struct rtl8365mb_port *p = &mb->ports[i];
if (dsa_is_unused_port(smi->ds, i)) if (dsa_is_unused_port(priv->ds, i))
continue; continue;
/* Per-port spinlock to protect the stats64 data */ /* Per-port spinlock to protect the stats64 data */
...@@ -1436,45 +1476,45 @@ static void rtl8365mb_stats_setup(struct realtek_smi *smi) ...@@ -1436,45 +1476,45 @@ static void rtl8365mb_stats_setup(struct realtek_smi *smi)
} }
} }
static void rtl8365mb_stats_teardown(struct realtek_smi *smi) static void rtl8365mb_stats_teardown(struct realtek_priv *priv)
{ {
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
int i; int i;
for (i = 0; i < smi->num_ports; i++) { for (i = 0; i < priv->num_ports; i++) {
struct rtl8365mb_port *p = &mb->ports[i]; struct rtl8365mb_port *p = &mb->ports[i];
if (dsa_is_unused_port(smi->ds, i)) if (dsa_is_unused_port(priv->ds, i))
continue; continue;
cancel_delayed_work_sync(&p->mib_work); cancel_delayed_work_sync(&p->mib_work);
} }
} }
static int rtl8365mb_get_and_clear_status_reg(struct realtek_smi *smi, u32 reg, static int rtl8365mb_get_and_clear_status_reg(struct realtek_priv *priv, u32 reg,
u32 *val) u32 *val)
{ {
int ret; int ret;
ret = regmap_read(smi->map, reg, val); ret = regmap_read(priv->map, reg, val);
if (ret) if (ret)
return ret; return ret;
return regmap_write(smi->map, reg, *val); return regmap_write(priv->map, reg, *val);
} }
static irqreturn_t rtl8365mb_irq(int irq, void *data) static irqreturn_t rtl8365mb_irq(int irq, void *data)
{ {
struct realtek_smi *smi = data; struct realtek_priv *priv = data;
unsigned long line_changes = 0; unsigned long line_changes = 0;
struct rtl8365mb *mb; struct rtl8365mb *mb;
u32 stat; u32 stat;
int line; int line;
int ret; int ret;
mb = smi->chip_data; mb = priv->chip_data;
ret = rtl8365mb_get_and_clear_status_reg(smi, RTL8365MB_INTR_STATUS_REG, ret = rtl8365mb_get_and_clear_status_reg(priv, RTL8365MB_INTR_STATUS_REG,
&stat); &stat);
if (ret) if (ret)
goto out_error; goto out_error;
...@@ -1485,14 +1525,14 @@ static irqreturn_t rtl8365mb_irq(int irq, void *data) ...@@ -1485,14 +1525,14 @@ static irqreturn_t rtl8365mb_irq(int irq, void *data)
u32 val; u32 val;
ret = rtl8365mb_get_and_clear_status_reg( ret = rtl8365mb_get_and_clear_status_reg(
smi, RTL8365MB_PORT_LINKUP_IND_REG, &val); priv, RTL8365MB_PORT_LINKUP_IND_REG, &val);
if (ret) if (ret)
goto out_error; goto out_error;
linkup_ind = FIELD_GET(RTL8365MB_PORT_LINKUP_IND_MASK, val); linkup_ind = FIELD_GET(RTL8365MB_PORT_LINKUP_IND_MASK, val);
ret = rtl8365mb_get_and_clear_status_reg( ret = rtl8365mb_get_and_clear_status_reg(
smi, RTL8365MB_PORT_LINKDOWN_IND_REG, &val); priv, RTL8365MB_PORT_LINKDOWN_IND_REG, &val);
if (ret) if (ret)
goto out_error; goto out_error;
...@@ -1504,8 +1544,8 @@ static irqreturn_t rtl8365mb_irq(int irq, void *data) ...@@ -1504,8 +1544,8 @@ static irqreturn_t rtl8365mb_irq(int irq, void *data)
if (!line_changes) if (!line_changes)
goto out_none; goto out_none;
for_each_set_bit(line, &line_changes, smi->num_ports) { for_each_set_bit(line, &line_changes, priv->num_ports) {
int child_irq = irq_find_mapping(smi->irqdomain, line); int child_irq = irq_find_mapping(priv->irqdomain, line);
handle_nested_irq(child_irq); handle_nested_irq(child_irq);
} }
...@@ -1513,7 +1553,7 @@ static irqreturn_t rtl8365mb_irq(int irq, void *data) ...@@ -1513,7 +1553,7 @@ static irqreturn_t rtl8365mb_irq(int irq, void *data)
return IRQ_HANDLED; return IRQ_HANDLED;
out_error: out_error:
dev_err(smi->dev, "failed to read interrupt status: %d\n", ret); dev_err(priv->dev, "failed to read interrupt status: %d\n", ret);
out_none: out_none:
return IRQ_NONE; return IRQ_NONE;
...@@ -1548,27 +1588,27 @@ static const struct irq_domain_ops rtl8365mb_irqdomain_ops = { ...@@ -1548,27 +1588,27 @@ static const struct irq_domain_ops rtl8365mb_irqdomain_ops = {
.xlate = irq_domain_xlate_onecell, .xlate = irq_domain_xlate_onecell,
}; };
static int rtl8365mb_set_irq_enable(struct realtek_smi *smi, bool enable) static int rtl8365mb_set_irq_enable(struct realtek_priv *priv, bool enable)
{ {
return regmap_update_bits(smi->map, RTL8365MB_INTR_CTRL_REG, return regmap_update_bits(priv->map, RTL8365MB_INTR_CTRL_REG,
RTL8365MB_INTR_LINK_CHANGE_MASK, RTL8365MB_INTR_LINK_CHANGE_MASK,
FIELD_PREP(RTL8365MB_INTR_LINK_CHANGE_MASK, FIELD_PREP(RTL8365MB_INTR_LINK_CHANGE_MASK,
enable ? 1 : 0)); enable ? 1 : 0));
} }
static int rtl8365mb_irq_enable(struct realtek_smi *smi) static int rtl8365mb_irq_enable(struct realtek_priv *priv)
{ {
return rtl8365mb_set_irq_enable(smi, true); return rtl8365mb_set_irq_enable(priv, true);
} }
static int rtl8365mb_irq_disable(struct realtek_smi *smi) static int rtl8365mb_irq_disable(struct realtek_priv *priv)
{ {
return rtl8365mb_set_irq_enable(smi, false); return rtl8365mb_set_irq_enable(priv, false);
} }
static int rtl8365mb_irq_setup(struct realtek_smi *smi) static int rtl8365mb_irq_setup(struct realtek_priv *priv)
{ {
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
struct device_node *intc; struct device_node *intc;
u32 irq_trig; u32 irq_trig;
int virq; int virq;
...@@ -1577,9 +1617,9 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi) ...@@ -1577,9 +1617,9 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi)
int ret; int ret;
int i; int i;
intc = of_get_child_by_name(smi->dev->of_node, "interrupt-controller"); intc = of_get_child_by_name(priv->dev->of_node, "interrupt-controller");
if (!intc) { if (!intc) {
dev_err(smi->dev, "missing child interrupt-controller node\n"); dev_err(priv->dev, "missing child interrupt-controller node\n");
return -EINVAL; return -EINVAL;
} }
...@@ -1587,24 +1627,24 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi) ...@@ -1587,24 +1627,24 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi)
irq = of_irq_get(intc, 0); irq = of_irq_get(intc, 0);
if (irq <= 0) { if (irq <= 0) {
if (irq != -EPROBE_DEFER) if (irq != -EPROBE_DEFER)
dev_err(smi->dev, "failed to get parent irq: %d\n", dev_err(priv->dev, "failed to get parent irq: %d\n",
irq); irq);
ret = irq ? irq : -EINVAL; ret = irq ? irq : -EINVAL;
goto out_put_node; goto out_put_node;
} }
smi->irqdomain = irq_domain_add_linear(intc, smi->num_ports, priv->irqdomain = irq_domain_add_linear(intc, priv->num_ports,
&rtl8365mb_irqdomain_ops, smi); &rtl8365mb_irqdomain_ops, priv);
if (!smi->irqdomain) { if (!priv->irqdomain) {
dev_err(smi->dev, "failed to add irq domain\n"); dev_err(priv->dev, "failed to add irq domain\n");
ret = -ENOMEM; ret = -ENOMEM;
goto out_put_node; goto out_put_node;
} }
for (i = 0; i < smi->num_ports; i++) { for (i = 0; i < priv->num_ports; i++) {
virq = irq_create_mapping(smi->irqdomain, i); virq = irq_create_mapping(priv->irqdomain, i);
if (!virq) { if (!virq) {
dev_err(smi->dev, dev_err(priv->dev,
"failed to create irq domain mapping\n"); "failed to create irq domain mapping\n");
ret = -EINVAL; ret = -EINVAL;
goto out_remove_irqdomain; goto out_remove_irqdomain;
...@@ -1625,40 +1665,40 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi) ...@@ -1625,40 +1665,40 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi)
val = RTL8365MB_INTR_POLARITY_LOW; val = RTL8365MB_INTR_POLARITY_LOW;
break; break;
default: default:
dev_err(smi->dev, "unsupported irq trigger type %u\n", dev_err(priv->dev, "unsupported irq trigger type %u\n",
irq_trig); irq_trig);
ret = -EINVAL; ret = -EINVAL;
goto out_remove_irqdomain; goto out_remove_irqdomain;
} }
ret = regmap_update_bits(smi->map, RTL8365MB_INTR_POLARITY_REG, ret = regmap_update_bits(priv->map, RTL8365MB_INTR_POLARITY_REG,
RTL8365MB_INTR_POLARITY_MASK, RTL8365MB_INTR_POLARITY_MASK,
FIELD_PREP(RTL8365MB_INTR_POLARITY_MASK, val)); FIELD_PREP(RTL8365MB_INTR_POLARITY_MASK, val));
if (ret) if (ret)
goto out_remove_irqdomain; goto out_remove_irqdomain;
/* Disable the interrupt in case the chip has it enabled on reset */ /* Disable the interrupt in case the chip has it enabled on reset */
ret = rtl8365mb_irq_disable(smi); ret = rtl8365mb_irq_disable(priv);
if (ret) if (ret)
goto out_remove_irqdomain; goto out_remove_irqdomain;
/* Clear the interrupt status register */ /* Clear the interrupt status register */
ret = regmap_write(smi->map, RTL8365MB_INTR_STATUS_REG, ret = regmap_write(priv->map, RTL8365MB_INTR_STATUS_REG,
RTL8365MB_INTR_ALL_MASK); RTL8365MB_INTR_ALL_MASK);
if (ret) if (ret)
goto out_remove_irqdomain; goto out_remove_irqdomain;
ret = request_threaded_irq(irq, NULL, rtl8365mb_irq, IRQF_ONESHOT, ret = request_threaded_irq(irq, NULL, rtl8365mb_irq, IRQF_ONESHOT,
"rtl8365mb", smi); "rtl8365mb", priv);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to request irq: %d\n", ret); dev_err(priv->dev, "failed to request irq: %d\n", ret);
goto out_remove_irqdomain; goto out_remove_irqdomain;
} }
/* Store the irq so that we know to free it during teardown */ /* Store the irq so that we know to free it during teardown */
mb->irq = irq; mb->irq = irq;
ret = rtl8365mb_irq_enable(smi); ret = rtl8365mb_irq_enable(priv);
if (ret) if (ret)
goto out_free_irq; goto out_free_irq;
...@@ -1667,17 +1707,17 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi) ...@@ -1667,17 +1707,17 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi)
return 0; return 0;
out_free_irq: out_free_irq:
free_irq(mb->irq, smi); free_irq(mb->irq, priv);
mb->irq = 0; mb->irq = 0;
out_remove_irqdomain: out_remove_irqdomain:
for (i = 0; i < smi->num_ports; i++) { for (i = 0; i < priv->num_ports; i++) {
virq = irq_find_mapping(smi->irqdomain, i); virq = irq_find_mapping(priv->irqdomain, i);
irq_dispose_mapping(virq); irq_dispose_mapping(virq);
} }
irq_domain_remove(smi->irqdomain); irq_domain_remove(priv->irqdomain);
smi->irqdomain = NULL; priv->irqdomain = NULL;
out_put_node: out_put_node:
of_node_put(intc); of_node_put(intc);
...@@ -1685,36 +1725,34 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi) ...@@ -1685,36 +1725,34 @@ static int rtl8365mb_irq_setup(struct realtek_smi *smi)
return ret; return ret;
} }
static void rtl8365mb_irq_teardown(struct realtek_smi *smi) static void rtl8365mb_irq_teardown(struct realtek_priv *priv)
{ {
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
int virq; int virq;
int i; int i;
if (mb->irq) { if (mb->irq) {
free_irq(mb->irq, smi); free_irq(mb->irq, priv);
mb->irq = 0; mb->irq = 0;
} }
if (smi->irqdomain) { if (priv->irqdomain) {
for (i = 0; i < smi->num_ports; i++) { for (i = 0; i < priv->num_ports; i++) {
virq = irq_find_mapping(smi->irqdomain, i); virq = irq_find_mapping(priv->irqdomain, i);
irq_dispose_mapping(virq); irq_dispose_mapping(virq);
} }
irq_domain_remove(smi->irqdomain); irq_domain_remove(priv->irqdomain);
smi->irqdomain = NULL; priv->irqdomain = NULL;
} }
} }
static int rtl8365mb_cpu_config(struct realtek_smi *smi) static int rtl8365mb_cpu_config(struct realtek_priv *priv, const struct rtl8365mb_cpu *cpu)
{ {
struct rtl8365mb *mb = smi->chip_data;
struct rtl8365mb_cpu *cpu = &mb->cpu;
u32 val; u32 val;
int ret; int ret;
ret = regmap_update_bits(smi->map, RTL8365MB_CPU_PORT_MASK_REG, ret = regmap_update_bits(priv->map, RTL8365MB_CPU_PORT_MASK_REG,
RTL8365MB_CPU_PORT_MASK_MASK, RTL8365MB_CPU_PORT_MASK_MASK,
FIELD_PREP(RTL8365MB_CPU_PORT_MASK_MASK, FIELD_PREP(RTL8365MB_CPU_PORT_MASK_MASK,
cpu->mask)); cpu->mask));
...@@ -1726,26 +1764,26 @@ static int rtl8365mb_cpu_config(struct realtek_smi *smi) ...@@ -1726,26 +1764,26 @@ static int rtl8365mb_cpu_config(struct realtek_smi *smi)
FIELD_PREP(RTL8365MB_CPU_CTRL_TAG_POSITION_MASK, cpu->position) | FIELD_PREP(RTL8365MB_CPU_CTRL_TAG_POSITION_MASK, cpu->position) |
FIELD_PREP(RTL8365MB_CPU_CTRL_RXBYTECOUNT_MASK, cpu->rx_length) | FIELD_PREP(RTL8365MB_CPU_CTRL_RXBYTECOUNT_MASK, cpu->rx_length) |
FIELD_PREP(RTL8365MB_CPU_CTRL_TAG_FORMAT_MASK, cpu->format) | FIELD_PREP(RTL8365MB_CPU_CTRL_TAG_FORMAT_MASK, cpu->format) |
FIELD_PREP(RTL8365MB_CPU_CTRL_TRAP_PORT_MASK, cpu->trap_port) | FIELD_PREP(RTL8365MB_CPU_CTRL_TRAP_PORT_MASK, cpu->trap_port & 0x7) |
FIELD_PREP(RTL8365MB_CPU_CTRL_TRAP_PORT_EXT_MASK, FIELD_PREP(RTL8365MB_CPU_CTRL_TRAP_PORT_EXT_MASK,
cpu->trap_port >> 3); cpu->trap_port >> 3 & 0x1);
ret = regmap_write(smi->map, RTL8365MB_CPU_CTRL_REG, val); ret = regmap_write(priv->map, RTL8365MB_CPU_CTRL_REG, val);
if (ret) if (ret)
return ret; return ret;
return 0; return 0;
} }
static int rtl8365mb_switch_init(struct realtek_smi *smi) static int rtl8365mb_switch_init(struct realtek_priv *priv)
{ {
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
int ret; int ret;
int i; int i;
/* Do any chip-specific init jam before getting to the common stuff */ /* Do any chip-specific init jam before getting to the common stuff */
if (mb->jam_table) { if (mb->jam_table) {
for (i = 0; i < mb->jam_size; i++) { for (i = 0; i < mb->jam_size; i++) {
ret = regmap_write(smi->map, mb->jam_table[i].reg, ret = regmap_write(priv->map, mb->jam_table[i].reg,
mb->jam_table[i].val); mb->jam_table[i].val);
if (ret) if (ret)
return ret; return ret;
...@@ -1754,7 +1792,7 @@ static int rtl8365mb_switch_init(struct realtek_smi *smi) ...@@ -1754,7 +1792,7 @@ static int rtl8365mb_switch_init(struct realtek_smi *smi)
/* Common init jam */ /* Common init jam */
for (i = 0; i < ARRAY_SIZE(rtl8365mb_init_jam_common); i++) { for (i = 0; i < ARRAY_SIZE(rtl8365mb_init_jam_common); i++) {
ret = regmap_write(smi->map, rtl8365mb_init_jam_common[i].reg, ret = regmap_write(priv->map, rtl8365mb_init_jam_common[i].reg,
rtl8365mb_init_jam_common[i].val); rtl8365mb_init_jam_common[i].val);
if (ret) if (ret)
return ret; return ret;
...@@ -1763,75 +1801,86 @@ static int rtl8365mb_switch_init(struct realtek_smi *smi) ...@@ -1763,75 +1801,86 @@ static int rtl8365mb_switch_init(struct realtek_smi *smi)
return 0; return 0;
} }
static int rtl8365mb_reset_chip(struct realtek_smi *smi) static int rtl8365mb_reset_chip(struct realtek_priv *priv)
{ {
u32 val; u32 val;
realtek_smi_write_reg_noack(smi, RTL8365MB_CHIP_RESET_REG, priv->write_reg_noack(priv, RTL8365MB_CHIP_RESET_REG,
FIELD_PREP(RTL8365MB_CHIP_RESET_HW_MASK, FIELD_PREP(RTL8365MB_CHIP_RESET_HW_MASK, 1));
1));
/* Realtek documentation says the chip needs 1 second to reset. Sleep /* Realtek documentation says the chip needs 1 second to reset. Sleep
* for 100 ms before accessing any registers to prevent ACK timeouts. * for 100 ms before accessing any registers to prevent ACK timeouts.
*/ */
msleep(100); msleep(100);
return regmap_read_poll_timeout(smi->map, RTL8365MB_CHIP_RESET_REG, val, return regmap_read_poll_timeout(priv->map, RTL8365MB_CHIP_RESET_REG, val,
!(val & RTL8365MB_CHIP_RESET_HW_MASK), !(val & RTL8365MB_CHIP_RESET_HW_MASK),
20000, 1e6); 20000, 1e6);
} }
static int rtl8365mb_setup(struct dsa_switch *ds) static int rtl8365mb_setup(struct dsa_switch *ds)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8365mb_cpu cpu = {0};
struct dsa_port *cpu_dp;
struct rtl8365mb *mb; struct rtl8365mb *mb;
int ret; int ret;
int i; int i;
mb = smi->chip_data; mb = priv->chip_data;
ret = rtl8365mb_reset_chip(smi); ret = rtl8365mb_reset_chip(priv);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to reset chip: %d\n", ret); dev_err(priv->dev, "failed to reset chip: %d\n", ret);
goto out_error; goto out_error;
} }
/* Configure switch to vendor-defined initial state */ /* Configure switch to vendor-defined initial state */
ret = rtl8365mb_switch_init(smi); ret = rtl8365mb_switch_init(priv);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to initialize switch: %d\n", ret); dev_err(priv->dev, "failed to initialize switch: %d\n", ret);
goto out_error; goto out_error;
} }
/* Set up cascading IRQs */ /* Set up cascading IRQs */
ret = rtl8365mb_irq_setup(smi); ret = rtl8365mb_irq_setup(priv);
if (ret == -EPROBE_DEFER) if (ret == -EPROBE_DEFER)
return ret; return ret;
else if (ret) else if (ret)
dev_info(smi->dev, "no interrupt support\n"); dev_info(priv->dev, "no interrupt support\n");
/* Configure CPU tagging */ /* Configure CPU tagging */
ret = rtl8365mb_cpu_config(smi); cpu.trap_port = RTL8365MB_MAX_NUM_PORTS;
dsa_switch_for_each_cpu_port(cpu_dp, priv->ds) {
cpu.mask |= BIT(cpu_dp->index);
if (cpu.trap_port == RTL8365MB_MAX_NUM_PORTS)
cpu.trap_port = cpu_dp->index;
}
cpu.enable = cpu.mask > 0;
cpu.insert = RTL8365MB_CPU_INSERT_TO_ALL;
cpu.position = RTL8365MB_CPU_POS_AFTER_SA;
cpu.rx_length = RTL8365MB_CPU_RXLEN_64BYTES;
cpu.format = RTL8365MB_CPU_FORMAT_8BYTES;
ret = rtl8365mb_cpu_config(priv, &cpu);
if (ret) if (ret)
goto out_teardown_irq; goto out_teardown_irq;
/* Configure ports */ /* Configure ports */
for (i = 0; i < smi->num_ports; i++) { for (i = 0; i < priv->num_ports; i++) {
struct rtl8365mb_port *p = &mb->ports[i]; struct rtl8365mb_port *p = &mb->ports[i];
if (dsa_is_unused_port(smi->ds, i)) if (dsa_is_unused_port(priv->ds, i))
continue; continue;
/* Set up per-port private data */
p->smi = smi;
p->index = i;
/* Forward only to the CPU */ /* Forward only to the CPU */
ret = rtl8365mb_port_set_isolation(smi, i, BIT(smi->cpu_port)); ret = rtl8365mb_port_set_isolation(priv, i, cpu.mask);
if (ret) if (ret)
goto out_teardown_irq; goto out_teardown_irq;
/* Disable learning */ /* Disable learning */
ret = rtl8365mb_port_set_learning(smi, i, false); ret = rtl8365mb_port_set_learning(priv, i, false);
if (ret) if (ret)
goto out_teardown_irq; goto out_teardown_irq;
...@@ -1839,29 +1888,35 @@ static int rtl8365mb_setup(struct dsa_switch *ds) ...@@ -1839,29 +1888,35 @@ static int rtl8365mb_setup(struct dsa_switch *ds)
* ports will still forward frames to the CPU despite being * ports will still forward frames to the CPU despite being
* administratively down by default. * administratively down by default.
*/ */
rtl8365mb_port_stp_state_set(smi->ds, i, BR_STATE_DISABLED); rtl8365mb_port_stp_state_set(priv->ds, i, BR_STATE_DISABLED);
/* Set up per-port private data */
p->priv = priv;
p->index = i;
} }
/* Set maximum packet length to 1536 bytes */ /* Set maximum packet length to 1536 bytes */
ret = regmap_update_bits(smi->map, RTL8365MB_CFG0_MAX_LEN_REG, ret = regmap_update_bits(priv->map, RTL8365MB_CFG0_MAX_LEN_REG,
RTL8365MB_CFG0_MAX_LEN_MASK, RTL8365MB_CFG0_MAX_LEN_MASK,
FIELD_PREP(RTL8365MB_CFG0_MAX_LEN_MASK, 1536)); FIELD_PREP(RTL8365MB_CFG0_MAX_LEN_MASK, 1536));
if (ret) if (ret)
goto out_teardown_irq; goto out_teardown_irq;
ret = realtek_smi_setup_mdio(smi); if (priv->setup_interface) {
if (ret) { ret = priv->setup_interface(ds);
dev_err(smi->dev, "could not set up MDIO bus\n"); if (ret) {
goto out_teardown_irq; dev_err(priv->dev, "could not set up MDIO bus\n");
goto out_teardown_irq;
}
} }
/* Start statistics counter polling */ /* Start statistics counter polling */
rtl8365mb_stats_setup(smi); rtl8365mb_stats_setup(priv);
return 0; return 0;
out_teardown_irq: out_teardown_irq:
rtl8365mb_irq_teardown(smi); rtl8365mb_irq_teardown(priv);
out_error: out_error:
return ret; return ret;
...@@ -1869,10 +1924,10 @@ static int rtl8365mb_setup(struct dsa_switch *ds) ...@@ -1869,10 +1924,10 @@ static int rtl8365mb_setup(struct dsa_switch *ds)
static void rtl8365mb_teardown(struct dsa_switch *ds) static void rtl8365mb_teardown(struct dsa_switch *ds)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
rtl8365mb_stats_teardown(smi); rtl8365mb_stats_teardown(priv);
rtl8365mb_irq_teardown(smi); rtl8365mb_irq_teardown(priv);
} }
static int rtl8365mb_get_chip_id_and_ver(struct regmap *map, u32 *id, u32 *ver) static int rtl8365mb_get_chip_id_and_ver(struct regmap *map, u32 *id, u32 *ver)
...@@ -1902,48 +1957,57 @@ static int rtl8365mb_get_chip_id_and_ver(struct regmap *map, u32 *id, u32 *ver) ...@@ -1902,48 +1957,57 @@ static int rtl8365mb_get_chip_id_and_ver(struct regmap *map, u32 *id, u32 *ver)
return 0; return 0;
} }
static int rtl8365mb_detect(struct realtek_smi *smi) static int rtl8365mb_detect(struct realtek_priv *priv)
{ {
struct rtl8365mb *mb = smi->chip_data; struct rtl8365mb *mb = priv->chip_data;
u32 chip_id; u32 chip_id;
u32 chip_ver; u32 chip_ver;
int ret; int ret;
ret = rtl8365mb_get_chip_id_and_ver(smi->map, &chip_id, &chip_ver); ret = rtl8365mb_get_chip_id_and_ver(priv->map, &chip_id, &chip_ver);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to read chip id and version: %d\n", dev_err(priv->dev, "failed to read chip id and version: %d\n",
ret); ret);
return ret; return ret;
} }
switch (chip_id) { switch (chip_id) {
case RTL8365MB_CHIP_ID_8365MB_VC: case RTL8365MB_CHIP_ID_8365MB_VC:
dev_info(smi->dev, switch (chip_ver) {
"found an RTL8365MB-VC switch (ver=0x%04x)\n", case RTL8365MB_CHIP_VER_8365MB_VC:
chip_ver); dev_info(priv->dev,
"found an RTL8365MB-VC switch (ver=0x%04x)\n",
chip_ver);
break;
case RTL8365MB_CHIP_VER_8367RB:
dev_info(priv->dev,
"found an RTL8367RB-VB switch (ver=0x%04x)\n",
chip_ver);
break;
case RTL8365MB_CHIP_VER_8367S:
dev_info(priv->dev,
"found an RTL8367S switch (ver=0x%04x)\n",
chip_ver);
break;
default:
dev_err(priv->dev, "unrecognized switch version (ver=0x%04x)",
chip_ver);
return -ENODEV;
}
smi->cpu_port = RTL8365MB_CPU_PORT_NUM_8365MB_VC; priv->num_ports = RTL8365MB_MAX_NUM_PORTS;
smi->num_ports = smi->cpu_port + 1;
mb->smi = smi; mb->priv = priv;
mb->chip_id = chip_id; mb->chip_id = chip_id;
mb->chip_ver = chip_ver; mb->chip_ver = chip_ver;
mb->port_mask = BIT(smi->num_ports) - 1; mb->port_mask = GENMASK(priv->num_ports - 1, 0);
mb->learn_limit_max = RTL8365MB_LEARN_LIMIT_MAX_8365MB_VC; mb->learn_limit_max = RTL8365MB_LEARN_LIMIT_MAX;
mb->jam_table = rtl8365mb_init_jam_8365mb_vc; mb->jam_table = rtl8365mb_init_jam_8365mb_vc;
mb->jam_size = ARRAY_SIZE(rtl8365mb_init_jam_8365mb_vc); mb->jam_size = ARRAY_SIZE(rtl8365mb_init_jam_8365mb_vc);
mb->cpu.enable = 1;
mb->cpu.mask = BIT(smi->cpu_port);
mb->cpu.trap_port = smi->cpu_port;
mb->cpu.insert = RTL8365MB_CPU_INSERT_TO_ALL;
mb->cpu.position = RTL8365MB_CPU_POS_AFTER_SA;
mb->cpu.rx_length = RTL8365MB_CPU_RXLEN_64BYTES;
mb->cpu.format = RTL8365MB_CPU_FORMAT_8BYTES;
break; break;
default: default:
dev_err(smi->dev, dev_err(priv->dev,
"found an unknown Realtek switch (id=0x%04x, ver=0x%04x)\n", "found an unknown Realtek switch (id=0x%04x, ver=0x%04x)\n",
chip_id, chip_ver); chip_id, chip_ver);
return -ENODEV; return -ENODEV;
...@@ -1952,7 +2016,25 @@ static int rtl8365mb_detect(struct realtek_smi *smi) ...@@ -1952,7 +2016,25 @@ static int rtl8365mb_detect(struct realtek_smi *smi)
return 0; return 0;
} }
static const struct dsa_switch_ops rtl8365mb_switch_ops = { static const struct dsa_switch_ops rtl8365mb_switch_ops_smi = {
.get_tag_protocol = rtl8365mb_get_tag_protocol,
.setup = rtl8365mb_setup,
.teardown = rtl8365mb_teardown,
.phylink_validate = rtl8365mb_phylink_validate,
.phylink_mac_config = rtl8365mb_phylink_mac_config,
.phylink_mac_link_down = rtl8365mb_phylink_mac_link_down,
.phylink_mac_link_up = rtl8365mb_phylink_mac_link_up,
.port_stp_state_set = rtl8365mb_port_stp_state_set,
.get_strings = rtl8365mb_get_strings,
.get_ethtool_stats = rtl8365mb_get_ethtool_stats,
.get_sset_count = rtl8365mb_get_sset_count,
.get_eth_phy_stats = rtl8365mb_get_phy_stats,
.get_eth_mac_stats = rtl8365mb_get_mac_stats,
.get_eth_ctrl_stats = rtl8365mb_get_ctrl_stats,
.get_stats64 = rtl8365mb_get_stats64,
};
static const struct dsa_switch_ops rtl8365mb_switch_ops_mdio = {
.get_tag_protocol = rtl8365mb_get_tag_protocol, .get_tag_protocol = rtl8365mb_get_tag_protocol,
.setup = rtl8365mb_setup, .setup = rtl8365mb_setup,
.teardown = rtl8365mb_teardown, .teardown = rtl8365mb_teardown,
...@@ -1960,6 +2042,8 @@ static const struct dsa_switch_ops rtl8365mb_switch_ops = { ...@@ -1960,6 +2042,8 @@ static const struct dsa_switch_ops rtl8365mb_switch_ops = {
.phylink_mac_config = rtl8365mb_phylink_mac_config, .phylink_mac_config = rtl8365mb_phylink_mac_config,
.phylink_mac_link_down = rtl8365mb_phylink_mac_link_down, .phylink_mac_link_down = rtl8365mb_phylink_mac_link_down,
.phylink_mac_link_up = rtl8365mb_phylink_mac_link_up, .phylink_mac_link_up = rtl8365mb_phylink_mac_link_up,
.phy_read = rtl8365mb_dsa_phy_read,
.phy_write = rtl8365mb_dsa_phy_write,
.port_stp_state_set = rtl8365mb_port_stp_state_set, .port_stp_state_set = rtl8365mb_port_stp_state_set,
.get_strings = rtl8365mb_get_strings, .get_strings = rtl8365mb_get_strings,
.get_ethtool_stats = rtl8365mb_get_ethtool_stats, .get_ethtool_stats = rtl8365mb_get_ethtool_stats,
...@@ -1970,18 +2054,23 @@ static const struct dsa_switch_ops rtl8365mb_switch_ops = { ...@@ -1970,18 +2054,23 @@ static const struct dsa_switch_ops rtl8365mb_switch_ops = {
.get_stats64 = rtl8365mb_get_stats64, .get_stats64 = rtl8365mb_get_stats64,
}; };
static const struct realtek_smi_ops rtl8365mb_smi_ops = { static const struct realtek_ops rtl8365mb_ops = {
.detect = rtl8365mb_detect, .detect = rtl8365mb_detect,
.phy_read = rtl8365mb_phy_read, .phy_read = rtl8365mb_phy_read,
.phy_write = rtl8365mb_phy_write, .phy_write = rtl8365mb_phy_write,
}; };
const struct realtek_smi_variant rtl8365mb_variant = { const struct realtek_variant rtl8365mb_variant = {
.ds_ops = &rtl8365mb_switch_ops, .ds_ops_smi = &rtl8365mb_switch_ops_smi,
.ops = &rtl8365mb_smi_ops, .ds_ops_mdio = &rtl8365mb_switch_ops_mdio,
.ops = &rtl8365mb_ops,
.clk_delay = 10, .clk_delay = 10,
.cmd_read = 0xb9, .cmd_read = 0xb9,
.cmd_write = 0xb8, .cmd_write = 0xb8,
.chip_data_sz = sizeof(struct rtl8365mb), .chip_data_sz = sizeof(struct rtl8365mb),
}; };
EXPORT_SYMBOL_GPL(rtl8365mb_variant); EXPORT_SYMBOL_GPL(rtl8365mb_variant);
MODULE_AUTHOR("Alvin Šipraga <alsi@bang-olufsen.dk>");
MODULE_DESCRIPTION("Driver for RTL8365MB-VC ethernet switch");
MODULE_LICENSE("GPL");
...@@ -11,18 +11,18 @@ ...@@ -11,18 +11,18 @@
#include <linux/if_bridge.h> #include <linux/if_bridge.h>
#include <net/dsa.h> #include <net/dsa.h>
#include "realtek-smi-core.h" #include "realtek.h"
int rtl8366_mc_is_used(struct realtek_smi *smi, int mc_index, int *used) int rtl8366_mc_is_used(struct realtek_priv *priv, int mc_index, int *used)
{ {
int ret; int ret;
int i; int i;
*used = 0; *used = 0;
for (i = 0; i < smi->num_ports; i++) { for (i = 0; i < priv->num_ports; i++) {
int index = 0; int index = 0;
ret = smi->ops->get_mc_index(smi, i, &index); ret = priv->ops->get_mc_index(priv, i, &index);
if (ret) if (ret)
return ret; return ret;
...@@ -38,13 +38,13 @@ EXPORT_SYMBOL_GPL(rtl8366_mc_is_used); ...@@ -38,13 +38,13 @@ EXPORT_SYMBOL_GPL(rtl8366_mc_is_used);
/** /**
* rtl8366_obtain_mc() - retrieve or allocate a VLAN member configuration * rtl8366_obtain_mc() - retrieve or allocate a VLAN member configuration
* @smi: the Realtek SMI device instance * @priv: the Realtek SMI device instance
* @vid: the VLAN ID to look up or allocate * @vid: the VLAN ID to look up or allocate
* @vlanmc: the pointer will be assigned to a pointer to a valid member config * @vlanmc: the pointer will be assigned to a pointer to a valid member config
* if successful * if successful
* @return: index of a new member config or negative error number * @return: index of a new member config or negative error number
*/ */
static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid, static int rtl8366_obtain_mc(struct realtek_priv *priv, int vid,
struct rtl8366_vlan_mc *vlanmc) struct rtl8366_vlan_mc *vlanmc)
{ {
struct rtl8366_vlan_4k vlan4k; struct rtl8366_vlan_4k vlan4k;
...@@ -52,10 +52,10 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid, ...@@ -52,10 +52,10 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid,
int i; int i;
/* Try to find an existing member config entry for this VID */ /* Try to find an existing member config entry for this VID */
for (i = 0; i < smi->num_vlan_mc; i++) { for (i = 0; i < priv->num_vlan_mc; i++) {
ret = smi->ops->get_vlan_mc(smi, i, vlanmc); ret = priv->ops->get_vlan_mc(priv, i, vlanmc);
if (ret) { if (ret) {
dev_err(smi->dev, "error searching for VLAN MC %d for VID %d\n", dev_err(priv->dev, "error searching for VLAN MC %d for VID %d\n",
i, vid); i, vid);
return ret; return ret;
} }
...@@ -65,19 +65,19 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid, ...@@ -65,19 +65,19 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid,
} }
/* We have no MC entry for this VID, try to find an empty one */ /* We have no MC entry for this VID, try to find an empty one */
for (i = 0; i < smi->num_vlan_mc; i++) { for (i = 0; i < priv->num_vlan_mc; i++) {
ret = smi->ops->get_vlan_mc(smi, i, vlanmc); ret = priv->ops->get_vlan_mc(priv, i, vlanmc);
if (ret) { if (ret) {
dev_err(smi->dev, "error searching for VLAN MC %d for VID %d\n", dev_err(priv->dev, "error searching for VLAN MC %d for VID %d\n",
i, vid); i, vid);
return ret; return ret;
} }
if (vlanmc->vid == 0 && vlanmc->member == 0) { if (vlanmc->vid == 0 && vlanmc->member == 0) {
/* Update the entry from the 4K table */ /* Update the entry from the 4K table */
ret = smi->ops->get_vlan_4k(smi, vid, &vlan4k); ret = priv->ops->get_vlan_4k(priv, vid, &vlan4k);
if (ret) { if (ret) {
dev_err(smi->dev, "error looking for 4K VLAN MC %d for VID %d\n", dev_err(priv->dev, "error looking for 4K VLAN MC %d for VID %d\n",
i, vid); i, vid);
return ret; return ret;
} }
...@@ -86,30 +86,30 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid, ...@@ -86,30 +86,30 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid,
vlanmc->member = vlan4k.member; vlanmc->member = vlan4k.member;
vlanmc->untag = vlan4k.untag; vlanmc->untag = vlan4k.untag;
vlanmc->fid = vlan4k.fid; vlanmc->fid = vlan4k.fid;
ret = smi->ops->set_vlan_mc(smi, i, vlanmc); ret = priv->ops->set_vlan_mc(priv, i, vlanmc);
if (ret) { if (ret) {
dev_err(smi->dev, "unable to set/update VLAN MC %d for VID %d\n", dev_err(priv->dev, "unable to set/update VLAN MC %d for VID %d\n",
i, vid); i, vid);
return ret; return ret;
} }
dev_dbg(smi->dev, "created new MC at index %d for VID %d\n", dev_dbg(priv->dev, "created new MC at index %d for VID %d\n",
i, vid); i, vid);
return i; return i;
} }
} }
/* MC table is full, try to find an unused entry and replace it */ /* MC table is full, try to find an unused entry and replace it */
for (i = 0; i < smi->num_vlan_mc; i++) { for (i = 0; i < priv->num_vlan_mc; i++) {
int used; int used;
ret = rtl8366_mc_is_used(smi, i, &used); ret = rtl8366_mc_is_used(priv, i, &used);
if (ret) if (ret)
return ret; return ret;
if (!used) { if (!used) {
/* Update the entry from the 4K table */ /* Update the entry from the 4K table */
ret = smi->ops->get_vlan_4k(smi, vid, &vlan4k); ret = priv->ops->get_vlan_4k(priv, vid, &vlan4k);
if (ret) if (ret)
return ret; return ret;
...@@ -117,23 +117,23 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid, ...@@ -117,23 +117,23 @@ static int rtl8366_obtain_mc(struct realtek_smi *smi, int vid,
vlanmc->member = vlan4k.member; vlanmc->member = vlan4k.member;
vlanmc->untag = vlan4k.untag; vlanmc->untag = vlan4k.untag;
vlanmc->fid = vlan4k.fid; vlanmc->fid = vlan4k.fid;
ret = smi->ops->set_vlan_mc(smi, i, vlanmc); ret = priv->ops->set_vlan_mc(priv, i, vlanmc);
if (ret) { if (ret) {
dev_err(smi->dev, "unable to set/update VLAN MC %d for VID %d\n", dev_err(priv->dev, "unable to set/update VLAN MC %d for VID %d\n",
i, vid); i, vid);
return ret; return ret;
} }
dev_dbg(smi->dev, "recycled MC at index %i for VID %d\n", dev_dbg(priv->dev, "recycled MC at index %i for VID %d\n",
i, vid); i, vid);
return i; return i;
} }
} }
dev_err(smi->dev, "all VLAN member configurations are in use\n"); dev_err(priv->dev, "all VLAN member configurations are in use\n");
return -ENOSPC; return -ENOSPC;
} }
int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member, int rtl8366_set_vlan(struct realtek_priv *priv, int vid, u32 member,
u32 untag, u32 fid) u32 untag, u32 fid)
{ {
struct rtl8366_vlan_mc vlanmc; struct rtl8366_vlan_mc vlanmc;
...@@ -141,31 +141,31 @@ int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member, ...@@ -141,31 +141,31 @@ int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member,
int mc; int mc;
int ret; int ret;
if (!smi->ops->is_vlan_valid(smi, vid)) if (!priv->ops->is_vlan_valid(priv, vid))
return -EINVAL; return -EINVAL;
dev_dbg(smi->dev, dev_dbg(priv->dev,
"setting VLAN%d 4k members: 0x%02x, untagged: 0x%02x\n", "setting VLAN%d 4k members: 0x%02x, untagged: 0x%02x\n",
vid, member, untag); vid, member, untag);
/* Update the 4K table */ /* Update the 4K table */
ret = smi->ops->get_vlan_4k(smi, vid, &vlan4k); ret = priv->ops->get_vlan_4k(priv, vid, &vlan4k);
if (ret) if (ret)
return ret; return ret;
vlan4k.member |= member; vlan4k.member |= member;
vlan4k.untag |= untag; vlan4k.untag |= untag;
vlan4k.fid = fid; vlan4k.fid = fid;
ret = smi->ops->set_vlan_4k(smi, &vlan4k); ret = priv->ops->set_vlan_4k(priv, &vlan4k);
if (ret) if (ret)
return ret; return ret;
dev_dbg(smi->dev, dev_dbg(priv->dev,
"resulting VLAN%d 4k members: 0x%02x, untagged: 0x%02x\n", "resulting VLAN%d 4k members: 0x%02x, untagged: 0x%02x\n",
vid, vlan4k.member, vlan4k.untag); vid, vlan4k.member, vlan4k.untag);
/* Find or allocate a member config for this VID */ /* Find or allocate a member config for this VID */
ret = rtl8366_obtain_mc(smi, vid, &vlanmc); ret = rtl8366_obtain_mc(priv, vid, &vlanmc);
if (ret < 0) if (ret < 0)
return ret; return ret;
mc = ret; mc = ret;
...@@ -176,12 +176,12 @@ int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member, ...@@ -176,12 +176,12 @@ int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member,
vlanmc.fid = fid; vlanmc.fid = fid;
/* Commit updates to the MC entry */ /* Commit updates to the MC entry */
ret = smi->ops->set_vlan_mc(smi, mc, &vlanmc); ret = priv->ops->set_vlan_mc(priv, mc, &vlanmc);
if (ret) if (ret)
dev_err(smi->dev, "failed to commit changes to VLAN MC index %d for VID %d\n", dev_err(priv->dev, "failed to commit changes to VLAN MC index %d for VID %d\n",
mc, vid); mc, vid);
else else
dev_dbg(smi->dev, dev_dbg(priv->dev,
"resulting VLAN%d MC members: 0x%02x, untagged: 0x%02x\n", "resulting VLAN%d MC members: 0x%02x, untagged: 0x%02x\n",
vid, vlanmc.member, vlanmc.untag); vid, vlanmc.member, vlanmc.untag);
...@@ -189,37 +189,37 @@ int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member, ...@@ -189,37 +189,37 @@ int rtl8366_set_vlan(struct realtek_smi *smi, int vid, u32 member,
} }
EXPORT_SYMBOL_GPL(rtl8366_set_vlan); EXPORT_SYMBOL_GPL(rtl8366_set_vlan);
int rtl8366_set_pvid(struct realtek_smi *smi, unsigned int port, int rtl8366_set_pvid(struct realtek_priv *priv, unsigned int port,
unsigned int vid) unsigned int vid)
{ {
struct rtl8366_vlan_mc vlanmc; struct rtl8366_vlan_mc vlanmc;
int mc; int mc;
int ret; int ret;
if (!smi->ops->is_vlan_valid(smi, vid)) if (!priv->ops->is_vlan_valid(priv, vid))
return -EINVAL; return -EINVAL;
/* Find or allocate a member config for this VID */ /* Find or allocate a member config for this VID */
ret = rtl8366_obtain_mc(smi, vid, &vlanmc); ret = rtl8366_obtain_mc(priv, vid, &vlanmc);
if (ret < 0) if (ret < 0)
return ret; return ret;
mc = ret; mc = ret;
ret = smi->ops->set_mc_index(smi, port, mc); ret = priv->ops->set_mc_index(priv, port, mc);
if (ret) { if (ret) {
dev_err(smi->dev, "set PVID: failed to set MC index %d for port %d\n", dev_err(priv->dev, "set PVID: failed to set MC index %d for port %d\n",
mc, port); mc, port);
return ret; return ret;
} }
dev_dbg(smi->dev, "set PVID: the PVID for port %d set to %d using existing MC index %d\n", dev_dbg(priv->dev, "set PVID: the PVID for port %d set to %d using existing MC index %d\n",
port, vid, mc); port, vid, mc);
return 0; return 0;
} }
EXPORT_SYMBOL_GPL(rtl8366_set_pvid); EXPORT_SYMBOL_GPL(rtl8366_set_pvid);
int rtl8366_enable_vlan4k(struct realtek_smi *smi, bool enable) int rtl8366_enable_vlan4k(struct realtek_priv *priv, bool enable)
{ {
int ret; int ret;
...@@ -229,52 +229,52 @@ int rtl8366_enable_vlan4k(struct realtek_smi *smi, bool enable) ...@@ -229,52 +229,52 @@ int rtl8366_enable_vlan4k(struct realtek_smi *smi, bool enable)
*/ */
if (enable) { if (enable) {
/* Make sure VLAN is ON */ /* Make sure VLAN is ON */
ret = smi->ops->enable_vlan(smi, true); ret = priv->ops->enable_vlan(priv, true);
if (ret) if (ret)
return ret; return ret;
smi->vlan_enabled = true; priv->vlan_enabled = true;
} }
ret = smi->ops->enable_vlan4k(smi, enable); ret = priv->ops->enable_vlan4k(priv, enable);
if (ret) if (ret)
return ret; return ret;
smi->vlan4k_enabled = enable; priv->vlan4k_enabled = enable;
return 0; return 0;
} }
EXPORT_SYMBOL_GPL(rtl8366_enable_vlan4k); EXPORT_SYMBOL_GPL(rtl8366_enable_vlan4k);
int rtl8366_enable_vlan(struct realtek_smi *smi, bool enable) int rtl8366_enable_vlan(struct realtek_priv *priv, bool enable)
{ {
int ret; int ret;
ret = smi->ops->enable_vlan(smi, enable); ret = priv->ops->enable_vlan(priv, enable);
if (ret) if (ret)
return ret; return ret;
smi->vlan_enabled = enable; priv->vlan_enabled = enable;
/* If we turn VLAN off, make sure that we turn off /* If we turn VLAN off, make sure that we turn off
* 4k VLAN as well, if that happened to be on. * 4k VLAN as well, if that happened to be on.
*/ */
if (!enable) { if (!enable) {
smi->vlan4k_enabled = false; priv->vlan4k_enabled = false;
ret = smi->ops->enable_vlan4k(smi, false); ret = priv->ops->enable_vlan4k(priv, false);
} }
return ret; return ret;
} }
EXPORT_SYMBOL_GPL(rtl8366_enable_vlan); EXPORT_SYMBOL_GPL(rtl8366_enable_vlan);
int rtl8366_reset_vlan(struct realtek_smi *smi) int rtl8366_reset_vlan(struct realtek_priv *priv)
{ {
struct rtl8366_vlan_mc vlanmc; struct rtl8366_vlan_mc vlanmc;
int ret; int ret;
int i; int i;
rtl8366_enable_vlan(smi, false); rtl8366_enable_vlan(priv, false);
rtl8366_enable_vlan4k(smi, false); rtl8366_enable_vlan4k(priv, false);
/* Clear the 16 VLAN member configurations */ /* Clear the 16 VLAN member configurations */
vlanmc.vid = 0; vlanmc.vid = 0;
...@@ -282,8 +282,8 @@ int rtl8366_reset_vlan(struct realtek_smi *smi) ...@@ -282,8 +282,8 @@ int rtl8366_reset_vlan(struct realtek_smi *smi)
vlanmc.member = 0; vlanmc.member = 0;
vlanmc.untag = 0; vlanmc.untag = 0;
vlanmc.fid = 0; vlanmc.fid = 0;
for (i = 0; i < smi->num_vlan_mc; i++) { for (i = 0; i < priv->num_vlan_mc; i++) {
ret = smi->ops->set_vlan_mc(smi, i, &vlanmc); ret = priv->ops->set_vlan_mc(priv, i, &vlanmc);
if (ret) if (ret)
return ret; return ret;
} }
...@@ -298,12 +298,12 @@ int rtl8366_vlan_add(struct dsa_switch *ds, int port, ...@@ -298,12 +298,12 @@ int rtl8366_vlan_add(struct dsa_switch *ds, int port,
{ {
bool untagged = !!(vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED); bool untagged = !!(vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED);
bool pvid = !!(vlan->flags & BRIDGE_VLAN_INFO_PVID); bool pvid = !!(vlan->flags & BRIDGE_VLAN_INFO_PVID);
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
u32 member = 0; u32 member = 0;
u32 untag = 0; u32 untag = 0;
int ret; int ret;
if (!smi->ops->is_vlan_valid(smi, vlan->vid)) { if (!priv->ops->is_vlan_valid(priv, vlan->vid)) {
NL_SET_ERR_MSG_MOD(extack, "VLAN ID not valid"); NL_SET_ERR_MSG_MOD(extack, "VLAN ID not valid");
return -EINVAL; return -EINVAL;
} }
...@@ -312,13 +312,13 @@ int rtl8366_vlan_add(struct dsa_switch *ds, int port, ...@@ -312,13 +312,13 @@ int rtl8366_vlan_add(struct dsa_switch *ds, int port,
* FIXME: what's with this 4k business? * FIXME: what's with this 4k business?
* Just rtl8366_enable_vlan() seems inconclusive. * Just rtl8366_enable_vlan() seems inconclusive.
*/ */
ret = rtl8366_enable_vlan4k(smi, true); ret = rtl8366_enable_vlan4k(priv, true);
if (ret) { if (ret) {
NL_SET_ERR_MSG_MOD(extack, "Failed to enable VLAN 4K"); NL_SET_ERR_MSG_MOD(extack, "Failed to enable VLAN 4K");
return ret; return ret;
} }
dev_dbg(smi->dev, "add VLAN %d on port %d, %s, %s\n", dev_dbg(priv->dev, "add VLAN %d on port %d, %s, %s\n",
vlan->vid, port, untagged ? "untagged" : "tagged", vlan->vid, port, untagged ? "untagged" : "tagged",
pvid ? "PVID" : "no PVID"); pvid ? "PVID" : "no PVID");
...@@ -327,18 +327,18 @@ int rtl8366_vlan_add(struct dsa_switch *ds, int port, ...@@ -327,18 +327,18 @@ int rtl8366_vlan_add(struct dsa_switch *ds, int port,
if (untagged) if (untagged)
untag |= BIT(port); untag |= BIT(port);
ret = rtl8366_set_vlan(smi, vlan->vid, member, untag, 0); ret = rtl8366_set_vlan(priv, vlan->vid, member, untag, 0);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to set up VLAN %04x", vlan->vid); dev_err(priv->dev, "failed to set up VLAN %04x", vlan->vid);
return ret; return ret;
} }
if (!pvid) if (!pvid)
return 0; return 0;
ret = rtl8366_set_pvid(smi, port, vlan->vid); ret = rtl8366_set_pvid(priv, port, vlan->vid);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to set PVID on port %d to VLAN %04x", dev_err(priv->dev, "failed to set PVID on port %d to VLAN %04x",
port, vlan->vid); port, vlan->vid);
return ret; return ret;
} }
...@@ -350,15 +350,15 @@ EXPORT_SYMBOL_GPL(rtl8366_vlan_add); ...@@ -350,15 +350,15 @@ EXPORT_SYMBOL_GPL(rtl8366_vlan_add);
int rtl8366_vlan_del(struct dsa_switch *ds, int port, int rtl8366_vlan_del(struct dsa_switch *ds, int port,
const struct switchdev_obj_port_vlan *vlan) const struct switchdev_obj_port_vlan *vlan)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int ret, i; int ret, i;
dev_dbg(smi->dev, "del VLAN %d on port %d\n", vlan->vid, port); dev_dbg(priv->dev, "del VLAN %d on port %d\n", vlan->vid, port);
for (i = 0; i < smi->num_vlan_mc; i++) { for (i = 0; i < priv->num_vlan_mc; i++) {
struct rtl8366_vlan_mc vlanmc; struct rtl8366_vlan_mc vlanmc;
ret = smi->ops->get_vlan_mc(smi, i, &vlanmc); ret = priv->ops->get_vlan_mc(priv, i, &vlanmc);
if (ret) if (ret)
return ret; return ret;
...@@ -376,9 +376,9 @@ int rtl8366_vlan_del(struct dsa_switch *ds, int port, ...@@ -376,9 +376,9 @@ int rtl8366_vlan_del(struct dsa_switch *ds, int port,
vlanmc.priority = 0; vlanmc.priority = 0;
vlanmc.fid = 0; vlanmc.fid = 0;
} }
ret = smi->ops->set_vlan_mc(smi, i, &vlanmc); ret = priv->ops->set_vlan_mc(priv, i, &vlanmc);
if (ret) { if (ret) {
dev_err(smi->dev, dev_err(priv->dev,
"failed to remove VLAN %04x\n", "failed to remove VLAN %04x\n",
vlan->vid); vlan->vid);
return ret; return ret;
...@@ -394,15 +394,15 @@ EXPORT_SYMBOL_GPL(rtl8366_vlan_del); ...@@ -394,15 +394,15 @@ EXPORT_SYMBOL_GPL(rtl8366_vlan_del);
void rtl8366_get_strings(struct dsa_switch *ds, int port, u32 stringset, void rtl8366_get_strings(struct dsa_switch *ds, int port, u32 stringset,
uint8_t *data) uint8_t *data)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8366_mib_counter *mib; struct rtl8366_mib_counter *mib;
int i; int i;
if (port >= smi->num_ports) if (port >= priv->num_ports)
return; return;
for (i = 0; i < smi->num_mib_counters; i++) { for (i = 0; i < priv->num_mib_counters; i++) {
mib = &smi->mib_counters[i]; mib = &priv->mib_counters[i];
strncpy(data + i * ETH_GSTRING_LEN, strncpy(data + i * ETH_GSTRING_LEN,
mib->name, ETH_GSTRING_LEN); mib->name, ETH_GSTRING_LEN);
} }
...@@ -411,35 +411,35 @@ EXPORT_SYMBOL_GPL(rtl8366_get_strings); ...@@ -411,35 +411,35 @@ EXPORT_SYMBOL_GPL(rtl8366_get_strings);
int rtl8366_get_sset_count(struct dsa_switch *ds, int port, int sset) int rtl8366_get_sset_count(struct dsa_switch *ds, int port, int sset)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
/* We only support SS_STATS */ /* We only support SS_STATS */
if (sset != ETH_SS_STATS) if (sset != ETH_SS_STATS)
return 0; return 0;
if (port >= smi->num_ports) if (port >= priv->num_ports)
return -EINVAL; return -EINVAL;
return smi->num_mib_counters; return priv->num_mib_counters;
} }
EXPORT_SYMBOL_GPL(rtl8366_get_sset_count); EXPORT_SYMBOL_GPL(rtl8366_get_sset_count);
void rtl8366_get_ethtool_stats(struct dsa_switch *ds, int port, uint64_t *data) void rtl8366_get_ethtool_stats(struct dsa_switch *ds, int port, uint64_t *data)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int i; int i;
int ret; int ret;
if (port >= smi->num_ports) if (port >= priv->num_ports)
return; return;
for (i = 0; i < smi->num_mib_counters; i++) { for (i = 0; i < priv->num_mib_counters; i++) {
struct rtl8366_mib_counter *mib; struct rtl8366_mib_counter *mib;
u64 mibvalue = 0; u64 mibvalue = 0;
mib = &smi->mib_counters[i]; mib = &priv->mib_counters[i];
ret = smi->ops->get_mib_counter(smi, port, mib, &mibvalue); ret = priv->ops->get_mib_counter(priv, port, mib, &mibvalue);
if (ret) { if (ret) {
dev_err(smi->dev, "error reading MIB counter %s\n", dev_err(priv->dev, "error reading MIB counter %s\n",
mib->name); mib->name);
} }
data[i] = mibvalue; data[i] = mibvalue;
......
...@@ -21,7 +21,7 @@ ...@@ -21,7 +21,7 @@
#include <linux/of_irq.h> #include <linux/of_irq.h>
#include <linux/regmap.h> #include <linux/regmap.h>
#include "realtek-smi-core.h" #include "realtek.h"
#define RTL8366RB_PORT_NUM_CPU 5 #define RTL8366RB_PORT_NUM_CPU 5
#define RTL8366RB_NUM_PORTS 6 #define RTL8366RB_NUM_PORTS 6
...@@ -396,7 +396,7 @@ static struct rtl8366_mib_counter rtl8366rb_mib_counters[] = { ...@@ -396,7 +396,7 @@ static struct rtl8366_mib_counter rtl8366rb_mib_counters[] = {
{ 0, 70, 2, "IfOutBroadcastPkts" }, { 0, 70, 2, "IfOutBroadcastPkts" },
}; };
static int rtl8366rb_get_mib_counter(struct realtek_smi *smi, static int rtl8366rb_get_mib_counter(struct realtek_priv *priv,
int port, int port,
struct rtl8366_mib_counter *mib, struct rtl8366_mib_counter *mib,
u64 *mibvalue) u64 *mibvalue)
...@@ -412,12 +412,12 @@ static int rtl8366rb_get_mib_counter(struct realtek_smi *smi, ...@@ -412,12 +412,12 @@ static int rtl8366rb_get_mib_counter(struct realtek_smi *smi,
/* Writing access counter address first /* Writing access counter address first
* then ASIC will prepare 64bits counter wait for being retrived * then ASIC will prepare 64bits counter wait for being retrived
*/ */
ret = regmap_write(smi->map, addr, 0); /* Write whatever */ ret = regmap_write(priv->map, addr, 0); /* Write whatever */
if (ret) if (ret)
return ret; return ret;
/* Read MIB control register */ /* Read MIB control register */
ret = regmap_read(smi->map, RTL8366RB_MIB_CTRL_REG, &val); ret = regmap_read(priv->map, RTL8366RB_MIB_CTRL_REG, &val);
if (ret) if (ret)
return -EIO; return -EIO;
...@@ -430,7 +430,7 @@ static int rtl8366rb_get_mib_counter(struct realtek_smi *smi, ...@@ -430,7 +430,7 @@ static int rtl8366rb_get_mib_counter(struct realtek_smi *smi,
/* Read each individual MIB 16 bits at the time */ /* Read each individual MIB 16 bits at the time */
*mibvalue = 0; *mibvalue = 0;
for (i = mib->length; i > 0; i--) { for (i = mib->length; i > 0; i--) {
ret = regmap_read(smi->map, addr + (i - 1), &val); ret = regmap_read(priv->map, addr + (i - 1), &val);
if (ret) if (ret)
return ret; return ret;
*mibvalue = (*mibvalue << 16) | (val & 0xFFFF); *mibvalue = (*mibvalue << 16) | (val & 0xFFFF);
...@@ -455,38 +455,38 @@ static u32 rtl8366rb_get_irqmask(struct irq_data *d) ...@@ -455,38 +455,38 @@ static u32 rtl8366rb_get_irqmask(struct irq_data *d)
static void rtl8366rb_mask_irq(struct irq_data *d) static void rtl8366rb_mask_irq(struct irq_data *d)
{ {
struct realtek_smi *smi = irq_data_get_irq_chip_data(d); struct realtek_priv *priv = irq_data_get_irq_chip_data(d);
int ret; int ret;
ret = regmap_update_bits(smi->map, RTL8366RB_INTERRUPT_MASK_REG, ret = regmap_update_bits(priv->map, RTL8366RB_INTERRUPT_MASK_REG,
rtl8366rb_get_irqmask(d), 0); rtl8366rb_get_irqmask(d), 0);
if (ret) if (ret)
dev_err(smi->dev, "could not mask IRQ\n"); dev_err(priv->dev, "could not mask IRQ\n");
} }
static void rtl8366rb_unmask_irq(struct irq_data *d) static void rtl8366rb_unmask_irq(struct irq_data *d)
{ {
struct realtek_smi *smi = irq_data_get_irq_chip_data(d); struct realtek_priv *priv = irq_data_get_irq_chip_data(d);
int ret; int ret;
ret = regmap_update_bits(smi->map, RTL8366RB_INTERRUPT_MASK_REG, ret = regmap_update_bits(priv->map, RTL8366RB_INTERRUPT_MASK_REG,
rtl8366rb_get_irqmask(d), rtl8366rb_get_irqmask(d),
rtl8366rb_get_irqmask(d)); rtl8366rb_get_irqmask(d));
if (ret) if (ret)
dev_err(smi->dev, "could not unmask IRQ\n"); dev_err(priv->dev, "could not unmask IRQ\n");
} }
static irqreturn_t rtl8366rb_irq(int irq, void *data) static irqreturn_t rtl8366rb_irq(int irq, void *data)
{ {
struct realtek_smi *smi = data; struct realtek_priv *priv = data;
u32 stat; u32 stat;
int ret; int ret;
/* This clears the IRQ status register */ /* This clears the IRQ status register */
ret = regmap_read(smi->map, RTL8366RB_INTERRUPT_STATUS_REG, ret = regmap_read(priv->map, RTL8366RB_INTERRUPT_STATUS_REG,
&stat); &stat);
if (ret) { if (ret) {
dev_err(smi->dev, "can't read interrupt status\n"); dev_err(priv->dev, "can't read interrupt status\n");
return IRQ_NONE; return IRQ_NONE;
} }
stat &= RTL8366RB_INTERRUPT_VALID; stat &= RTL8366RB_INTERRUPT_VALID;
...@@ -502,7 +502,7 @@ static irqreturn_t rtl8366rb_irq(int irq, void *data) ...@@ -502,7 +502,7 @@ static irqreturn_t rtl8366rb_irq(int irq, void *data)
*/ */
if (line < 12 && line > 5) if (line < 12 && line > 5)
line -= 5; line -= 5;
child_irq = irq_find_mapping(smi->irqdomain, line); child_irq = irq_find_mapping(priv->irqdomain, line);
handle_nested_irq(child_irq); handle_nested_irq(child_irq);
} }
return IRQ_HANDLED; return IRQ_HANDLED;
...@@ -538,7 +538,7 @@ static const struct irq_domain_ops rtl8366rb_irqdomain_ops = { ...@@ -538,7 +538,7 @@ static const struct irq_domain_ops rtl8366rb_irqdomain_ops = {
.xlate = irq_domain_xlate_onecell, .xlate = irq_domain_xlate_onecell,
}; };
static int rtl8366rb_setup_cascaded_irq(struct realtek_smi *smi) static int rtl8366rb_setup_cascaded_irq(struct realtek_priv *priv)
{ {
struct device_node *intc; struct device_node *intc;
unsigned long irq_trig; unsigned long irq_trig;
...@@ -547,24 +547,24 @@ static int rtl8366rb_setup_cascaded_irq(struct realtek_smi *smi) ...@@ -547,24 +547,24 @@ static int rtl8366rb_setup_cascaded_irq(struct realtek_smi *smi)
u32 val; u32 val;
int i; int i;
intc = of_get_child_by_name(smi->dev->of_node, "interrupt-controller"); intc = of_get_child_by_name(priv->dev->of_node, "interrupt-controller");
if (!intc) { if (!intc) {
dev_err(smi->dev, "missing child interrupt-controller node\n"); dev_err(priv->dev, "missing child interrupt-controller node\n");
return -EINVAL; return -EINVAL;
} }
/* RB8366RB IRQs cascade off this one */ /* RB8366RB IRQs cascade off this one */
irq = of_irq_get(intc, 0); irq = of_irq_get(intc, 0);
if (irq <= 0) { if (irq <= 0) {
dev_err(smi->dev, "failed to get parent IRQ\n"); dev_err(priv->dev, "failed to get parent IRQ\n");
ret = irq ? irq : -EINVAL; ret = irq ? irq : -EINVAL;
goto out_put_node; goto out_put_node;
} }
/* This clears the IRQ status register */ /* This clears the IRQ status register */
ret = regmap_read(smi->map, RTL8366RB_INTERRUPT_STATUS_REG, ret = regmap_read(priv->map, RTL8366RB_INTERRUPT_STATUS_REG,
&val); &val);
if (ret) { if (ret) {
dev_err(smi->dev, "can't read interrupt status\n"); dev_err(priv->dev, "can't read interrupt status\n");
goto out_put_node; goto out_put_node;
} }
...@@ -573,48 +573,48 @@ static int rtl8366rb_setup_cascaded_irq(struct realtek_smi *smi) ...@@ -573,48 +573,48 @@ static int rtl8366rb_setup_cascaded_irq(struct realtek_smi *smi)
switch (irq_trig) { switch (irq_trig) {
case IRQF_TRIGGER_RISING: case IRQF_TRIGGER_RISING:
case IRQF_TRIGGER_HIGH: case IRQF_TRIGGER_HIGH:
dev_info(smi->dev, "active high/rising IRQ\n"); dev_info(priv->dev, "active high/rising IRQ\n");
val = 0; val = 0;
break; break;
case IRQF_TRIGGER_FALLING: case IRQF_TRIGGER_FALLING:
case IRQF_TRIGGER_LOW: case IRQF_TRIGGER_LOW:
dev_info(smi->dev, "active low/falling IRQ\n"); dev_info(priv->dev, "active low/falling IRQ\n");
val = RTL8366RB_INTERRUPT_POLARITY; val = RTL8366RB_INTERRUPT_POLARITY;
break; break;
} }
ret = regmap_update_bits(smi->map, RTL8366RB_INTERRUPT_CONTROL_REG, ret = regmap_update_bits(priv->map, RTL8366RB_INTERRUPT_CONTROL_REG,
RTL8366RB_INTERRUPT_POLARITY, RTL8366RB_INTERRUPT_POLARITY,
val); val);
if (ret) { if (ret) {
dev_err(smi->dev, "could not configure IRQ polarity\n"); dev_err(priv->dev, "could not configure IRQ polarity\n");
goto out_put_node; goto out_put_node;
} }
ret = devm_request_threaded_irq(smi->dev, irq, NULL, ret = devm_request_threaded_irq(priv->dev, irq, NULL,
rtl8366rb_irq, IRQF_ONESHOT, rtl8366rb_irq, IRQF_ONESHOT,
"RTL8366RB", smi); "RTL8366RB", priv);
if (ret) { if (ret) {
dev_err(smi->dev, "unable to request irq: %d\n", ret); dev_err(priv->dev, "unable to request irq: %d\n", ret);
goto out_put_node; goto out_put_node;
} }
smi->irqdomain = irq_domain_add_linear(intc, priv->irqdomain = irq_domain_add_linear(intc,
RTL8366RB_NUM_INTERRUPT, RTL8366RB_NUM_INTERRUPT,
&rtl8366rb_irqdomain_ops, &rtl8366rb_irqdomain_ops,
smi); priv);
if (!smi->irqdomain) { if (!priv->irqdomain) {
dev_err(smi->dev, "failed to create IRQ domain\n"); dev_err(priv->dev, "failed to create IRQ domain\n");
ret = -EINVAL; ret = -EINVAL;
goto out_put_node; goto out_put_node;
} }
for (i = 0; i < smi->num_ports; i++) for (i = 0; i < priv->num_ports; i++)
irq_set_parent(irq_create_mapping(smi->irqdomain, i), irq); irq_set_parent(irq_create_mapping(priv->irqdomain, i), irq);
out_put_node: out_put_node:
of_node_put(intc); of_node_put(intc);
return ret; return ret;
} }
static int rtl8366rb_set_addr(struct realtek_smi *smi) static int rtl8366rb_set_addr(struct realtek_priv *priv)
{ {
u8 addr[ETH_ALEN]; u8 addr[ETH_ALEN];
u16 val; u16 val;
...@@ -622,18 +622,18 @@ static int rtl8366rb_set_addr(struct realtek_smi *smi) ...@@ -622,18 +622,18 @@ static int rtl8366rb_set_addr(struct realtek_smi *smi)
eth_random_addr(addr); eth_random_addr(addr);
dev_info(smi->dev, "set MAC: %02X:%02X:%02X:%02X:%02X:%02X\n", dev_info(priv->dev, "set MAC: %02X:%02X:%02X:%02X:%02X:%02X\n",
addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]); addr[0], addr[1], addr[2], addr[3], addr[4], addr[5]);
val = addr[0] << 8 | addr[1]; val = addr[0] << 8 | addr[1];
ret = regmap_write(smi->map, RTL8366RB_SMAR0, val); ret = regmap_write(priv->map, RTL8366RB_SMAR0, val);
if (ret) if (ret)
return ret; return ret;
val = addr[2] << 8 | addr[3]; val = addr[2] << 8 | addr[3];
ret = regmap_write(smi->map, RTL8366RB_SMAR1, val); ret = regmap_write(priv->map, RTL8366RB_SMAR1, val);
if (ret) if (ret)
return ret; return ret;
val = addr[4] << 8 | addr[5]; val = addr[4] << 8 | addr[5];
ret = regmap_write(smi->map, RTL8366RB_SMAR2, val); ret = regmap_write(priv->map, RTL8366RB_SMAR2, val);
if (ret) if (ret)
return ret; return ret;
...@@ -765,7 +765,7 @@ static const struct rtl8366rb_jam_tbl_entry rtl8366rb_green_jam[] = { ...@@ -765,7 +765,7 @@ static const struct rtl8366rb_jam_tbl_entry rtl8366rb_green_jam[] = {
/* Function that jams the tables in the proper registers */ /* Function that jams the tables in the proper registers */
static int rtl8366rb_jam_table(const struct rtl8366rb_jam_tbl_entry *jam_table, static int rtl8366rb_jam_table(const struct rtl8366rb_jam_tbl_entry *jam_table,
int jam_size, struct realtek_smi *smi, int jam_size, struct realtek_priv *priv,
bool write_dbg) bool write_dbg)
{ {
u32 val; u32 val;
...@@ -774,24 +774,24 @@ static int rtl8366rb_jam_table(const struct rtl8366rb_jam_tbl_entry *jam_table, ...@@ -774,24 +774,24 @@ static int rtl8366rb_jam_table(const struct rtl8366rb_jam_tbl_entry *jam_table,
for (i = 0; i < jam_size; i++) { for (i = 0; i < jam_size; i++) {
if ((jam_table[i].reg & 0xBE00) == 0xBE00) { if ((jam_table[i].reg & 0xBE00) == 0xBE00) {
ret = regmap_read(smi->map, ret = regmap_read(priv->map,
RTL8366RB_PHY_ACCESS_BUSY_REG, RTL8366RB_PHY_ACCESS_BUSY_REG,
&val); &val);
if (ret) if (ret)
return ret; return ret;
if (!(val & RTL8366RB_PHY_INT_BUSY)) { if (!(val & RTL8366RB_PHY_INT_BUSY)) {
ret = regmap_write(smi->map, ret = regmap_write(priv->map,
RTL8366RB_PHY_ACCESS_CTRL_REG, RTL8366RB_PHY_ACCESS_CTRL_REG,
RTL8366RB_PHY_CTRL_WRITE); RTL8366RB_PHY_CTRL_WRITE);
if (ret) if (ret)
return ret; return ret;
} }
} }
if (write_dbg) if (write_dbg)
dev_dbg(smi->dev, "jam %04x into register %04x\n", dev_dbg(priv->dev, "jam %04x into register %04x\n",
jam_table[i].val, jam_table[i].val,
jam_table[i].reg); jam_table[i].reg);
ret = regmap_write(smi->map, ret = regmap_write(priv->map,
jam_table[i].reg, jam_table[i].reg,
jam_table[i].val); jam_table[i].val);
if (ret) if (ret)
...@@ -802,7 +802,7 @@ static int rtl8366rb_jam_table(const struct rtl8366rb_jam_tbl_entry *jam_table, ...@@ -802,7 +802,7 @@ static int rtl8366rb_jam_table(const struct rtl8366rb_jam_tbl_entry *jam_table,
static int rtl8366rb_setup(struct dsa_switch *ds) static int rtl8366rb_setup(struct dsa_switch *ds)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
const struct rtl8366rb_jam_tbl_entry *jam_table; const struct rtl8366rb_jam_tbl_entry *jam_table;
struct rtl8366rb *rb; struct rtl8366rb *rb;
u32 chip_ver = 0; u32 chip_ver = 0;
...@@ -812,11 +812,11 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -812,11 +812,11 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
int ret; int ret;
int i; int i;
rb = smi->chip_data; rb = priv->chip_data;
ret = regmap_read(smi->map, RTL8366RB_CHIP_ID_REG, &chip_id); ret = regmap_read(priv->map, RTL8366RB_CHIP_ID_REG, &chip_id);
if (ret) { if (ret) {
dev_err(smi->dev, "unable to read chip id\n"); dev_err(priv->dev, "unable to read chip id\n");
return ret; return ret;
} }
...@@ -824,18 +824,18 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -824,18 +824,18 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
case RTL8366RB_CHIP_ID_8366: case RTL8366RB_CHIP_ID_8366:
break; break;
default: default:
dev_err(smi->dev, "unknown chip id (%04x)\n", chip_id); dev_err(priv->dev, "unknown chip id (%04x)\n", chip_id);
return -ENODEV; return -ENODEV;
} }
ret = regmap_read(smi->map, RTL8366RB_CHIP_VERSION_CTRL_REG, ret = regmap_read(priv->map, RTL8366RB_CHIP_VERSION_CTRL_REG,
&chip_ver); &chip_ver);
if (ret) { if (ret) {
dev_err(smi->dev, "unable to read chip version\n"); dev_err(priv->dev, "unable to read chip version\n");
return ret; return ret;
} }
dev_info(smi->dev, "RTL%04x ver %u chip found\n", dev_info(priv->dev, "RTL%04x ver %u chip found\n",
chip_id, chip_ver & RTL8366RB_CHIP_VERSION_MASK); chip_id, chip_ver & RTL8366RB_CHIP_VERSION_MASK);
/* Do the init dance using the right jam table */ /* Do the init dance using the right jam table */
...@@ -872,20 +872,20 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -872,20 +872,20 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
jam_size = ARRAY_SIZE(rtl8366rb_init_jam_dgn3500); jam_size = ARRAY_SIZE(rtl8366rb_init_jam_dgn3500);
} }
ret = rtl8366rb_jam_table(jam_table, jam_size, smi, true); ret = rtl8366rb_jam_table(jam_table, jam_size, priv, true);
if (ret) if (ret)
return ret; return ret;
/* Isolate all user ports so they can only send packets to itself and the CPU port */ /* Isolate all user ports so they can only send packets to itself and the CPU port */
for (i = 0; i < RTL8366RB_PORT_NUM_CPU; i++) { for (i = 0; i < RTL8366RB_PORT_NUM_CPU; i++) {
ret = regmap_write(smi->map, RTL8366RB_PORT_ISO(i), ret = regmap_write(priv->map, RTL8366RB_PORT_ISO(i),
RTL8366RB_PORT_ISO_PORTS(BIT(RTL8366RB_PORT_NUM_CPU)) | RTL8366RB_PORT_ISO_PORTS(BIT(RTL8366RB_PORT_NUM_CPU)) |
RTL8366RB_PORT_ISO_EN); RTL8366RB_PORT_ISO_EN);
if (ret) if (ret)
return ret; return ret;
} }
/* CPU port can send packets to all ports */ /* CPU port can send packets to all ports */
ret = regmap_write(smi->map, RTL8366RB_PORT_ISO(RTL8366RB_PORT_NUM_CPU), ret = regmap_write(priv->map, RTL8366RB_PORT_ISO(RTL8366RB_PORT_NUM_CPU),
RTL8366RB_PORT_ISO_PORTS(dsa_user_ports(ds)) | RTL8366RB_PORT_ISO_PORTS(dsa_user_ports(ds)) |
RTL8366RB_PORT_ISO_EN); RTL8366RB_PORT_ISO_EN);
if (ret) if (ret)
...@@ -893,26 +893,26 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -893,26 +893,26 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
/* Set up the "green ethernet" feature */ /* Set up the "green ethernet" feature */
ret = rtl8366rb_jam_table(rtl8366rb_green_jam, ret = rtl8366rb_jam_table(rtl8366rb_green_jam,
ARRAY_SIZE(rtl8366rb_green_jam), smi, false); ARRAY_SIZE(rtl8366rb_green_jam), priv, false);
if (ret) if (ret)
return ret; return ret;
ret = regmap_write(smi->map, ret = regmap_write(priv->map,
RTL8366RB_GREEN_FEATURE_REG, RTL8366RB_GREEN_FEATURE_REG,
(chip_ver == 1) ? 0x0007 : 0x0003); (chip_ver == 1) ? 0x0007 : 0x0003);
if (ret) if (ret)
return ret; return ret;
/* Vendor driver sets 0x240 in registers 0xc and 0xd (undocumented) */ /* Vendor driver sets 0x240 in registers 0xc and 0xd (undocumented) */
ret = regmap_write(smi->map, 0x0c, 0x240); ret = regmap_write(priv->map, 0x0c, 0x240);
if (ret) if (ret)
return ret; return ret;
ret = regmap_write(smi->map, 0x0d, 0x240); ret = regmap_write(priv->map, 0x0d, 0x240);
if (ret) if (ret)
return ret; return ret;
/* Set some random MAC address */ /* Set some random MAC address */
ret = rtl8366rb_set_addr(smi); ret = rtl8366rb_set_addr(priv);
if (ret) if (ret)
return ret; return ret;
...@@ -921,21 +921,21 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -921,21 +921,21 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
* If you set RTL8368RB_CPU_NO_TAG (bit 15) in this registers * If you set RTL8368RB_CPU_NO_TAG (bit 15) in this registers
* the custom tag is turned off. * the custom tag is turned off.
*/ */
ret = regmap_update_bits(smi->map, RTL8368RB_CPU_CTRL_REG, ret = regmap_update_bits(priv->map, RTL8368RB_CPU_CTRL_REG,
0xFFFF, 0xFFFF,
BIT(smi->cpu_port)); BIT(priv->cpu_port));
if (ret) if (ret)
return ret; return ret;
/* Make sure we default-enable the fixed CPU port */ /* Make sure we default-enable the fixed CPU port */
ret = regmap_update_bits(smi->map, RTL8366RB_PECR, ret = regmap_update_bits(priv->map, RTL8366RB_PECR,
BIT(smi->cpu_port), BIT(priv->cpu_port),
0); 0);
if (ret) if (ret)
return ret; return ret;
/* Set maximum packet length to 1536 bytes */ /* Set maximum packet length to 1536 bytes */
ret = regmap_update_bits(smi->map, RTL8366RB_SGCR, ret = regmap_update_bits(priv->map, RTL8366RB_SGCR,
RTL8366RB_SGCR_MAX_LENGTH_MASK, RTL8366RB_SGCR_MAX_LENGTH_MASK,
RTL8366RB_SGCR_MAX_LENGTH_1536); RTL8366RB_SGCR_MAX_LENGTH_1536);
if (ret) if (ret)
...@@ -945,13 +945,13 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -945,13 +945,13 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
rb->max_mtu[i] = 1532; rb->max_mtu[i] = 1532;
/* Disable learning for all ports */ /* Disable learning for all ports */
ret = regmap_write(smi->map, RTL8366RB_PORT_LEARNDIS_CTRL, ret = regmap_write(priv->map, RTL8366RB_PORT_LEARNDIS_CTRL,
RTL8366RB_PORT_ALL); RTL8366RB_PORT_ALL);
if (ret) if (ret)
return ret; return ret;
/* Enable auto ageing for all ports */ /* Enable auto ageing for all ports */
ret = regmap_write(smi->map, RTL8366RB_SECURITY_CTRL, 0); ret = regmap_write(priv->map, RTL8366RB_SECURITY_CTRL, 0);
if (ret) if (ret)
return ret; return ret;
...@@ -962,30 +962,30 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -962,30 +962,30 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
* connected to something exotic such as fiber, then this might * connected to something exotic such as fiber, then this might
* be worth experimenting with. * be worth experimenting with.
*/ */
ret = regmap_update_bits(smi->map, RTL8366RB_PMC0, ret = regmap_update_bits(priv->map, RTL8366RB_PMC0,
RTL8366RB_PMC0_P4_IOMODE_MASK, RTL8366RB_PMC0_P4_IOMODE_MASK,
0 << RTL8366RB_PMC0_P4_IOMODE_SHIFT); 0 << RTL8366RB_PMC0_P4_IOMODE_SHIFT);
if (ret) if (ret)
return ret; return ret;
/* Accept all packets by default, we enable filtering on-demand */ /* Accept all packets by default, we enable filtering on-demand */
ret = regmap_write(smi->map, RTL8366RB_VLAN_INGRESS_CTRL1_REG, ret = regmap_write(priv->map, RTL8366RB_VLAN_INGRESS_CTRL1_REG,
0); 0);
if (ret) if (ret)
return ret; return ret;
ret = regmap_write(smi->map, RTL8366RB_VLAN_INGRESS_CTRL2_REG, ret = regmap_write(priv->map, RTL8366RB_VLAN_INGRESS_CTRL2_REG,
0); 0);
if (ret) if (ret)
return ret; return ret;
/* Don't drop packets whose DA has not been learned */ /* Don't drop packets whose DA has not been learned */
ret = regmap_update_bits(smi->map, RTL8366RB_SSCR2, ret = regmap_update_bits(priv->map, RTL8366RB_SSCR2,
RTL8366RB_SSCR2_DROP_UNKNOWN_DA, 0); RTL8366RB_SSCR2_DROP_UNKNOWN_DA, 0);
if (ret) if (ret)
return ret; return ret;
/* Set blinking, TODO: make this configurable */ /* Set blinking, TODO: make this configurable */
ret = regmap_update_bits(smi->map, RTL8366RB_LED_BLINKRATE_REG, ret = regmap_update_bits(priv->map, RTL8366RB_LED_BLINKRATE_REG,
RTL8366RB_LED_BLINKRATE_MASK, RTL8366RB_LED_BLINKRATE_MASK,
RTL8366RB_LED_BLINKRATE_56MS); RTL8366RB_LED_BLINKRATE_56MS);
if (ret) if (ret)
...@@ -996,15 +996,15 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -996,15 +996,15 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
* behaviour (no individual config) but we can set up each * behaviour (no individual config) but we can set up each
* LED separately. * LED separately.
*/ */
if (smi->leds_disabled) { if (priv->leds_disabled) {
/* Turn everything off */ /* Turn everything off */
regmap_update_bits(smi->map, regmap_update_bits(priv->map,
RTL8366RB_LED_0_1_CTRL_REG, RTL8366RB_LED_0_1_CTRL_REG,
0x0FFF, 0); 0x0FFF, 0);
regmap_update_bits(smi->map, regmap_update_bits(priv->map,
RTL8366RB_LED_2_3_CTRL_REG, RTL8366RB_LED_2_3_CTRL_REG,
0x0FFF, 0); 0x0FFF, 0);
regmap_update_bits(smi->map, regmap_update_bits(priv->map,
RTL8366RB_INTERRUPT_CONTROL_REG, RTL8366RB_INTERRUPT_CONTROL_REG,
RTL8366RB_P4_RGMII_LED, RTL8366RB_P4_RGMII_LED,
0); 0);
...@@ -1014,7 +1014,7 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -1014,7 +1014,7 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
val = RTL8366RB_LED_FORCE; val = RTL8366RB_LED_FORCE;
} }
for (i = 0; i < 4; i++) { for (i = 0; i < 4; i++) {
ret = regmap_update_bits(smi->map, ret = regmap_update_bits(priv->map,
RTL8366RB_LED_CTRL_REG, RTL8366RB_LED_CTRL_REG,
0xf << (i * 4), 0xf << (i * 4),
val << (i * 4)); val << (i * 4));
...@@ -1022,18 +1022,20 @@ static int rtl8366rb_setup(struct dsa_switch *ds) ...@@ -1022,18 +1022,20 @@ static int rtl8366rb_setup(struct dsa_switch *ds)
return ret; return ret;
} }
ret = rtl8366_reset_vlan(smi); ret = rtl8366_reset_vlan(priv);
if (ret) if (ret)
return ret; return ret;
ret = rtl8366rb_setup_cascaded_irq(smi); ret = rtl8366rb_setup_cascaded_irq(priv);
if (ret) if (ret)
dev_info(smi->dev, "no interrupt support\n"); dev_info(priv->dev, "no interrupt support\n");
ret = realtek_smi_setup_mdio(smi); if (priv->setup_interface) {
if (ret) { ret = priv->setup_interface(ds);
dev_info(smi->dev, "could not set up MDIO bus\n"); if (ret) {
return -ENODEV; dev_err(priv->dev, "could not set up MDIO bus\n");
return -ENODEV;
}
} }
return 0; return 0;
...@@ -1052,35 +1054,35 @@ rtl8366rb_mac_link_up(struct dsa_switch *ds, int port, unsigned int mode, ...@@ -1052,35 +1054,35 @@ rtl8366rb_mac_link_up(struct dsa_switch *ds, int port, unsigned int mode,
phy_interface_t interface, struct phy_device *phydev, phy_interface_t interface, struct phy_device *phydev,
int speed, int duplex, bool tx_pause, bool rx_pause) int speed, int duplex, bool tx_pause, bool rx_pause)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int ret; int ret;
if (port != smi->cpu_port) if (port != priv->cpu_port)
return; return;
dev_dbg(smi->dev, "MAC link up on CPU port (%d)\n", port); dev_dbg(priv->dev, "MAC link up on CPU port (%d)\n", port);
/* Force the fixed CPU port into 1Gbit mode, no autonegotiation */ /* Force the fixed CPU port into 1Gbit mode, no autonegotiation */
ret = regmap_update_bits(smi->map, RTL8366RB_MAC_FORCE_CTRL_REG, ret = regmap_update_bits(priv->map, RTL8366RB_MAC_FORCE_CTRL_REG,
BIT(port), BIT(port)); BIT(port), BIT(port));
if (ret) { if (ret) {
dev_err(smi->dev, "failed to force 1Gbit on CPU port\n"); dev_err(priv->dev, "failed to force 1Gbit on CPU port\n");
return; return;
} }
ret = regmap_update_bits(smi->map, RTL8366RB_PAACR2, ret = regmap_update_bits(priv->map, RTL8366RB_PAACR2,
0xFF00U, 0xFF00U,
RTL8366RB_PAACR_CPU_PORT << 8); RTL8366RB_PAACR_CPU_PORT << 8);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to set PAACR on CPU port\n"); dev_err(priv->dev, "failed to set PAACR on CPU port\n");
return; return;
} }
/* Enable the CPU port */ /* Enable the CPU port */
ret = regmap_update_bits(smi->map, RTL8366RB_PECR, BIT(port), ret = regmap_update_bits(priv->map, RTL8366RB_PECR, BIT(port),
0); 0);
if (ret) { if (ret) {
dev_err(smi->dev, "failed to enable the CPU port\n"); dev_err(priv->dev, "failed to enable the CPU port\n");
return; return;
} }
} }
...@@ -1089,99 +1091,99 @@ static void ...@@ -1089,99 +1091,99 @@ static void
rtl8366rb_mac_link_down(struct dsa_switch *ds, int port, unsigned int mode, rtl8366rb_mac_link_down(struct dsa_switch *ds, int port, unsigned int mode,
phy_interface_t interface) phy_interface_t interface)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int ret; int ret;
if (port != smi->cpu_port) if (port != priv->cpu_port)
return; return;
dev_dbg(smi->dev, "MAC link down on CPU port (%d)\n", port); dev_dbg(priv->dev, "MAC link down on CPU port (%d)\n", port);
/* Disable the CPU port */ /* Disable the CPU port */
ret = regmap_update_bits(smi->map, RTL8366RB_PECR, BIT(port), ret = regmap_update_bits(priv->map, RTL8366RB_PECR, BIT(port),
BIT(port)); BIT(port));
if (ret) { if (ret) {
dev_err(smi->dev, "failed to disable the CPU port\n"); dev_err(priv->dev, "failed to disable the CPU port\n");
return; return;
} }
} }
static void rb8366rb_set_port_led(struct realtek_smi *smi, static void rb8366rb_set_port_led(struct realtek_priv *priv,
int port, bool enable) int port, bool enable)
{ {
u16 val = enable ? 0x3f : 0; u16 val = enable ? 0x3f : 0;
int ret; int ret;
if (smi->leds_disabled) if (priv->leds_disabled)
return; return;
switch (port) { switch (port) {
case 0: case 0:
ret = regmap_update_bits(smi->map, ret = regmap_update_bits(priv->map,
RTL8366RB_LED_0_1_CTRL_REG, RTL8366RB_LED_0_1_CTRL_REG,
0x3F, val); 0x3F, val);
break; break;
case 1: case 1:
ret = regmap_update_bits(smi->map, ret = regmap_update_bits(priv->map,
RTL8366RB_LED_0_1_CTRL_REG, RTL8366RB_LED_0_1_CTRL_REG,
0x3F << RTL8366RB_LED_1_OFFSET, 0x3F << RTL8366RB_LED_1_OFFSET,
val << RTL8366RB_LED_1_OFFSET); val << RTL8366RB_LED_1_OFFSET);
break; break;
case 2: case 2:
ret = regmap_update_bits(smi->map, ret = regmap_update_bits(priv->map,
RTL8366RB_LED_2_3_CTRL_REG, RTL8366RB_LED_2_3_CTRL_REG,
0x3F, val); 0x3F, val);
break; break;
case 3: case 3:
ret = regmap_update_bits(smi->map, ret = regmap_update_bits(priv->map,
RTL8366RB_LED_2_3_CTRL_REG, RTL8366RB_LED_2_3_CTRL_REG,
0x3F << RTL8366RB_LED_3_OFFSET, 0x3F << RTL8366RB_LED_3_OFFSET,
val << RTL8366RB_LED_3_OFFSET); val << RTL8366RB_LED_3_OFFSET);
break; break;
case 4: case 4:
ret = regmap_update_bits(smi->map, ret = regmap_update_bits(priv->map,
RTL8366RB_INTERRUPT_CONTROL_REG, RTL8366RB_INTERRUPT_CONTROL_REG,
RTL8366RB_P4_RGMII_LED, RTL8366RB_P4_RGMII_LED,
enable ? RTL8366RB_P4_RGMII_LED : 0); enable ? RTL8366RB_P4_RGMII_LED : 0);
break; break;
default: default:
dev_err(smi->dev, "no LED for port %d\n", port); dev_err(priv->dev, "no LED for port %d\n", port);
return; return;
} }
if (ret) if (ret)
dev_err(smi->dev, "error updating LED on port %d\n", port); dev_err(priv->dev, "error updating LED on port %d\n", port);
} }
static int static int
rtl8366rb_port_enable(struct dsa_switch *ds, int port, rtl8366rb_port_enable(struct dsa_switch *ds, int port,
struct phy_device *phy) struct phy_device *phy)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int ret; int ret;
dev_dbg(smi->dev, "enable port %d\n", port); dev_dbg(priv->dev, "enable port %d\n", port);
ret = regmap_update_bits(smi->map, RTL8366RB_PECR, BIT(port), ret = regmap_update_bits(priv->map, RTL8366RB_PECR, BIT(port),
0); 0);
if (ret) if (ret)
return ret; return ret;
rb8366rb_set_port_led(smi, port, true); rb8366rb_set_port_led(priv, port, true);
return 0; return 0;
} }
static void static void
rtl8366rb_port_disable(struct dsa_switch *ds, int port) rtl8366rb_port_disable(struct dsa_switch *ds, int port)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int ret; int ret;
dev_dbg(smi->dev, "disable port %d\n", port); dev_dbg(priv->dev, "disable port %d\n", port);
ret = regmap_update_bits(smi->map, RTL8366RB_PECR, BIT(port), ret = regmap_update_bits(priv->map, RTL8366RB_PECR, BIT(port),
BIT(port)); BIT(port));
if (ret) if (ret)
return; return;
rb8366rb_set_port_led(smi, port, false); rb8366rb_set_port_led(priv, port, false);
} }
static int static int
...@@ -1189,7 +1191,7 @@ rtl8366rb_port_bridge_join(struct dsa_switch *ds, int port, ...@@ -1189,7 +1191,7 @@ rtl8366rb_port_bridge_join(struct dsa_switch *ds, int port,
struct dsa_bridge bridge, struct dsa_bridge bridge,
bool *tx_fwd_offload) bool *tx_fwd_offload)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
unsigned int port_bitmap = 0; unsigned int port_bitmap = 0;
int ret, i; int ret, i;
...@@ -1202,17 +1204,17 @@ rtl8366rb_port_bridge_join(struct dsa_switch *ds, int port, ...@@ -1202,17 +1204,17 @@ rtl8366rb_port_bridge_join(struct dsa_switch *ds, int port,
if (!dsa_port_offloads_bridge(dsa_to_port(ds, i), &bridge)) if (!dsa_port_offloads_bridge(dsa_to_port(ds, i), &bridge))
continue; continue;
/* Join this port to each other port on the bridge */ /* Join this port to each other port on the bridge */
ret = regmap_update_bits(smi->map, RTL8366RB_PORT_ISO(i), ret = regmap_update_bits(priv->map, RTL8366RB_PORT_ISO(i),
RTL8366RB_PORT_ISO_PORTS(BIT(port)), RTL8366RB_PORT_ISO_PORTS(BIT(port)),
RTL8366RB_PORT_ISO_PORTS(BIT(port))); RTL8366RB_PORT_ISO_PORTS(BIT(port)));
if (ret) if (ret)
dev_err(smi->dev, "failed to join port %d\n", port); dev_err(priv->dev, "failed to join port %d\n", port);
port_bitmap |= BIT(i); port_bitmap |= BIT(i);
} }
/* Set the bits for the ports we can access */ /* Set the bits for the ports we can access */
return regmap_update_bits(smi->map, RTL8366RB_PORT_ISO(port), return regmap_update_bits(priv->map, RTL8366RB_PORT_ISO(port),
RTL8366RB_PORT_ISO_PORTS(port_bitmap), RTL8366RB_PORT_ISO_PORTS(port_bitmap),
RTL8366RB_PORT_ISO_PORTS(port_bitmap)); RTL8366RB_PORT_ISO_PORTS(port_bitmap));
} }
...@@ -1221,7 +1223,7 @@ static void ...@@ -1221,7 +1223,7 @@ static void
rtl8366rb_port_bridge_leave(struct dsa_switch *ds, int port, rtl8366rb_port_bridge_leave(struct dsa_switch *ds, int port,
struct dsa_bridge bridge) struct dsa_bridge bridge)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
unsigned int port_bitmap = 0; unsigned int port_bitmap = 0;
int ret, i; int ret, i;
...@@ -1234,28 +1236,30 @@ rtl8366rb_port_bridge_leave(struct dsa_switch *ds, int port, ...@@ -1234,28 +1236,30 @@ rtl8366rb_port_bridge_leave(struct dsa_switch *ds, int port,
if (!dsa_port_offloads_bridge(dsa_to_port(ds, i), &bridge)) if (!dsa_port_offloads_bridge(dsa_to_port(ds, i), &bridge))
continue; continue;
/* Remove this port from any other port on the bridge */ /* Remove this port from any other port on the bridge */
ret = regmap_update_bits(smi->map, RTL8366RB_PORT_ISO(i), ret = regmap_update_bits(priv->map, RTL8366RB_PORT_ISO(i),
RTL8366RB_PORT_ISO_PORTS(BIT(port)), 0); RTL8366RB_PORT_ISO_PORTS(BIT(port)), 0);
if (ret) if (ret)
dev_err(smi->dev, "failed to leave port %d\n", port); dev_err(priv->dev, "failed to leave port %d\n", port);
port_bitmap |= BIT(i); port_bitmap |= BIT(i);
} }
/* Clear the bits for the ports we can not access, leave ourselves */ /* Clear the bits for the ports we can not access, leave ourselves */
regmap_update_bits(smi->map, RTL8366RB_PORT_ISO(port), regmap_update_bits(priv->map, RTL8366RB_PORT_ISO(port),
RTL8366RB_PORT_ISO_PORTS(port_bitmap), 0); RTL8366RB_PORT_ISO_PORTS(port_bitmap), 0);
} }
/** /**
* rtl8366rb_drop_untagged() - make the switch drop untagged and C-tagged frames * rtl8366rb_drop_untagged() - make the switch drop untagged and C-tagged frames
* @smi: SMI state container * @priv: SMI state container
* @port: the port to drop untagged and C-tagged frames on * @port: the port to drop untagged and C-tagged frames on
* @drop: whether to drop or pass untagged and C-tagged frames * @drop: whether to drop or pass untagged and C-tagged frames
*
* Return: zero for success, a negative number on error.
*/ */
static int rtl8366rb_drop_untagged(struct realtek_smi *smi, int port, bool drop) static int rtl8366rb_drop_untagged(struct realtek_priv *priv, int port, bool drop)
{ {
return regmap_update_bits(smi->map, RTL8366RB_VLAN_INGRESS_CTRL1_REG, return regmap_update_bits(priv->map, RTL8366RB_VLAN_INGRESS_CTRL1_REG,
RTL8366RB_VLAN_INGRESS_CTRL1_DROP(port), RTL8366RB_VLAN_INGRESS_CTRL1_DROP(port),
drop ? RTL8366RB_VLAN_INGRESS_CTRL1_DROP(port) : 0); drop ? RTL8366RB_VLAN_INGRESS_CTRL1_DROP(port) : 0);
} }
...@@ -1264,17 +1268,17 @@ static int rtl8366rb_vlan_filtering(struct dsa_switch *ds, int port, ...@@ -1264,17 +1268,17 @@ static int rtl8366rb_vlan_filtering(struct dsa_switch *ds, int port,
bool vlan_filtering, bool vlan_filtering,
struct netlink_ext_ack *extack) struct netlink_ext_ack *extack)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8366rb *rb; struct rtl8366rb *rb;
int ret; int ret;
rb = smi->chip_data; rb = priv->chip_data;
dev_dbg(smi->dev, "port %d: %s VLAN filtering\n", port, dev_dbg(priv->dev, "port %d: %s VLAN filtering\n", port,
vlan_filtering ? "enable" : "disable"); vlan_filtering ? "enable" : "disable");
/* If the port is not in the member set, the frame will be dropped */ /* If the port is not in the member set, the frame will be dropped */
ret = regmap_update_bits(smi->map, RTL8366RB_VLAN_INGRESS_CTRL2_REG, ret = regmap_update_bits(priv->map, RTL8366RB_VLAN_INGRESS_CTRL2_REG,
BIT(port), vlan_filtering ? BIT(port) : 0); BIT(port), vlan_filtering ? BIT(port) : 0);
if (ret) if (ret)
return ret; return ret;
...@@ -1284,9 +1288,9 @@ static int rtl8366rb_vlan_filtering(struct dsa_switch *ds, int port, ...@@ -1284,9 +1288,9 @@ static int rtl8366rb_vlan_filtering(struct dsa_switch *ds, int port,
* filtering on a port, we need to accept any frames. * filtering on a port, we need to accept any frames.
*/ */
if (vlan_filtering) if (vlan_filtering)
ret = rtl8366rb_drop_untagged(smi, port, !rb->pvid_enabled[port]); ret = rtl8366rb_drop_untagged(priv, port, !rb->pvid_enabled[port]);
else else
ret = rtl8366rb_drop_untagged(smi, port, false); ret = rtl8366rb_drop_untagged(priv, port, false);
return ret; return ret;
} }
...@@ -1308,11 +1312,11 @@ rtl8366rb_port_bridge_flags(struct dsa_switch *ds, int port, ...@@ -1308,11 +1312,11 @@ rtl8366rb_port_bridge_flags(struct dsa_switch *ds, int port,
struct switchdev_brport_flags flags, struct switchdev_brport_flags flags,
struct netlink_ext_ack *extack) struct netlink_ext_ack *extack)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
int ret; int ret;
if (flags.mask & BR_LEARNING) { if (flags.mask & BR_LEARNING) {
ret = regmap_update_bits(smi->map, RTL8366RB_PORT_LEARNDIS_CTRL, ret = regmap_update_bits(priv->map, RTL8366RB_PORT_LEARNDIS_CTRL,
BIT(port), BIT(port),
(flags.val & BR_LEARNING) ? 0 : BIT(port)); (flags.val & BR_LEARNING) ? 0 : BIT(port));
if (ret) if (ret)
...@@ -1325,7 +1329,7 @@ rtl8366rb_port_bridge_flags(struct dsa_switch *ds, int port, ...@@ -1325,7 +1329,7 @@ rtl8366rb_port_bridge_flags(struct dsa_switch *ds, int port,
static void static void
rtl8366rb_port_stp_state_set(struct dsa_switch *ds, int port, u8 state) rtl8366rb_port_stp_state_set(struct dsa_switch *ds, int port, u8 state)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
u32 val; u32 val;
int i; int i;
...@@ -1344,13 +1348,13 @@ rtl8366rb_port_stp_state_set(struct dsa_switch *ds, int port, u8 state) ...@@ -1344,13 +1348,13 @@ rtl8366rb_port_stp_state_set(struct dsa_switch *ds, int port, u8 state)
val = RTL8366RB_STP_STATE_FORWARDING; val = RTL8366RB_STP_STATE_FORWARDING;
break; break;
default: default:
dev_err(smi->dev, "unknown bridge state requested\n"); dev_err(priv->dev, "unknown bridge state requested\n");
return; return;
} }
/* Set the same status for the port on all the FIDs */ /* Set the same status for the port on all the FIDs */
for (i = 0; i < RTL8366RB_NUM_FIDS; i++) { for (i = 0; i < RTL8366RB_NUM_FIDS; i++) {
regmap_update_bits(smi->map, RTL8366RB_STP_STATE_BASE + i, regmap_update_bits(priv->map, RTL8366RB_STP_STATE_BASE + i,
RTL8366RB_STP_STATE_MASK(port), RTL8366RB_STP_STATE_MASK(port),
RTL8366RB_STP_STATE(port, val)); RTL8366RB_STP_STATE(port, val));
} }
...@@ -1359,26 +1363,26 @@ rtl8366rb_port_stp_state_set(struct dsa_switch *ds, int port, u8 state) ...@@ -1359,26 +1363,26 @@ rtl8366rb_port_stp_state_set(struct dsa_switch *ds, int port, u8 state)
static void static void
rtl8366rb_port_fast_age(struct dsa_switch *ds, int port) rtl8366rb_port_fast_age(struct dsa_switch *ds, int port)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
/* This will age out any learned L2 entries */ /* This will age out any learned L2 entries */
regmap_update_bits(smi->map, RTL8366RB_SECURITY_CTRL, regmap_update_bits(priv->map, RTL8366RB_SECURITY_CTRL,
BIT(port), BIT(port)); BIT(port), BIT(port));
/* Restore the normal state of things */ /* Restore the normal state of things */
regmap_update_bits(smi->map, RTL8366RB_SECURITY_CTRL, regmap_update_bits(priv->map, RTL8366RB_SECURITY_CTRL,
BIT(port), 0); BIT(port), 0);
} }
static int rtl8366rb_change_mtu(struct dsa_switch *ds, int port, int new_mtu) static int rtl8366rb_change_mtu(struct dsa_switch *ds, int port, int new_mtu)
{ {
struct realtek_smi *smi = ds->priv; struct realtek_priv *priv = ds->priv;
struct rtl8366rb *rb; struct rtl8366rb *rb;
unsigned int max_mtu; unsigned int max_mtu;
u32 len; u32 len;
int i; int i;
/* Cache the per-port MTU setting */ /* Cache the per-port MTU setting */
rb = smi->chip_data; rb = priv->chip_data;
rb->max_mtu[port] = new_mtu; rb->max_mtu[port] = new_mtu;
/* Roof out the MTU for the entire switch to the greatest /* Roof out the MTU for the entire switch to the greatest
...@@ -1406,7 +1410,7 @@ static int rtl8366rb_change_mtu(struct dsa_switch *ds, int port, int new_mtu) ...@@ -1406,7 +1410,7 @@ static int rtl8366rb_change_mtu(struct dsa_switch *ds, int port, int new_mtu)
else else
len = RTL8366RB_SGCR_MAX_LENGTH_16000; len = RTL8366RB_SGCR_MAX_LENGTH_16000;
return regmap_update_bits(smi->map, RTL8366RB_SGCR, return regmap_update_bits(priv->map, RTL8366RB_SGCR,
RTL8366RB_SGCR_MAX_LENGTH_MASK, RTL8366RB_SGCR_MAX_LENGTH_MASK,
len); len);
} }
...@@ -1419,7 +1423,7 @@ static int rtl8366rb_max_mtu(struct dsa_switch *ds, int port) ...@@ -1419,7 +1423,7 @@ static int rtl8366rb_max_mtu(struct dsa_switch *ds, int port)
return 15996; return 15996;
} }
static int rtl8366rb_get_vlan_4k(struct realtek_smi *smi, u32 vid, static int rtl8366rb_get_vlan_4k(struct realtek_priv *priv, u32 vid,
struct rtl8366_vlan_4k *vlan4k) struct rtl8366_vlan_4k *vlan4k)
{ {
u32 data[3]; u32 data[3];
...@@ -1432,19 +1436,19 @@ static int rtl8366rb_get_vlan_4k(struct realtek_smi *smi, u32 vid, ...@@ -1432,19 +1436,19 @@ static int rtl8366rb_get_vlan_4k(struct realtek_smi *smi, u32 vid,
return -EINVAL; return -EINVAL;
/* write VID */ /* write VID */
ret = regmap_write(smi->map, RTL8366RB_VLAN_TABLE_WRITE_BASE, ret = regmap_write(priv->map, RTL8366RB_VLAN_TABLE_WRITE_BASE,
vid & RTL8366RB_VLAN_VID_MASK); vid & RTL8366RB_VLAN_VID_MASK);
if (ret) if (ret)
return ret; return ret;
/* write table access control word */ /* write table access control word */
ret = regmap_write(smi->map, RTL8366RB_TABLE_ACCESS_CTRL_REG, ret = regmap_write(priv->map, RTL8366RB_TABLE_ACCESS_CTRL_REG,
RTL8366RB_TABLE_VLAN_READ_CTRL); RTL8366RB_TABLE_VLAN_READ_CTRL);
if (ret) if (ret)
return ret; return ret;
for (i = 0; i < 3; i++) { for (i = 0; i < 3; i++) {
ret = regmap_read(smi->map, ret = regmap_read(priv->map,
RTL8366RB_VLAN_TABLE_READ_BASE + i, RTL8366RB_VLAN_TABLE_READ_BASE + i,
&data[i]); &data[i]);
if (ret) if (ret)
...@@ -1460,7 +1464,7 @@ static int rtl8366rb_get_vlan_4k(struct realtek_smi *smi, u32 vid, ...@@ -1460,7 +1464,7 @@ static int rtl8366rb_get_vlan_4k(struct realtek_smi *smi, u32 vid,
return 0; return 0;
} }
static int rtl8366rb_set_vlan_4k(struct realtek_smi *smi, static int rtl8366rb_set_vlan_4k(struct realtek_priv *priv,
const struct rtl8366_vlan_4k *vlan4k) const struct rtl8366_vlan_4k *vlan4k)
{ {
u32 data[3]; u32 data[3];
...@@ -1480,7 +1484,7 @@ static int rtl8366rb_set_vlan_4k(struct realtek_smi *smi, ...@@ -1480,7 +1484,7 @@ static int rtl8366rb_set_vlan_4k(struct realtek_smi *smi,
data[2] = vlan4k->fid & RTL8366RB_VLAN_FID_MASK; data[2] = vlan4k->fid & RTL8366RB_VLAN_FID_MASK;
for (i = 0; i < 3; i++) { for (i = 0; i < 3; i++) {
ret = regmap_write(smi->map, ret = regmap_write(priv->map,
RTL8366RB_VLAN_TABLE_WRITE_BASE + i, RTL8366RB_VLAN_TABLE_WRITE_BASE + i,
data[i]); data[i]);
if (ret) if (ret)
...@@ -1488,13 +1492,13 @@ static int rtl8366rb_set_vlan_4k(struct realtek_smi *smi, ...@@ -1488,13 +1492,13 @@ static int rtl8366rb_set_vlan_4k(struct realtek_smi *smi,
} }
/* write table access control word */ /* write table access control word */
ret = regmap_write(smi->map, RTL8366RB_TABLE_ACCESS_CTRL_REG, ret = regmap_write(priv->map, RTL8366RB_TABLE_ACCESS_CTRL_REG,
RTL8366RB_TABLE_VLAN_WRITE_CTRL); RTL8366RB_TABLE_VLAN_WRITE_CTRL);
return ret; return ret;
} }
static int rtl8366rb_get_vlan_mc(struct realtek_smi *smi, u32 index, static int rtl8366rb_get_vlan_mc(struct realtek_priv *priv, u32 index,
struct rtl8366_vlan_mc *vlanmc) struct rtl8366_vlan_mc *vlanmc)
{ {
u32 data[3]; u32 data[3];
...@@ -1507,7 +1511,7 @@ static int rtl8366rb_get_vlan_mc(struct realtek_smi *smi, u32 index, ...@@ -1507,7 +1511,7 @@ static int rtl8366rb_get_vlan_mc(struct realtek_smi *smi, u32 index,
return -EINVAL; return -EINVAL;
for (i = 0; i < 3; i++) { for (i = 0; i < 3; i++) {
ret = regmap_read(smi->map, ret = regmap_read(priv->map,
RTL8366RB_VLAN_MC_BASE(index) + i, RTL8366RB_VLAN_MC_BASE(index) + i,
&data[i]); &data[i]);
if (ret) if (ret)
...@@ -1525,7 +1529,7 @@ static int rtl8366rb_get_vlan_mc(struct realtek_smi *smi, u32 index, ...@@ -1525,7 +1529,7 @@ static int rtl8366rb_get_vlan_mc(struct realtek_smi *smi, u32 index,
return 0; return 0;
} }
static int rtl8366rb_set_vlan_mc(struct realtek_smi *smi, u32 index, static int rtl8366rb_set_vlan_mc(struct realtek_priv *priv, u32 index,
const struct rtl8366_vlan_mc *vlanmc) const struct rtl8366_vlan_mc *vlanmc)
{ {
u32 data[3]; u32 data[3];
...@@ -1549,7 +1553,7 @@ static int rtl8366rb_set_vlan_mc(struct realtek_smi *smi, u32 index, ...@@ -1549,7 +1553,7 @@ static int rtl8366rb_set_vlan_mc(struct realtek_smi *smi, u32 index,
data[2] = vlanmc->fid & RTL8366RB_VLAN_FID_MASK; data[2] = vlanmc->fid & RTL8366RB_VLAN_FID_MASK;
for (i = 0; i < 3; i++) { for (i = 0; i < 3; i++) {
ret = regmap_write(smi->map, ret = regmap_write(priv->map,
RTL8366RB_VLAN_MC_BASE(index) + i, RTL8366RB_VLAN_MC_BASE(index) + i,
data[i]); data[i]);
if (ret) if (ret)
...@@ -1559,15 +1563,15 @@ static int rtl8366rb_set_vlan_mc(struct realtek_smi *smi, u32 index, ...@@ -1559,15 +1563,15 @@ static int rtl8366rb_set_vlan_mc(struct realtek_smi *smi, u32 index,
return 0; return 0;
} }
static int rtl8366rb_get_mc_index(struct realtek_smi *smi, int port, int *val) static int rtl8366rb_get_mc_index(struct realtek_priv *priv, int port, int *val)
{ {
u32 data; u32 data;
int ret; int ret;
if (port >= smi->num_ports) if (port >= priv->num_ports)
return -EINVAL; return -EINVAL;
ret = regmap_read(smi->map, RTL8366RB_PORT_VLAN_CTRL_REG(port), ret = regmap_read(priv->map, RTL8366RB_PORT_VLAN_CTRL_REG(port),
&data); &data);
if (ret) if (ret)
return ret; return ret;
...@@ -1578,22 +1582,22 @@ static int rtl8366rb_get_mc_index(struct realtek_smi *smi, int port, int *val) ...@@ -1578,22 +1582,22 @@ static int rtl8366rb_get_mc_index(struct realtek_smi *smi, int port, int *val)
return 0; return 0;
} }
static int rtl8366rb_set_mc_index(struct realtek_smi *smi, int port, int index) static int rtl8366rb_set_mc_index(struct realtek_priv *priv, int port, int index)
{ {
struct rtl8366rb *rb; struct rtl8366rb *rb;
bool pvid_enabled; bool pvid_enabled;
int ret; int ret;
rb = smi->chip_data; rb = priv->chip_data;
pvid_enabled = !!index; pvid_enabled = !!index;
if (port >= smi->num_ports || index >= RTL8366RB_NUM_VLANS) if (port >= priv->num_ports || index >= RTL8366RB_NUM_VLANS)
return -EINVAL; return -EINVAL;
ret = regmap_update_bits(smi->map, RTL8366RB_PORT_VLAN_CTRL_REG(port), ret = regmap_update_bits(priv->map, RTL8366RB_PORT_VLAN_CTRL_REG(port),
RTL8366RB_PORT_VLAN_CTRL_MASK << RTL8366RB_PORT_VLAN_CTRL_MASK <<
RTL8366RB_PORT_VLAN_CTRL_SHIFT(port), RTL8366RB_PORT_VLAN_CTRL_SHIFT(port),
(index & RTL8366RB_PORT_VLAN_CTRL_MASK) << (index & RTL8366RB_PORT_VLAN_CTRL_MASK) <<
RTL8366RB_PORT_VLAN_CTRL_SHIFT(port)); RTL8366RB_PORT_VLAN_CTRL_SHIFT(port));
if (ret) if (ret)
return ret; return ret;
...@@ -1604,17 +1608,17 @@ static int rtl8366rb_set_mc_index(struct realtek_smi *smi, int port, int index) ...@@ -1604,17 +1608,17 @@ static int rtl8366rb_set_mc_index(struct realtek_smi *smi, int port, int index)
* not drop any untagged or C-tagged frames. Make sure to update the * not drop any untagged or C-tagged frames. Make sure to update the
* filtering setting. * filtering setting.
*/ */
if (dsa_port_is_vlan_filtering(dsa_to_port(smi->ds, port))) if (dsa_port_is_vlan_filtering(dsa_to_port(priv->ds, port)))
ret = rtl8366rb_drop_untagged(smi, port, !pvid_enabled); ret = rtl8366rb_drop_untagged(priv, port, !pvid_enabled);
return ret; return ret;
} }
static bool rtl8366rb_is_vlan_valid(struct realtek_smi *smi, unsigned int vlan) static bool rtl8366rb_is_vlan_valid(struct realtek_priv *priv, unsigned int vlan)
{ {
unsigned int max = RTL8366RB_NUM_VLANS - 1; unsigned int max = RTL8366RB_NUM_VLANS - 1;
if (smi->vlan4k_enabled) if (priv->vlan4k_enabled)
max = RTL8366RB_NUM_VIDS - 1; max = RTL8366RB_NUM_VIDS - 1;
if (vlan > max) if (vlan > max)
...@@ -1623,23 +1627,23 @@ static bool rtl8366rb_is_vlan_valid(struct realtek_smi *smi, unsigned int vlan) ...@@ -1623,23 +1627,23 @@ static bool rtl8366rb_is_vlan_valid(struct realtek_smi *smi, unsigned int vlan)
return true; return true;
} }
static int rtl8366rb_enable_vlan(struct realtek_smi *smi, bool enable) static int rtl8366rb_enable_vlan(struct realtek_priv *priv, bool enable)
{ {
dev_dbg(smi->dev, "%s VLAN\n", enable ? "enable" : "disable"); dev_dbg(priv->dev, "%s VLAN\n", enable ? "enable" : "disable");
return regmap_update_bits(smi->map, return regmap_update_bits(priv->map,
RTL8366RB_SGCR, RTL8366RB_SGCR_EN_VLAN, RTL8366RB_SGCR, RTL8366RB_SGCR_EN_VLAN,
enable ? RTL8366RB_SGCR_EN_VLAN : 0); enable ? RTL8366RB_SGCR_EN_VLAN : 0);
} }
static int rtl8366rb_enable_vlan4k(struct realtek_smi *smi, bool enable) static int rtl8366rb_enable_vlan4k(struct realtek_priv *priv, bool enable)
{ {
dev_dbg(smi->dev, "%s VLAN 4k\n", enable ? "enable" : "disable"); dev_dbg(priv->dev, "%s VLAN 4k\n", enable ? "enable" : "disable");
return regmap_update_bits(smi->map, RTL8366RB_SGCR, return regmap_update_bits(priv->map, RTL8366RB_SGCR,
RTL8366RB_SGCR_EN_VLAN_4KTB, RTL8366RB_SGCR_EN_VLAN_4KTB,
enable ? RTL8366RB_SGCR_EN_VLAN_4KTB : 0); enable ? RTL8366RB_SGCR_EN_VLAN_4KTB : 0);
} }
static int rtl8366rb_phy_read(struct realtek_smi *smi, int phy, int regnum) static int rtl8366rb_phy_read(struct realtek_priv *priv, int phy, int regnum)
{ {
u32 val; u32 val;
u32 reg; u32 reg;
...@@ -1648,32 +1652,32 @@ static int rtl8366rb_phy_read(struct realtek_smi *smi, int phy, int regnum) ...@@ -1648,32 +1652,32 @@ static int rtl8366rb_phy_read(struct realtek_smi *smi, int phy, int regnum)
if (phy > RTL8366RB_PHY_NO_MAX) if (phy > RTL8366RB_PHY_NO_MAX)
return -EINVAL; return -EINVAL;
ret = regmap_write(smi->map, RTL8366RB_PHY_ACCESS_CTRL_REG, ret = regmap_write(priv->map, RTL8366RB_PHY_ACCESS_CTRL_REG,
RTL8366RB_PHY_CTRL_READ); RTL8366RB_PHY_CTRL_READ);
if (ret) if (ret)
return ret; return ret;
reg = 0x8000 | (1 << (phy + RTL8366RB_PHY_NO_OFFSET)) | regnum; reg = 0x8000 | (1 << (phy + RTL8366RB_PHY_NO_OFFSET)) | regnum;
ret = regmap_write(smi->map, reg, 0); ret = regmap_write(priv->map, reg, 0);
if (ret) { if (ret) {
dev_err(smi->dev, dev_err(priv->dev,
"failed to write PHY%d reg %04x @ %04x, ret %d\n", "failed to write PHY%d reg %04x @ %04x, ret %d\n",
phy, regnum, reg, ret); phy, regnum, reg, ret);
return ret; return ret;
} }
ret = regmap_read(smi->map, RTL8366RB_PHY_ACCESS_DATA_REG, &val); ret = regmap_read(priv->map, RTL8366RB_PHY_ACCESS_DATA_REG, &val);
if (ret) if (ret)
return ret; return ret;
dev_dbg(smi->dev, "read PHY%d register 0x%04x @ %08x, val <- %04x\n", dev_dbg(priv->dev, "read PHY%d register 0x%04x @ %08x, val <- %04x\n",
phy, regnum, reg, val); phy, regnum, reg, val);
return val; return val;
} }
static int rtl8366rb_phy_write(struct realtek_smi *smi, int phy, int regnum, static int rtl8366rb_phy_write(struct realtek_priv *priv, int phy, int regnum,
u16 val) u16 val)
{ {
u32 reg; u32 reg;
...@@ -1682,34 +1686,45 @@ static int rtl8366rb_phy_write(struct realtek_smi *smi, int phy, int regnum, ...@@ -1682,34 +1686,45 @@ static int rtl8366rb_phy_write(struct realtek_smi *smi, int phy, int regnum,
if (phy > RTL8366RB_PHY_NO_MAX) if (phy > RTL8366RB_PHY_NO_MAX)
return -EINVAL; return -EINVAL;
ret = regmap_write(smi->map, RTL8366RB_PHY_ACCESS_CTRL_REG, ret = regmap_write(priv->map, RTL8366RB_PHY_ACCESS_CTRL_REG,
RTL8366RB_PHY_CTRL_WRITE); RTL8366RB_PHY_CTRL_WRITE);
if (ret) if (ret)
return ret; return ret;
reg = 0x8000 | (1 << (phy + RTL8366RB_PHY_NO_OFFSET)) | regnum; reg = 0x8000 | (1 << (phy + RTL8366RB_PHY_NO_OFFSET)) | regnum;
dev_dbg(smi->dev, "write PHY%d register 0x%04x @ %04x, val -> %04x\n", dev_dbg(priv->dev, "write PHY%d register 0x%04x @ %04x, val -> %04x\n",
phy, regnum, reg, val); phy, regnum, reg, val);
ret = regmap_write(smi->map, reg, val); ret = regmap_write(priv->map, reg, val);
if (ret) if (ret)
return ret; return ret;
return 0; return 0;
} }
static int rtl8366rb_reset_chip(struct realtek_smi *smi) static int rtl8366rb_dsa_phy_read(struct dsa_switch *ds, int phy, int regnum)
{
return rtl8366rb_phy_read(ds->priv, phy, regnum);
}
static int rtl8366rb_dsa_phy_write(struct dsa_switch *ds, int phy, int regnum,
u16 val)
{
return rtl8366rb_phy_write(ds->priv, phy, regnum, val);
}
static int rtl8366rb_reset_chip(struct realtek_priv *priv)
{ {
int timeout = 10; int timeout = 10;
u32 val; u32 val;
int ret; int ret;
realtek_smi_write_reg_noack(smi, RTL8366RB_RESET_CTRL_REG, priv->write_reg_noack(priv, RTL8366RB_RESET_CTRL_REG,
RTL8366RB_CHIP_CTRL_RESET_HW); RTL8366RB_CHIP_CTRL_RESET_HW);
do { do {
usleep_range(20000, 25000); usleep_range(20000, 25000);
ret = regmap_read(smi->map, RTL8366RB_RESET_CTRL_REG, &val); ret = regmap_read(priv->map, RTL8366RB_RESET_CTRL_REG, &val);
if (ret) if (ret)
return ret; return ret;
...@@ -1718,21 +1733,21 @@ static int rtl8366rb_reset_chip(struct realtek_smi *smi) ...@@ -1718,21 +1733,21 @@ static int rtl8366rb_reset_chip(struct realtek_smi *smi)
} while (--timeout); } while (--timeout);
if (!timeout) { if (!timeout) {
dev_err(smi->dev, "timeout waiting for the switch to reset\n"); dev_err(priv->dev, "timeout waiting for the switch to reset\n");
return -EIO; return -EIO;
} }
return 0; return 0;
} }
static int rtl8366rb_detect(struct realtek_smi *smi) static int rtl8366rb_detect(struct realtek_priv *priv)
{ {
struct device *dev = smi->dev; struct device *dev = priv->dev;
int ret; int ret;
u32 val; u32 val;
/* Detect device */ /* Detect device */
ret = regmap_read(smi->map, 0x5c, &val); ret = regmap_read(priv->map, 0x5c, &val);
if (ret) { if (ret) {
dev_err(dev, "can't get chip ID (%d)\n", ret); dev_err(dev, "can't get chip ID (%d)\n", ret);
return ret; return ret;
...@@ -1745,11 +1760,11 @@ static int rtl8366rb_detect(struct realtek_smi *smi) ...@@ -1745,11 +1760,11 @@ static int rtl8366rb_detect(struct realtek_smi *smi)
return -ENODEV; return -ENODEV;
case 0x5937: case 0x5937:
dev_info(dev, "found an RTL8366RB switch\n"); dev_info(dev, "found an RTL8366RB switch\n");
smi->cpu_port = RTL8366RB_PORT_NUM_CPU; priv->cpu_port = RTL8366RB_PORT_NUM_CPU;
smi->num_ports = RTL8366RB_NUM_PORTS; priv->num_ports = RTL8366RB_NUM_PORTS;
smi->num_vlan_mc = RTL8366RB_NUM_VLANS; priv->num_vlan_mc = RTL8366RB_NUM_VLANS;
smi->mib_counters = rtl8366rb_mib_counters; priv->mib_counters = rtl8366rb_mib_counters;
smi->num_mib_counters = ARRAY_SIZE(rtl8366rb_mib_counters); priv->num_mib_counters = ARRAY_SIZE(rtl8366rb_mib_counters);
break; break;
default: default:
dev_info(dev, "found an Unknown Realtek switch (id=0x%04x)\n", dev_info(dev, "found an Unknown Realtek switch (id=0x%04x)\n",
...@@ -1757,14 +1772,14 @@ static int rtl8366rb_detect(struct realtek_smi *smi) ...@@ -1757,14 +1772,14 @@ static int rtl8366rb_detect(struct realtek_smi *smi)
break; break;
} }
ret = rtl8366rb_reset_chip(smi); ret = rtl8366rb_reset_chip(priv);
if (ret) if (ret)
return ret; return ret;
return 0; return 0;
} }
static const struct dsa_switch_ops rtl8366rb_switch_ops = { static const struct dsa_switch_ops rtl8366rb_switch_ops_smi = {
.get_tag_protocol = rtl8366_get_tag_protocol, .get_tag_protocol = rtl8366_get_tag_protocol,
.setup = rtl8366rb_setup, .setup = rtl8366rb_setup,
.phylink_mac_link_up = rtl8366rb_mac_link_up, .phylink_mac_link_up = rtl8366rb_mac_link_up,
...@@ -1787,7 +1802,32 @@ static const struct dsa_switch_ops rtl8366rb_switch_ops = { ...@@ -1787,7 +1802,32 @@ static const struct dsa_switch_ops rtl8366rb_switch_ops = {
.port_max_mtu = rtl8366rb_max_mtu, .port_max_mtu = rtl8366rb_max_mtu,
}; };
static const struct realtek_smi_ops rtl8366rb_smi_ops = { static const struct dsa_switch_ops rtl8366rb_switch_ops_mdio = {
.get_tag_protocol = rtl8366_get_tag_protocol,
.setup = rtl8366rb_setup,
.phy_read = rtl8366rb_dsa_phy_read,
.phy_write = rtl8366rb_dsa_phy_write,
.phylink_mac_link_up = rtl8366rb_mac_link_up,
.phylink_mac_link_down = rtl8366rb_mac_link_down,
.get_strings = rtl8366_get_strings,
.get_ethtool_stats = rtl8366_get_ethtool_stats,
.get_sset_count = rtl8366_get_sset_count,
.port_bridge_join = rtl8366rb_port_bridge_join,
.port_bridge_leave = rtl8366rb_port_bridge_leave,
.port_vlan_filtering = rtl8366rb_vlan_filtering,
.port_vlan_add = rtl8366_vlan_add,
.port_vlan_del = rtl8366_vlan_del,
.port_enable = rtl8366rb_port_enable,
.port_disable = rtl8366rb_port_disable,
.port_pre_bridge_flags = rtl8366rb_port_pre_bridge_flags,
.port_bridge_flags = rtl8366rb_port_bridge_flags,
.port_stp_state_set = rtl8366rb_port_stp_state_set,
.port_fast_age = rtl8366rb_port_fast_age,
.port_change_mtu = rtl8366rb_change_mtu,
.port_max_mtu = rtl8366rb_max_mtu,
};
static const struct realtek_ops rtl8366rb_ops = {
.detect = rtl8366rb_detect, .detect = rtl8366rb_detect,
.get_vlan_mc = rtl8366rb_get_vlan_mc, .get_vlan_mc = rtl8366rb_get_vlan_mc,
.set_vlan_mc = rtl8366rb_set_vlan_mc, .set_vlan_mc = rtl8366rb_set_vlan_mc,
...@@ -1803,12 +1843,17 @@ static const struct realtek_smi_ops rtl8366rb_smi_ops = { ...@@ -1803,12 +1843,17 @@ static const struct realtek_smi_ops rtl8366rb_smi_ops = {
.phy_write = rtl8366rb_phy_write, .phy_write = rtl8366rb_phy_write,
}; };
const struct realtek_smi_variant rtl8366rb_variant = { const struct realtek_variant rtl8366rb_variant = {
.ds_ops = &rtl8366rb_switch_ops, .ds_ops_smi = &rtl8366rb_switch_ops_smi,
.ops = &rtl8366rb_smi_ops, .ds_ops_mdio = &rtl8366rb_switch_ops_mdio,
.ops = &rtl8366rb_ops,
.clk_delay = 10, .clk_delay = 10,
.cmd_read = 0xa9, .cmd_read = 0xa9,
.cmd_write = 0xa8, .cmd_write = 0xa8,
.chip_data_sz = sizeof(struct rtl8366rb), .chip_data_sz = sizeof(struct rtl8366rb),
}; };
EXPORT_SYMBOL_GPL(rtl8366rb_variant); EXPORT_SYMBOL_GPL(rtl8366rb_variant);
MODULE_AUTHOR("Linus Walleij <linus.walleij@linaro.org>");
MODULE_DESCRIPTION("Driver for RTL8366RB ethernet switch");
MODULE_LICENSE("GPL");
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册
反馈
建议
客服 返回
顶部