// SPDX-License-Identifier: GPL-2.0 /* Realtek SMI library helpers for the RTL8366x variants * RTL8366RB and RTL8366S * * Copyright (C) 2017 Linus Walleij * Copyright (C) 2009-2010 Gabor Juhos * Copyright (C) 2010 Antti Seppälä * Copyright (C) 2010 Roman Yeryomin * Copyright (C) 2011 Colin Leitner */ #include #include #include "realtek.h" int rtl8366_mc_is_used(struct realtek_priv *priv, int mc_index, int *used) { int ret; int i; *used = 0; for (i = 0; i < priv->num_ports; i++) { int index = 0; ret = priv->ops->get_mc_index(priv, i, &index); if (ret) return ret; if (mc_index == index) { *used = 1; break; } } return 0; } EXPORT_SYMBOL_NS_GPL(rtl8366_mc_is_used, "REALTEK_DSA"); /** * rtl8366_obtain_mc() - retrieve or allocate a VLAN member configuration * @priv: the Realtek SMI device instance * @vid: the VLAN ID to look up or allocate * @vlanmc: the pointer will be assigned to a pointer to a valid member config * if successful * @return: index of a new member config or negative error number */ static int rtl8366_obtain_mc(struct realtek_priv *priv, int vid, struct rtl8366_vlan_mc *vlanmc) { struct rtl8366_vlan_4k vlan4k; int ret; int i; /* Try to find an existing member config entry for this VID */ for (i = 0; i < priv->num_vlan_mc; i++) { ret = priv->ops->get_vlan_mc(priv, i, vlanmc); if (ret) { dev_err(priv->dev, "error searching for VLAN MC %d for VID %d\n", i, vid); return ret; } if (vid == vlanmc->vid) return i; } /* We have no MC entry for this VID, try to find an empty one */ for (i = 0; i < priv->num_vlan_mc; i++) { ret = priv->ops->get_vlan_mc(priv, i, vlanmc); if (ret) { dev_err(priv->dev, "error searching for VLAN MC %d for VID %d\n", i, vid); return ret; } if (vlanmc->vid == 0 && vlanmc->member == 0) { /* Update the entry from the 4K table */ ret = priv->ops->get_vlan_4k(priv, vid, &vlan4k); if (ret) { dev_err(priv->dev, "error looking for 4K VLAN MC %d for VID %d\n", i, vid); return ret; } vlanmc->vid = vid; vlanmc->member = vlan4k.member; vlanmc->untag = vlan4k.untag; vlanmc->fid = vlan4k.fid; ret = priv->ops->set_vlan_mc(priv, i, vlanmc); if (ret) { dev_err(priv->dev, "unable to set/update VLAN MC %d for VID %d\n", i, vid); return ret; } dev_dbg(priv->dev, "created new MC at index %d for VID %d\n", i, vid); return i; } } /* MC table is full, try to find an unused entry and replace it */ for (i = 0; i < priv->num_vlan_mc; i++) { int used; ret = rtl8366_mc_is_used(priv, i, &used); if (ret) return ret; if (!used) { /* Update the entry from the 4K table */ ret = priv->ops->get_vlan_4k(priv, vid, &vlan4k); if (ret) return ret; vlanmc->vid = vid; vlanmc->member = vlan4k.member; vlanmc->untag = vlan4k.untag; vlanmc->fid = vlan4k.fid; ret = priv->ops->set_vlan_mc(priv, i, vlanmc); if (ret) { dev_err(priv->dev, "unable to set/update VLAN MC %d for VID %d\n", i, vid); return ret; } dev_dbg(priv->dev, "recycled MC at index %i for VID %d\n", i, vid); return i; } } dev_err(priv->dev, "all VLAN member configurations are in use\n"); return -ENOSPC; } int rtl8366_set_vlan(struct realtek_priv *priv, int vid, u32 member, u32 untag, u32 fid) { struct rtl8366_vlan_mc vlanmc; struct rtl8366_vlan_4k vlan4k; int mc; int ret; if (!priv->ops->is_vlan_valid(priv, vid)) return -EINVAL; dev_dbg(priv->dev, "setting VLAN%d 4k members: 0x%02x, untagged: 0x%02x\n", vid, member, untag); /* Update the 4K table */ ret = priv->ops->get_vlan_4k(priv, vid, &vlan4k); if (ret) return ret; vlan4k.member |= member; vlan4k.untag |= untag; vlan4k.fid = fid; ret = priv->ops->set_vlan_4k(priv, &vlan4k); if (ret) return ret; dev_dbg(priv->dev, "resulting VLAN%d 4k members: 0x%02x, untagged: 0x%02x\n", vid, vlan4k.member, vlan4k.untag); /* Find or allocate a member config for this VID */ ret = rtl8366_obtain_mc(priv, vid, &vlanmc); if (ret < 0) return ret; mc = ret; /* Update the MC entry */ vlanmc.member |= member; vlanmc.untag |= untag; vlanmc.fid = fid; /* Commit updates to the MC entry */ ret = priv->ops->set_vlan_mc(priv, mc, &vlanmc); if (ret) dev_err(priv->dev, "failed to commit changes to VLAN MC index %d for VID %d\n", mc, vid); else dev_dbg(priv->dev, "resulting VLAN%d MC members: 0x%02x, untagged: 0x%02x\n", vid, vlanmc.member, vlanmc.untag); return ret; } EXPORT_SYMBOL_NS_GPL(rtl8366_set_vlan, "REALTEK_DSA"); int rtl8366_set_pvid(struct realtek_priv *priv, unsigned int port, unsigned int vid) { struct rtl8366_vlan_mc vlanmc; int mc; int ret; if (!priv->ops->is_vlan_valid(priv, vid)) return -EINVAL; /* Find or allocate a member config for this VID */ ret = rtl8366_obtain_mc(priv, vid, &vlanmc); if (ret < 0) return ret; mc = ret; ret = priv->ops->set_mc_index(priv, port, mc); if (ret) { dev_err(priv->dev, "set PVID: failed to set MC index %d for port %d\n", mc, port); return ret; } dev_dbg(priv->dev, "set PVID: the PVID for port %d set to %d using existing MC index %d\n", port, vid, mc); return 0; } EXPORT_SYMBOL_NS_GPL(rtl8366_set_pvid, "REALTEK_DSA"); int rtl8366_enable_vlan4k(struct realtek_priv *priv, bool enable) { int ret; /* To enable 4k VLAN, ordinary VLAN must be enabled first, * but if we disable 4k VLAN it is fine to leave ordinary * VLAN enabled. */ if (enable) { /* Make sure VLAN is ON */ ret = priv->ops->enable_vlan(priv, true); if (ret) return ret; priv->vlan_enabled = true; } ret = priv->ops->enable_vlan4k(priv, enable); if (ret) return ret; priv->vlan4k_enabled = enable; return 0; } EXPORT_SYMBOL_NS_GPL(rtl8366_enable_vlan4k, "REALTEK_DSA"); int rtl8366_enable_vlan(struct realtek_priv *priv, bool enable) { int ret; ret = priv->ops->enable_vlan(priv, enable); if (ret) return ret; priv->vlan_enabled = enable; /* If we turn VLAN off, make sure that we turn off * 4k VLAN as well, if that happened to be on. */ if (!enable) { priv->vlan4k_enabled = false; ret = priv->ops->enable_vlan4k(priv, false); } return ret; } EXPORT_SYMBOL_NS_GPL(rtl8366_enable_vlan, "REALTEK_DSA"); int rtl8366_reset_vlan(struct realtek_priv *priv) { struct rtl8366_vlan_mc vlanmc; int ret; int i; rtl8366_enable_vlan(priv, false); rtl8366_enable_vlan4k(priv, false); /* Clear the 16 VLAN member configurations */ vlanmc.vid = 0; vlanmc.priority = 0; vlanmc.member = 0; vlanmc.untag = 0; vlanmc.fid = 0; for (i = 0; i < priv->num_vlan_mc; i++) { ret = priv->ops->set_vlan_mc(priv, i, &vlanmc); if (ret) return ret; } return 0; } EXPORT_SYMBOL_NS_GPL(rtl8366_reset_vlan, "REALTEK_DSA"); int rtl8366_vlan_add(struct dsa_switch *ds, int port, const struct switchdev_obj_port_vlan *vlan, struct netlink_ext_ack *extack) { bool untagged = !!(vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED); bool pvid = !!(vlan->flags & BRIDGE_VLAN_INFO_PVID); struct realtek_priv *priv = ds->priv; u32 member = 0; u32 untag = 0; int ret; if (!priv->ops->is_vlan_valid(priv, vlan->vid)) { NL_SET_ERR_MSG_MOD(extack, "VLAN ID not valid"); return -EINVAL; } /* Enable VLAN in the hardware * FIXME: what's with this 4k business? * Just rtl8366_enable_vlan() seems inconclusive. */ ret = rtl8366_enable_vlan4k(priv, true); if (ret) { NL_SET_ERR_MSG_MOD(extack, "Failed to enable VLAN 4K"); return ret; } dev_dbg(priv->dev, "add VLAN %d on port %d, %s, %s\n", vlan->vid, port, untagged ? "untagged" : "tagged", pvid ? "PVID" : "no PVID"); member |= BIT(port); if (untagged) untag |= BIT(port); ret = rtl8366_set_vlan(priv, vlan->vid, member, untag, 0); if (ret) { dev_err(priv->dev, "failed to set up VLAN %04x", vlan->vid); return ret; } if (!pvid) return 0; ret = rtl8366_set_pvid(priv, port, vlan->vid); if (ret) { dev_err(priv->dev, "failed to set PVID on port %d to VLAN %04x", port, vlan->vid); return ret; } return 0; } EXPORT_SYMBOL_NS_GPL(rtl8366_vlan_add, "REALTEK_DSA"); int rtl8366_vlan_del(struct dsa_switch *ds, int port, const struct switchdev_obj_port_vlan *vlan) { struct realtek_priv *priv = ds->priv; int ret, i; dev_dbg(priv->dev, "del VLAN %d on port %d\n", vlan->vid, port); for (i = 0; i < priv->num_vlan_mc; i++) { struct rtl8366_vlan_mc vlanmc; ret = priv->ops->get_vlan_mc(priv, i, &vlanmc); if (ret) return ret; if (vlan->vid == vlanmc.vid) { /* Remove this port from the VLAN */ vlanmc.member &= ~BIT(port); vlanmc.untag &= ~BIT(port); /* * If no ports are members of this VLAN * anymore then clear the whole member * config so it can be reused. */ if (!vlanmc.member) { vlanmc.vid = 0; vlanmc.priority = 0; vlanmc.fid = 0; } ret = priv->ops->set_vlan_mc(priv, i, &vlanmc); if (ret) { dev_err(priv->dev, "failed to remove VLAN %04x\n", vlan->vid); return ret; } break; } } return 0; } EXPORT_SYMBOL_NS_GPL(rtl8366_vlan_del, "REALTEK_DSA"); void rtl8366_get_strings(struct dsa_switch *ds, int port, u32 stringset, uint8_t *data) { struct realtek_priv *priv = ds->priv; int i; if (port >= priv->num_ports) return; for (i = 0; i < priv->num_mib_counters; i++) ethtool_puts(&data, priv->mib_counters[i].name); } EXPORT_SYMBOL_NS_GPL(rtl8366_get_strings, "REALTEK_DSA"); int rtl8366_get_sset_count(struct dsa_switch *ds, int port, int sset) { struct realtek_priv *priv = ds->priv; /* We only support SS_STATS */ if (sset != ETH_SS_STATS) return 0; if (port >= priv->num_ports) return -EINVAL; return priv->num_mib_counters; } EXPORT_SYMBOL_NS_GPL(rtl8366_get_sset_count, "REALTEK_DSA"); void rtl8366_get_ethtool_stats(struct dsa_switch *ds, int port, uint64_t *data) { struct realtek_priv *priv = ds->priv; int i; int ret; if (port >= priv->num_ports) return; for (i = 0; i < priv->num_mib_counters; i++) { struct rtl8366_mib_counter *mib; u64 mibvalue = 0; mib = &priv->mib_counters[i]; ret = priv->ops->get_mib_counter(priv, port, mib, &mibvalue); if (ret) { dev_err(priv->dev, "error reading MIB counter %s\n", mib->name); } data[i] = mibvalue; } } EXPORT_SYMBOL_NS_GPL(rtl8366_get_ethtool_stats, "REALTEK_DSA");