156051948SVladimir Oltean // SPDX-License-Identifier: GPL-2.0 256051948SVladimir Oltean /* Copyright 2019 NXP Semiconductors 3375e1314SVladimir Oltean * 4375e1314SVladimir Oltean * This is an umbrella module for all network switches that are 5375e1314SVladimir Oltean * register-compatible with Ocelot and that perform I/O to their host CPU 6375e1314SVladimir Oltean * through an NPI (Node Processor Interface) Ethernet port. 756051948SVladimir Oltean */ 856051948SVladimir Oltean #include <uapi/linux/if_bridge.h> 907d985eeSVladimir Oltean #include <soc/mscc/ocelot_vcap.h> 10bdeced75SVladimir Oltean #include <soc/mscc/ocelot_qsys.h> 11bdeced75SVladimir Oltean #include <soc/mscc/ocelot_sys.h> 12bdeced75SVladimir Oltean #include <soc/mscc/ocelot_dev.h> 13bdeced75SVladimir Oltean #include <soc/mscc/ocelot_ana.h> 142b49d128SYangbo Lu #include <soc/mscc/ocelot_ptp.h> 1556051948SVladimir Oltean #include <soc/mscc/ocelot.h> 1684705fc1SMaxim Kochetkov #include <linux/platform_device.h> 17c0bcf537SYangbo Lu #include <linux/packing.h> 1856051948SVladimir Oltean #include <linux/module.h> 19bdeced75SVladimir Oltean #include <linux/of_net.h> 2056051948SVladimir Oltean #include <linux/pci.h> 2156051948SVladimir Oltean #include <linux/of.h> 22588d0550SIoana Ciornei #include <linux/pcs-lynx.h> 23fc411eaaSVladimir Oltean #include <net/pkt_sched.h> 2456051948SVladimir Oltean #include <net/dsa.h> 2556051948SVladimir Oltean #include "felix.h" 2656051948SVladimir Oltean 2756051948SVladimir Oltean static enum dsa_tag_protocol felix_get_tag_protocol(struct dsa_switch *ds, 284d776482SFlorian Fainelli int port, 294d776482SFlorian Fainelli enum dsa_tag_protocol mp) 3056051948SVladimir Oltean { 3156051948SVladimir Oltean return DSA_TAG_PROTO_OCELOT; 3256051948SVladimir Oltean } 3356051948SVladimir Oltean 3456051948SVladimir Oltean static int felix_set_ageing_time(struct dsa_switch *ds, 3556051948SVladimir Oltean unsigned int ageing_time) 3656051948SVladimir Oltean { 3756051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 3856051948SVladimir Oltean 3956051948SVladimir Oltean ocelot_set_ageing_time(ocelot, ageing_time); 4056051948SVladimir Oltean 4156051948SVladimir Oltean return 0; 4256051948SVladimir Oltean } 4356051948SVladimir Oltean 4456051948SVladimir Oltean static int felix_fdb_dump(struct dsa_switch *ds, int port, 4556051948SVladimir Oltean dsa_fdb_dump_cb_t *cb, void *data) 4656051948SVladimir Oltean { 4756051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 4856051948SVladimir Oltean 4956051948SVladimir Oltean return ocelot_fdb_dump(ocelot, port, cb, data); 5056051948SVladimir Oltean } 5156051948SVladimir Oltean 5256051948SVladimir Oltean static int felix_fdb_add(struct dsa_switch *ds, int port, 5356051948SVladimir Oltean const unsigned char *addr, u16 vid) 5456051948SVladimir Oltean { 5556051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 5656051948SVladimir Oltean 5787b0f983SVladimir Oltean return ocelot_fdb_add(ocelot, port, addr, vid); 5856051948SVladimir Oltean } 5956051948SVladimir Oltean 6056051948SVladimir Oltean static int felix_fdb_del(struct dsa_switch *ds, int port, 6156051948SVladimir Oltean const unsigned char *addr, u16 vid) 6256051948SVladimir Oltean { 6356051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 6456051948SVladimir Oltean 6556051948SVladimir Oltean return ocelot_fdb_del(ocelot, port, addr, vid); 6656051948SVladimir Oltean } 6756051948SVladimir Oltean 68209edf95SVladimir Oltean /* This callback needs to be present */ 69209edf95SVladimir Oltean static int felix_mdb_prepare(struct dsa_switch *ds, int port, 70209edf95SVladimir Oltean const struct switchdev_obj_port_mdb *mdb) 71209edf95SVladimir Oltean { 72209edf95SVladimir Oltean return 0; 73209edf95SVladimir Oltean } 74209edf95SVladimir Oltean 75209edf95SVladimir Oltean static void felix_mdb_add(struct dsa_switch *ds, int port, 76209edf95SVladimir Oltean const struct switchdev_obj_port_mdb *mdb) 77209edf95SVladimir Oltean { 78209edf95SVladimir Oltean struct ocelot *ocelot = ds->priv; 79209edf95SVladimir Oltean 80209edf95SVladimir Oltean ocelot_port_mdb_add(ocelot, port, mdb); 81209edf95SVladimir Oltean } 82209edf95SVladimir Oltean 83209edf95SVladimir Oltean static int felix_mdb_del(struct dsa_switch *ds, int port, 84209edf95SVladimir Oltean const struct switchdev_obj_port_mdb *mdb) 85209edf95SVladimir Oltean { 86209edf95SVladimir Oltean struct ocelot *ocelot = ds->priv; 87209edf95SVladimir Oltean 88209edf95SVladimir Oltean return ocelot_port_mdb_del(ocelot, port, mdb); 89209edf95SVladimir Oltean } 90209edf95SVladimir Oltean 9156051948SVladimir Oltean static void felix_bridge_stp_state_set(struct dsa_switch *ds, int port, 9256051948SVladimir Oltean u8 state) 9356051948SVladimir Oltean { 9456051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 9556051948SVladimir Oltean 9656051948SVladimir Oltean return ocelot_bridge_stp_state_set(ocelot, port, state); 9756051948SVladimir Oltean } 9856051948SVladimir Oltean 9956051948SVladimir Oltean static int felix_bridge_join(struct dsa_switch *ds, int port, 10056051948SVladimir Oltean struct net_device *br) 10156051948SVladimir Oltean { 10256051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 10356051948SVladimir Oltean 10456051948SVladimir Oltean return ocelot_port_bridge_join(ocelot, port, br); 10556051948SVladimir Oltean } 10656051948SVladimir Oltean 10756051948SVladimir Oltean static void felix_bridge_leave(struct dsa_switch *ds, int port, 10856051948SVladimir Oltean struct net_device *br) 10956051948SVladimir Oltean { 11056051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 11156051948SVladimir Oltean 11256051948SVladimir Oltean ocelot_port_bridge_leave(ocelot, port, br); 11356051948SVladimir Oltean } 11456051948SVladimir Oltean 11556051948SVladimir Oltean static int felix_vlan_prepare(struct dsa_switch *ds, int port, 11656051948SVladimir Oltean const struct switchdev_obj_port_vlan *vlan) 11756051948SVladimir Oltean { 1182f0402feSVladimir Oltean struct ocelot *ocelot = ds->priv; 119*b7a9e0daSVladimir Oltean u16 flags = vlan->flags; 1202f0402feSVladimir Oltean 1219a720680SVladimir Oltean /* Ocelot switches copy frames as-is to the CPU, so the flags: 1229a720680SVladimir Oltean * egress-untagged or not, pvid or not, make no difference. This 1239a720680SVladimir Oltean * behavior is already better than what DSA just tries to approximate 1249a720680SVladimir Oltean * when it installs the VLAN with the same flags on the CPU port. 1259a720680SVladimir Oltean * Just accept any configuration, and don't let ocelot deny installing 1269a720680SVladimir Oltean * multiple native VLANs on the NPI port, because the switch doesn't 1279a720680SVladimir Oltean * look at the port tag settings towards the NPI interface anyway. 1289a720680SVladimir Oltean */ 1299a720680SVladimir Oltean if (port == ocelot->npi) 1309a720680SVladimir Oltean return 0; 1319a720680SVladimir Oltean 132*b7a9e0daSVladimir Oltean return ocelot_vlan_prepare(ocelot, port, vlan->vid, 1332f0402feSVladimir Oltean flags & BRIDGE_VLAN_INFO_PVID, 1342f0402feSVladimir Oltean flags & BRIDGE_VLAN_INFO_UNTAGGED); 13556051948SVladimir Oltean } 13656051948SVladimir Oltean 1372e554a7aSVladimir Oltean static int felix_vlan_filtering(struct dsa_switch *ds, int port, bool enabled, 1382e554a7aSVladimir Oltean struct switchdev_trans *trans) 13956051948SVladimir Oltean { 14056051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 14156051948SVladimir Oltean 1422e554a7aSVladimir Oltean return ocelot_port_vlan_filtering(ocelot, port, enabled, trans); 14356051948SVladimir Oltean } 14456051948SVladimir Oltean 14556051948SVladimir Oltean static void felix_vlan_add(struct dsa_switch *ds, int port, 14656051948SVladimir Oltean const struct switchdev_obj_port_vlan *vlan) 14756051948SVladimir Oltean { 14856051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 149183be6f9SVladimir Oltean u16 flags = vlan->flags; 15056051948SVladimir Oltean 151*b7a9e0daSVladimir Oltean ocelot_vlan_add(ocelot, port, vlan->vid, 152183be6f9SVladimir Oltean flags & BRIDGE_VLAN_INFO_PVID, 153183be6f9SVladimir Oltean flags & BRIDGE_VLAN_INFO_UNTAGGED); 15456051948SVladimir Oltean } 15556051948SVladimir Oltean 15656051948SVladimir Oltean static int felix_vlan_del(struct dsa_switch *ds, int port, 15756051948SVladimir Oltean const struct switchdev_obj_port_vlan *vlan) 15856051948SVladimir Oltean { 15956051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 16056051948SVladimir Oltean 161*b7a9e0daSVladimir Oltean return ocelot_vlan_del(ocelot, port, vlan->vid); 16256051948SVladimir Oltean } 16356051948SVladimir Oltean 16456051948SVladimir Oltean static int felix_port_enable(struct dsa_switch *ds, int port, 16556051948SVladimir Oltean struct phy_device *phy) 16656051948SVladimir Oltean { 16756051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 16856051948SVladimir Oltean 16956051948SVladimir Oltean ocelot_port_enable(ocelot, port, phy); 17056051948SVladimir Oltean 17156051948SVladimir Oltean return 0; 17256051948SVladimir Oltean } 17356051948SVladimir Oltean 17456051948SVladimir Oltean static void felix_port_disable(struct dsa_switch *ds, int port) 17556051948SVladimir Oltean { 17656051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 17756051948SVladimir Oltean 17856051948SVladimir Oltean return ocelot_port_disable(ocelot, port); 17956051948SVladimir Oltean } 18056051948SVladimir Oltean 181bdeced75SVladimir Oltean static void felix_phylink_validate(struct dsa_switch *ds, int port, 182bdeced75SVladimir Oltean unsigned long *supported, 183bdeced75SVladimir Oltean struct phylink_link_state *state) 184bdeced75SVladimir Oltean { 185bdeced75SVladimir Oltean struct ocelot *ocelot = ds->priv; 186375e1314SVladimir Oltean struct felix *felix = ocelot_to_felix(ocelot); 187bdeced75SVladimir Oltean 188375e1314SVladimir Oltean if (felix->info->phylink_validate) 189375e1314SVladimir Oltean felix->info->phylink_validate(ocelot, port, supported, state); 190bdeced75SVladimir Oltean } 191bdeced75SVladimir Oltean 192bdeced75SVladimir Oltean static void felix_phylink_mac_config(struct dsa_switch *ds, int port, 193bdeced75SVladimir Oltean unsigned int link_an_mode, 194bdeced75SVladimir Oltean const struct phylink_link_state *state) 195bdeced75SVladimir Oltean { 196bdeced75SVladimir Oltean struct ocelot *ocelot = ds->priv; 197bdeced75SVladimir Oltean struct felix *felix = ocelot_to_felix(ocelot); 198588d0550SIoana Ciornei struct dsa_port *dp = dsa_to_port(ds, port); 199bdeced75SVladimir Oltean 200588d0550SIoana Ciornei if (felix->pcs[port]) 201588d0550SIoana Ciornei phylink_set_pcs(dp->pl, &felix->pcs[port]->pcs); 202bdeced75SVladimir Oltean } 203bdeced75SVladimir Oltean 204bdeced75SVladimir Oltean static void felix_phylink_mac_link_down(struct dsa_switch *ds, int port, 205bdeced75SVladimir Oltean unsigned int link_an_mode, 206bdeced75SVladimir Oltean phy_interface_t interface) 207bdeced75SVladimir Oltean { 208bdeced75SVladimir Oltean struct ocelot *ocelot = ds->priv; 209bdeced75SVladimir Oltean struct ocelot_port *ocelot_port = ocelot->ports[port]; 210bdeced75SVladimir Oltean 211bdeced75SVladimir Oltean ocelot_port_writel(ocelot_port, 0, DEV_MAC_ENA_CFG); 212886e1387SVladimir Oltean ocelot_fields_write(ocelot, port, QSYS_SWITCH_PORT_MODE_PORT_ENA, 0); 213bdeced75SVladimir Oltean } 214bdeced75SVladimir Oltean 215bdeced75SVladimir Oltean static void felix_phylink_mac_link_up(struct dsa_switch *ds, int port, 216bdeced75SVladimir Oltean unsigned int link_an_mode, 217bdeced75SVladimir Oltean phy_interface_t interface, 2185b502a7bSRussell King struct phy_device *phydev, 2195b502a7bSRussell King int speed, int duplex, 2205b502a7bSRussell King bool tx_pause, bool rx_pause) 221bdeced75SVladimir Oltean { 222bdeced75SVladimir Oltean struct ocelot *ocelot = ds->priv; 223bdeced75SVladimir Oltean struct ocelot_port *ocelot_port = ocelot->ports[port]; 2247e14a2dcSVladimir Oltean struct felix *felix = ocelot_to_felix(ocelot); 2257e14a2dcSVladimir Oltean u32 mac_fc_cfg; 226bdeced75SVladimir Oltean 2277e14a2dcSVladimir Oltean /* Take port out of reset by clearing the MAC_TX_RST, MAC_RX_RST and 2287e14a2dcSVladimir Oltean * PORT_RST bits in DEV_CLOCK_CFG. Note that the way this system is 2297e14a2dcSVladimir Oltean * integrated is that the MAC speed is fixed and it's the PCS who is 2307e14a2dcSVladimir Oltean * performing the rate adaptation, so we have to write "1000Mbps" into 2317e14a2dcSVladimir Oltean * the LINK_SPEED field of DEV_CLOCK_CFG (which is also its default 2327e14a2dcSVladimir Oltean * value). 2337e14a2dcSVladimir Oltean */ 2347e14a2dcSVladimir Oltean ocelot_port_writel(ocelot_port, 2357e14a2dcSVladimir Oltean DEV_CLOCK_CFG_LINK_SPEED(OCELOT_SPEED_1000), 2367e14a2dcSVladimir Oltean DEV_CLOCK_CFG); 2377e14a2dcSVladimir Oltean 2387e14a2dcSVladimir Oltean switch (speed) { 2397e14a2dcSVladimir Oltean case SPEED_10: 2407e14a2dcSVladimir Oltean mac_fc_cfg = SYS_MAC_FC_CFG_FC_LINK_SPEED(3); 2417e14a2dcSVladimir Oltean break; 2427e14a2dcSVladimir Oltean case SPEED_100: 2437e14a2dcSVladimir Oltean mac_fc_cfg = SYS_MAC_FC_CFG_FC_LINK_SPEED(2); 2447e14a2dcSVladimir Oltean break; 2457e14a2dcSVladimir Oltean case SPEED_1000: 2467e14a2dcSVladimir Oltean case SPEED_2500: 2477e14a2dcSVladimir Oltean mac_fc_cfg = SYS_MAC_FC_CFG_FC_LINK_SPEED(1); 2487e14a2dcSVladimir Oltean break; 2497e14a2dcSVladimir Oltean default: 2507e14a2dcSVladimir Oltean dev_err(ocelot->dev, "Unsupported speed on port %d: %d\n", 2517e14a2dcSVladimir Oltean port, speed); 2527e14a2dcSVladimir Oltean return; 2537e14a2dcSVladimir Oltean } 2547e14a2dcSVladimir Oltean 2557e14a2dcSVladimir Oltean /* handle Rx pause in all cases, with 2500base-X this is used for rate 2567e14a2dcSVladimir Oltean * adaptation. 2577e14a2dcSVladimir Oltean */ 2587e14a2dcSVladimir Oltean mac_fc_cfg |= SYS_MAC_FC_CFG_RX_FC_ENA; 2597e14a2dcSVladimir Oltean 2607e14a2dcSVladimir Oltean if (tx_pause) 2617e14a2dcSVladimir Oltean mac_fc_cfg |= SYS_MAC_FC_CFG_TX_FC_ENA | 2627e14a2dcSVladimir Oltean SYS_MAC_FC_CFG_PAUSE_VAL_CFG(0xffff) | 2637e14a2dcSVladimir Oltean SYS_MAC_FC_CFG_FC_LATENCY_CFG(0x7) | 2647e14a2dcSVladimir Oltean SYS_MAC_FC_CFG_ZERO_PAUSE_ENA; 2657e14a2dcSVladimir Oltean 2667e14a2dcSVladimir Oltean /* Flow control. Link speed is only used here to evaluate the time 2677e14a2dcSVladimir Oltean * specification in incoming pause frames. 2687e14a2dcSVladimir Oltean */ 2697e14a2dcSVladimir Oltean ocelot_write_rix(ocelot, mac_fc_cfg, SYS_MAC_FC_CFG, port); 2707e14a2dcSVladimir Oltean 2717e14a2dcSVladimir Oltean ocelot_write_rix(ocelot, 0, ANA_POL_FLOWC, port); 2727e14a2dcSVladimir Oltean 2737e14a2dcSVladimir Oltean /* Undo the effects of felix_phylink_mac_link_down: 2747e14a2dcSVladimir Oltean * enable MAC module 2757e14a2dcSVladimir Oltean */ 276bdeced75SVladimir Oltean ocelot_port_writel(ocelot_port, DEV_MAC_ENA_CFG_RX_ENA | 277bdeced75SVladimir Oltean DEV_MAC_ENA_CFG_TX_ENA, DEV_MAC_ENA_CFG); 278bdeced75SVladimir Oltean 279bdeced75SVladimir Oltean /* Enable receiving frames on the port, and activate auto-learning of 280bdeced75SVladimir Oltean * MAC addresses. 281bdeced75SVladimir Oltean */ 282bdeced75SVladimir Oltean ocelot_write_gix(ocelot, ANA_PORT_PORT_CFG_LEARNAUTO | 283bdeced75SVladimir Oltean ANA_PORT_PORT_CFG_RECV_ENA | 284bdeced75SVladimir Oltean ANA_PORT_PORT_CFG_PORTID_VAL(port), 285bdeced75SVladimir Oltean ANA_PORT_PORT_CFG, port); 286bdeced75SVladimir Oltean 287bdeced75SVladimir Oltean /* Core: Enable port for frame transfer */ 288886e1387SVladimir Oltean ocelot_fields_write(ocelot, port, 289886e1387SVladimir Oltean QSYS_SWITCH_PORT_MODE_PORT_ENA, 1); 2907e14a2dcSVladimir Oltean 2917e14a2dcSVladimir Oltean if (felix->info->port_sched_speed_set) 2927e14a2dcSVladimir Oltean felix->info->port_sched_speed_set(ocelot, port, speed); 293bdeced75SVladimir Oltean } 294bdeced75SVladimir Oltean 295bd2b3161SXiaoliang Yang static void felix_port_qos_map_init(struct ocelot *ocelot, int port) 296bd2b3161SXiaoliang Yang { 297bd2b3161SXiaoliang Yang int i; 298bd2b3161SXiaoliang Yang 299bd2b3161SXiaoliang Yang ocelot_rmw_gix(ocelot, 300bd2b3161SXiaoliang Yang ANA_PORT_QOS_CFG_QOS_PCP_ENA, 301bd2b3161SXiaoliang Yang ANA_PORT_QOS_CFG_QOS_PCP_ENA, 302bd2b3161SXiaoliang Yang ANA_PORT_QOS_CFG, 303bd2b3161SXiaoliang Yang port); 304bd2b3161SXiaoliang Yang 305bd2b3161SXiaoliang Yang for (i = 0; i < FELIX_NUM_TC * 2; i++) { 306bd2b3161SXiaoliang Yang ocelot_rmw_ix(ocelot, 307bd2b3161SXiaoliang Yang (ANA_PORT_PCP_DEI_MAP_DP_PCP_DEI_VAL & i) | 308bd2b3161SXiaoliang Yang ANA_PORT_PCP_DEI_MAP_QOS_PCP_DEI_VAL(i), 309bd2b3161SXiaoliang Yang ANA_PORT_PCP_DEI_MAP_DP_PCP_DEI_VAL | 310bd2b3161SXiaoliang Yang ANA_PORT_PCP_DEI_MAP_QOS_PCP_DEI_VAL_M, 311bd2b3161SXiaoliang Yang ANA_PORT_PCP_DEI_MAP, 312bd2b3161SXiaoliang Yang port, i); 313bd2b3161SXiaoliang Yang } 314bd2b3161SXiaoliang Yang } 315bd2b3161SXiaoliang Yang 31656051948SVladimir Oltean static void felix_get_strings(struct dsa_switch *ds, int port, 31756051948SVladimir Oltean u32 stringset, u8 *data) 31856051948SVladimir Oltean { 31956051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 32056051948SVladimir Oltean 32156051948SVladimir Oltean return ocelot_get_strings(ocelot, port, stringset, data); 32256051948SVladimir Oltean } 32356051948SVladimir Oltean 32456051948SVladimir Oltean static void felix_get_ethtool_stats(struct dsa_switch *ds, int port, u64 *data) 32556051948SVladimir Oltean { 32656051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 32756051948SVladimir Oltean 32856051948SVladimir Oltean ocelot_get_ethtool_stats(ocelot, port, data); 32956051948SVladimir Oltean } 33056051948SVladimir Oltean 33156051948SVladimir Oltean static int felix_get_sset_count(struct dsa_switch *ds, int port, int sset) 33256051948SVladimir Oltean { 33356051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 33456051948SVladimir Oltean 33556051948SVladimir Oltean return ocelot_get_sset_count(ocelot, port, sset); 33656051948SVladimir Oltean } 33756051948SVladimir Oltean 33856051948SVladimir Oltean static int felix_get_ts_info(struct dsa_switch *ds, int port, 33956051948SVladimir Oltean struct ethtool_ts_info *info) 34056051948SVladimir Oltean { 34156051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 34256051948SVladimir Oltean 34356051948SVladimir Oltean return ocelot_get_ts_info(ocelot, port, info); 34456051948SVladimir Oltean } 34556051948SVladimir Oltean 346bdeced75SVladimir Oltean static int felix_parse_ports_node(struct felix *felix, 347bdeced75SVladimir Oltean struct device_node *ports_node, 348bdeced75SVladimir Oltean phy_interface_t *port_phy_modes) 349bdeced75SVladimir Oltean { 350bdeced75SVladimir Oltean struct ocelot *ocelot = &felix->ocelot; 351bdeced75SVladimir Oltean struct device *dev = felix->ocelot.dev; 352bdeced75SVladimir Oltean struct device_node *child; 353bdeced75SVladimir Oltean 35437fe45adSVladimir Oltean for_each_available_child_of_node(ports_node, child) { 355bdeced75SVladimir Oltean phy_interface_t phy_mode; 356bdeced75SVladimir Oltean u32 port; 357bdeced75SVladimir Oltean int err; 358bdeced75SVladimir Oltean 359bdeced75SVladimir Oltean /* Get switch port number from DT */ 360bdeced75SVladimir Oltean if (of_property_read_u32(child, "reg", &port) < 0) { 361bdeced75SVladimir Oltean dev_err(dev, "Port number not defined in device tree " 362bdeced75SVladimir Oltean "(property \"reg\")\n"); 363bdeced75SVladimir Oltean of_node_put(child); 364bdeced75SVladimir Oltean return -ENODEV; 365bdeced75SVladimir Oltean } 366bdeced75SVladimir Oltean 367bdeced75SVladimir Oltean /* Get PHY mode from DT */ 368bdeced75SVladimir Oltean err = of_get_phy_mode(child, &phy_mode); 369bdeced75SVladimir Oltean if (err) { 370bdeced75SVladimir Oltean dev_err(dev, "Failed to read phy-mode or " 371bdeced75SVladimir Oltean "phy-interface-type property for port %d\n", 372bdeced75SVladimir Oltean port); 373bdeced75SVladimir Oltean of_node_put(child); 374bdeced75SVladimir Oltean return -ENODEV; 375bdeced75SVladimir Oltean } 376bdeced75SVladimir Oltean 377bdeced75SVladimir Oltean err = felix->info->prevalidate_phy_mode(ocelot, port, phy_mode); 378bdeced75SVladimir Oltean if (err < 0) { 379bdeced75SVladimir Oltean dev_err(dev, "Unsupported PHY mode %s on port %d\n", 380bdeced75SVladimir Oltean phy_modes(phy_mode), port); 38159ebb430SSumera Priyadarsini of_node_put(child); 382bdeced75SVladimir Oltean return err; 383bdeced75SVladimir Oltean } 384bdeced75SVladimir Oltean 385bdeced75SVladimir Oltean port_phy_modes[port] = phy_mode; 386bdeced75SVladimir Oltean } 387bdeced75SVladimir Oltean 388bdeced75SVladimir Oltean return 0; 389bdeced75SVladimir Oltean } 390bdeced75SVladimir Oltean 391bdeced75SVladimir Oltean static int felix_parse_dt(struct felix *felix, phy_interface_t *port_phy_modes) 392bdeced75SVladimir Oltean { 393bdeced75SVladimir Oltean struct device *dev = felix->ocelot.dev; 394bdeced75SVladimir Oltean struct device_node *switch_node; 395bdeced75SVladimir Oltean struct device_node *ports_node; 396bdeced75SVladimir Oltean int err; 397bdeced75SVladimir Oltean 398bdeced75SVladimir Oltean switch_node = dev->of_node; 399bdeced75SVladimir Oltean 400bdeced75SVladimir Oltean ports_node = of_get_child_by_name(switch_node, "ports"); 401bdeced75SVladimir Oltean if (!ports_node) { 402bdeced75SVladimir Oltean dev_err(dev, "Incorrect bindings: absent \"ports\" node\n"); 403bdeced75SVladimir Oltean return -ENODEV; 404bdeced75SVladimir Oltean } 405bdeced75SVladimir Oltean 406bdeced75SVladimir Oltean err = felix_parse_ports_node(felix, ports_node, port_phy_modes); 407bdeced75SVladimir Oltean of_node_put(ports_node); 408bdeced75SVladimir Oltean 409bdeced75SVladimir Oltean return err; 410bdeced75SVladimir Oltean } 411bdeced75SVladimir Oltean 41256051948SVladimir Oltean static int felix_init_structs(struct felix *felix, int num_phys_ports) 41356051948SVladimir Oltean { 41456051948SVladimir Oltean struct ocelot *ocelot = &felix->ocelot; 415bdeced75SVladimir Oltean phy_interface_t *port_phy_modes; 416b4024c9eSClaudiu Manoil struct resource res; 41756051948SVladimir Oltean int port, i, err; 41856051948SVladimir Oltean 41956051948SVladimir Oltean ocelot->num_phys_ports = num_phys_ports; 42056051948SVladimir Oltean ocelot->ports = devm_kcalloc(ocelot->dev, num_phys_ports, 42156051948SVladimir Oltean sizeof(struct ocelot_port *), GFP_KERNEL); 42256051948SVladimir Oltean if (!ocelot->ports) 42356051948SVladimir Oltean return -ENOMEM; 42456051948SVladimir Oltean 42556051948SVladimir Oltean ocelot->map = felix->info->map; 42656051948SVladimir Oltean ocelot->stats_layout = felix->info->stats_layout; 42756051948SVladimir Oltean ocelot->num_stats = felix->info->num_stats; 42856051948SVladimir Oltean ocelot->shared_queue_sz = felix->info->shared_queue_sz; 42921ce7f3eSVladimir Oltean ocelot->num_mact_rows = felix->info->num_mact_rows; 43007d985eeSVladimir Oltean ocelot->vcap = felix->info->vcap; 43156051948SVladimir Oltean ocelot->ops = felix->info->ops; 4325124197cSVladimir Oltean ocelot->inj_prefix = OCELOT_TAG_PREFIX_SHORT; 4335124197cSVladimir Oltean ocelot->xtr_prefix = OCELOT_TAG_PREFIX_SHORT; 43456051948SVladimir Oltean 435bdeced75SVladimir Oltean port_phy_modes = kcalloc(num_phys_ports, sizeof(phy_interface_t), 436bdeced75SVladimir Oltean GFP_KERNEL); 437bdeced75SVladimir Oltean if (!port_phy_modes) 438bdeced75SVladimir Oltean return -ENOMEM; 439bdeced75SVladimir Oltean 440bdeced75SVladimir Oltean err = felix_parse_dt(felix, port_phy_modes); 441bdeced75SVladimir Oltean if (err) { 442bdeced75SVladimir Oltean kfree(port_phy_modes); 443bdeced75SVladimir Oltean return err; 444bdeced75SVladimir Oltean } 445bdeced75SVladimir Oltean 44656051948SVladimir Oltean for (i = 0; i < TARGET_MAX; i++) { 44756051948SVladimir Oltean struct regmap *target; 44856051948SVladimir Oltean 44956051948SVladimir Oltean if (!felix->info->target_io_res[i].name) 45056051948SVladimir Oltean continue; 45156051948SVladimir Oltean 452b4024c9eSClaudiu Manoil memcpy(&res, &felix->info->target_io_res[i], sizeof(res)); 453b4024c9eSClaudiu Manoil res.flags = IORESOURCE_MEM; 454375e1314SVladimir Oltean res.start += felix->switch_base; 455375e1314SVladimir Oltean res.end += felix->switch_base; 45656051948SVladimir Oltean 457b4024c9eSClaudiu Manoil target = ocelot_regmap_init(ocelot, &res); 45856051948SVladimir Oltean if (IS_ERR(target)) { 45956051948SVladimir Oltean dev_err(ocelot->dev, 46056051948SVladimir Oltean "Failed to map device memory space\n"); 461bdeced75SVladimir Oltean kfree(port_phy_modes); 46256051948SVladimir Oltean return PTR_ERR(target); 46356051948SVladimir Oltean } 46456051948SVladimir Oltean 46556051948SVladimir Oltean ocelot->targets[i] = target; 46656051948SVladimir Oltean } 46756051948SVladimir Oltean 46856051948SVladimir Oltean err = ocelot_regfields_init(ocelot, felix->info->regfields); 46956051948SVladimir Oltean if (err) { 47056051948SVladimir Oltean dev_err(ocelot->dev, "failed to init reg fields map\n"); 471bdeced75SVladimir Oltean kfree(port_phy_modes); 47256051948SVladimir Oltean return err; 47356051948SVladimir Oltean } 47456051948SVladimir Oltean 47556051948SVladimir Oltean for (port = 0; port < num_phys_ports; port++) { 47656051948SVladimir Oltean struct ocelot_port *ocelot_port; 47791c724cfSVladimir Oltean struct regmap *target; 47867c24049SVladimir Oltean u8 *template; 47956051948SVladimir Oltean 48056051948SVladimir Oltean ocelot_port = devm_kzalloc(ocelot->dev, 48156051948SVladimir Oltean sizeof(struct ocelot_port), 48256051948SVladimir Oltean GFP_KERNEL); 48356051948SVladimir Oltean if (!ocelot_port) { 48456051948SVladimir Oltean dev_err(ocelot->dev, 48556051948SVladimir Oltean "failed to allocate port memory\n"); 486bdeced75SVladimir Oltean kfree(port_phy_modes); 48756051948SVladimir Oltean return -ENOMEM; 48856051948SVladimir Oltean } 48956051948SVladimir Oltean 490b4024c9eSClaudiu Manoil memcpy(&res, &felix->info->port_io_res[port], sizeof(res)); 491b4024c9eSClaudiu Manoil res.flags = IORESOURCE_MEM; 492375e1314SVladimir Oltean res.start += felix->switch_base; 493375e1314SVladimir Oltean res.end += felix->switch_base; 49456051948SVladimir Oltean 49591c724cfSVladimir Oltean target = ocelot_regmap_init(ocelot, &res); 49691c724cfSVladimir Oltean if (IS_ERR(target)) { 49756051948SVladimir Oltean dev_err(ocelot->dev, 49891c724cfSVladimir Oltean "Failed to map memory space for port %d\n", 49991c724cfSVladimir Oltean port); 500bdeced75SVladimir Oltean kfree(port_phy_modes); 50191c724cfSVladimir Oltean return PTR_ERR(target); 50256051948SVladimir Oltean } 50356051948SVladimir Oltean 5045124197cSVladimir Oltean template = devm_kzalloc(ocelot->dev, OCELOT_TOTAL_TAG_LEN, 50567c24049SVladimir Oltean GFP_KERNEL); 50667c24049SVladimir Oltean if (!template) { 50767c24049SVladimir Oltean dev_err(ocelot->dev, 50867c24049SVladimir Oltean "Failed to allocate memory for DSA tag\n"); 50967c24049SVladimir Oltean kfree(port_phy_modes); 51067c24049SVladimir Oltean return -ENOMEM; 51167c24049SVladimir Oltean } 51267c24049SVladimir Oltean 513bdeced75SVladimir Oltean ocelot_port->phy_mode = port_phy_modes[port]; 51456051948SVladimir Oltean ocelot_port->ocelot = ocelot; 51591c724cfSVladimir Oltean ocelot_port->target = target; 51667c24049SVladimir Oltean ocelot_port->xmit_template = template; 51756051948SVladimir Oltean ocelot->ports[port] = ocelot_port; 51867c24049SVladimir Oltean 51967c24049SVladimir Oltean felix->info->xmit_template_populate(ocelot, port); 52056051948SVladimir Oltean } 52156051948SVladimir Oltean 522bdeced75SVladimir Oltean kfree(port_phy_modes); 523bdeced75SVladimir Oltean 524bdeced75SVladimir Oltean if (felix->info->mdio_bus_alloc) { 525bdeced75SVladimir Oltean err = felix->info->mdio_bus_alloc(ocelot); 526bdeced75SVladimir Oltean if (err < 0) 527bdeced75SVladimir Oltean return err; 528bdeced75SVladimir Oltean } 529bdeced75SVladimir Oltean 53056051948SVladimir Oltean return 0; 53156051948SVladimir Oltean } 53256051948SVladimir Oltean 5332d44b097SVladimir Oltean /* The CPU port module is connected to the Node Processor Interface (NPI). This 5342d44b097SVladimir Oltean * is the mode through which frames can be injected from and extracted to an 5352d44b097SVladimir Oltean * external CPU, over Ethernet. 5362d44b097SVladimir Oltean */ 5372d44b097SVladimir Oltean static void felix_npi_port_init(struct ocelot *ocelot, int port) 5382d44b097SVladimir Oltean { 5392d44b097SVladimir Oltean ocelot->npi = port; 5402d44b097SVladimir Oltean 5412d44b097SVladimir Oltean ocelot_write(ocelot, QSYS_EXT_CPU_CFG_EXT_CPUQ_MSK_M | 5422d44b097SVladimir Oltean QSYS_EXT_CPU_CFG_EXT_CPU_PORT(port), 5432d44b097SVladimir Oltean QSYS_EXT_CPU_CFG); 5442d44b097SVladimir Oltean 5452d44b097SVladimir Oltean /* NPI port Injection/Extraction configuration */ 5462d44b097SVladimir Oltean ocelot_fields_write(ocelot, port, SYS_PORT_MODE_INCL_XTR_HDR, 5472d44b097SVladimir Oltean ocelot->xtr_prefix); 5482d44b097SVladimir Oltean ocelot_fields_write(ocelot, port, SYS_PORT_MODE_INCL_INJ_HDR, 5492d44b097SVladimir Oltean ocelot->inj_prefix); 5502d44b097SVladimir Oltean 5512d44b097SVladimir Oltean /* Disable transmission of pause frames */ 5522d44b097SVladimir Oltean ocelot_fields_write(ocelot, port, SYS_PAUSE_CFG_PAUSE_ENA, 0); 5532d44b097SVladimir Oltean } 5542d44b097SVladimir Oltean 55556051948SVladimir Oltean /* Hardware initialization done here so that we can allocate structures with 55656051948SVladimir Oltean * devm without fear of dsa_register_switch returning -EPROBE_DEFER and causing 55756051948SVladimir Oltean * us to allocate structures twice (leak memory) and map PCI memory twice 55856051948SVladimir Oltean * (which will not work). 55956051948SVladimir Oltean */ 56056051948SVladimir Oltean static int felix_setup(struct dsa_switch *ds) 56156051948SVladimir Oltean { 56256051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 56356051948SVladimir Oltean struct felix *felix = ocelot_to_felix(ocelot); 56456051948SVladimir Oltean int port, err; 56556051948SVladimir Oltean 56656051948SVladimir Oltean err = felix_init_structs(felix, ds->num_ports); 56756051948SVladimir Oltean if (err) 56856051948SVladimir Oltean return err; 56956051948SVladimir Oltean 570d1cc0e93SVladimir Oltean err = ocelot_init(ocelot); 571d1cc0e93SVladimir Oltean if (err) 572d1cc0e93SVladimir Oltean return err; 573d1cc0e93SVladimir Oltean 5742b49d128SYangbo Lu if (ocelot->ptp) { 5752ac7c6c5SVladimir Oltean err = ocelot_init_timestamp(ocelot, felix->info->ptp_caps); 5762b49d128SYangbo Lu if (err) { 5772b49d128SYangbo Lu dev_err(ocelot->dev, 5782b49d128SYangbo Lu "Timestamp initialization failed\n"); 5792b49d128SYangbo Lu ocelot->ptp = 0; 5802b49d128SYangbo Lu } 5812b49d128SYangbo Lu } 58256051948SVladimir Oltean 58356051948SVladimir Oltean for (port = 0; port < ds->num_ports; port++) { 58456051948SVladimir Oltean ocelot_init_port(ocelot, port); 58556051948SVladimir Oltean 586b8fc7177SVladimir Oltean if (dsa_is_cpu_port(ds, port)) 5872d44b097SVladimir Oltean felix_npi_port_init(ocelot, port); 588bd2b3161SXiaoliang Yang 589bd2b3161SXiaoliang Yang /* Set the default QoS Classification based on PCP and DEI 590bd2b3161SXiaoliang Yang * bits of vlan tag. 591bd2b3161SXiaoliang Yang */ 592bd2b3161SXiaoliang Yang felix_port_qos_map_init(ocelot, port); 59356051948SVladimir Oltean } 59456051948SVladimir Oltean 5951cf3299bSVladimir Oltean /* Include the CPU port module in the forwarding mask for unknown 5961cf3299bSVladimir Oltean * unicast - the hardware default value for ANA_FLOODING_FLD_UNICAST 5971cf3299bSVladimir Oltean * excludes BIT(ocelot->num_phys_ports), and so does ocelot_init, since 5981cf3299bSVladimir Oltean * Ocelot relies on whitelisting MAC addresses towards PGID_CPU. 5991cf3299bSVladimir Oltean */ 6001cf3299bSVladimir Oltean ocelot_write_rix(ocelot, 6011cf3299bSVladimir Oltean ANA_PGID_PGID_PGID(GENMASK(ocelot->num_phys_ports, 0)), 6021cf3299bSVladimir Oltean ANA_PGID_PGID, PGID_UC); 6031cf3299bSVladimir Oltean 6040b912fc9SVladimir Oltean ds->mtu_enforcement_ingress = true; 605626a8323SVladimir Oltean ds->configure_vlan_while_not_filtering = true; 606c54913c1SVladimir Oltean ds->assisted_learning_on_cpu_port = true; 607bdeced75SVladimir Oltean 60856051948SVladimir Oltean return 0; 60956051948SVladimir Oltean } 61056051948SVladimir Oltean 61156051948SVladimir Oltean static void felix_teardown(struct dsa_switch *ds) 61256051948SVladimir Oltean { 61356051948SVladimir Oltean struct ocelot *ocelot = ds->priv; 614bdeced75SVladimir Oltean struct felix *felix = ocelot_to_felix(ocelot); 615e5fb512dSVladimir Oltean int port; 616bdeced75SVladimir Oltean 617bdeced75SVladimir Oltean if (felix->info->mdio_bus_free) 618bdeced75SVladimir Oltean felix->info->mdio_bus_free(ocelot); 61956051948SVladimir Oltean 620e5fb512dSVladimir Oltean for (port = 0; port < ocelot->num_phys_ports; port++) 621e5fb512dSVladimir Oltean ocelot_deinit_port(ocelot, port); 6222b49d128SYangbo Lu ocelot_deinit_timestamp(ocelot); 62356051948SVladimir Oltean /* stop workqueue thread */ 62456051948SVladimir Oltean ocelot_deinit(ocelot); 62556051948SVladimir Oltean } 62656051948SVladimir Oltean 627c0bcf537SYangbo Lu static int felix_hwtstamp_get(struct dsa_switch *ds, int port, 628c0bcf537SYangbo Lu struct ifreq *ifr) 629c0bcf537SYangbo Lu { 630c0bcf537SYangbo Lu struct ocelot *ocelot = ds->priv; 631c0bcf537SYangbo Lu 632c0bcf537SYangbo Lu return ocelot_hwstamp_get(ocelot, port, ifr); 633c0bcf537SYangbo Lu } 634c0bcf537SYangbo Lu 635c0bcf537SYangbo Lu static int felix_hwtstamp_set(struct dsa_switch *ds, int port, 636c0bcf537SYangbo Lu struct ifreq *ifr) 637c0bcf537SYangbo Lu { 638c0bcf537SYangbo Lu struct ocelot *ocelot = ds->priv; 639c0bcf537SYangbo Lu 640c0bcf537SYangbo Lu return ocelot_hwstamp_set(ocelot, port, ifr); 641c0bcf537SYangbo Lu } 642c0bcf537SYangbo Lu 643c0bcf537SYangbo Lu static bool felix_rxtstamp(struct dsa_switch *ds, int port, 644c0bcf537SYangbo Lu struct sk_buff *skb, unsigned int type) 645c0bcf537SYangbo Lu { 646c0bcf537SYangbo Lu struct skb_shared_hwtstamps *shhwtstamps; 647c0bcf537SYangbo Lu struct ocelot *ocelot = ds->priv; 648c0bcf537SYangbo Lu u8 *extraction = skb->data - ETH_HLEN - OCELOT_TAG_LEN; 649c0bcf537SYangbo Lu u32 tstamp_lo, tstamp_hi; 650c0bcf537SYangbo Lu struct timespec64 ts; 651c0bcf537SYangbo Lu u64 tstamp, val; 652c0bcf537SYangbo Lu 653c0bcf537SYangbo Lu ocelot_ptp_gettime64(&ocelot->ptp_info, &ts); 654c0bcf537SYangbo Lu tstamp = ktime_set(ts.tv_sec, ts.tv_nsec); 655c0bcf537SYangbo Lu 656c0bcf537SYangbo Lu packing(extraction, &val, 116, 85, OCELOT_TAG_LEN, UNPACK, 0); 657c0bcf537SYangbo Lu tstamp_lo = (u32)val; 658c0bcf537SYangbo Lu 659c0bcf537SYangbo Lu tstamp_hi = tstamp >> 32; 660c0bcf537SYangbo Lu if ((tstamp & 0xffffffff) < tstamp_lo) 661c0bcf537SYangbo Lu tstamp_hi--; 662c0bcf537SYangbo Lu 663c0bcf537SYangbo Lu tstamp = ((u64)tstamp_hi << 32) | tstamp_lo; 664c0bcf537SYangbo Lu 665c0bcf537SYangbo Lu shhwtstamps = skb_hwtstamps(skb); 666c0bcf537SYangbo Lu memset(shhwtstamps, 0, sizeof(struct skb_shared_hwtstamps)); 667c0bcf537SYangbo Lu shhwtstamps->hwtstamp = tstamp; 668c0bcf537SYangbo Lu return false; 669c0bcf537SYangbo Lu } 670c0bcf537SYangbo Lu 6713243e04aSChen Wandun static bool felix_txtstamp(struct dsa_switch *ds, int port, 672c0bcf537SYangbo Lu struct sk_buff *clone, unsigned int type) 673c0bcf537SYangbo Lu { 674c0bcf537SYangbo Lu struct ocelot *ocelot = ds->priv; 675c0bcf537SYangbo Lu struct ocelot_port *ocelot_port = ocelot->ports[port]; 676c0bcf537SYangbo Lu 677e2f9a8feSVladimir Oltean if (ocelot->ptp && (skb_shinfo(clone)->tx_flags & SKBTX_HW_TSTAMP) && 678e2f9a8feSVladimir Oltean ocelot_port->ptp_cmd == IFH_REW_OP_TWO_STEP_PTP) { 679e2f9a8feSVladimir Oltean ocelot_port_add_txtstamp_skb(ocelot, port, clone); 680c0bcf537SYangbo Lu return true; 681e2f9a8feSVladimir Oltean } 682c0bcf537SYangbo Lu 683c0bcf537SYangbo Lu return false; 684c0bcf537SYangbo Lu } 685c0bcf537SYangbo Lu 6860b912fc9SVladimir Oltean static int felix_change_mtu(struct dsa_switch *ds, int port, int new_mtu) 6870b912fc9SVladimir Oltean { 6880b912fc9SVladimir Oltean struct ocelot *ocelot = ds->priv; 6890b912fc9SVladimir Oltean 6900b912fc9SVladimir Oltean ocelot_port_set_maxlen(ocelot, port, new_mtu); 6910b912fc9SVladimir Oltean 6920b912fc9SVladimir Oltean return 0; 6930b912fc9SVladimir Oltean } 6940b912fc9SVladimir Oltean 6950b912fc9SVladimir Oltean static int felix_get_max_mtu(struct dsa_switch *ds, int port) 6960b912fc9SVladimir Oltean { 6970b912fc9SVladimir Oltean struct ocelot *ocelot = ds->priv; 6980b912fc9SVladimir Oltean 6990b912fc9SVladimir Oltean return ocelot_get_max_mtu(ocelot, port); 7000b912fc9SVladimir Oltean } 7010b912fc9SVladimir Oltean 70207d985eeSVladimir Oltean static int felix_cls_flower_add(struct dsa_switch *ds, int port, 70307d985eeSVladimir Oltean struct flow_cls_offload *cls, bool ingress) 70407d985eeSVladimir Oltean { 70507d985eeSVladimir Oltean struct ocelot *ocelot = ds->priv; 70607d985eeSVladimir Oltean 70707d985eeSVladimir Oltean return ocelot_cls_flower_replace(ocelot, port, cls, ingress); 70807d985eeSVladimir Oltean } 70907d985eeSVladimir Oltean 71007d985eeSVladimir Oltean static int felix_cls_flower_del(struct dsa_switch *ds, int port, 71107d985eeSVladimir Oltean struct flow_cls_offload *cls, bool ingress) 71207d985eeSVladimir Oltean { 71307d985eeSVladimir Oltean struct ocelot *ocelot = ds->priv; 71407d985eeSVladimir Oltean 71507d985eeSVladimir Oltean return ocelot_cls_flower_destroy(ocelot, port, cls, ingress); 71607d985eeSVladimir Oltean } 71707d985eeSVladimir Oltean 71807d985eeSVladimir Oltean static int felix_cls_flower_stats(struct dsa_switch *ds, int port, 71907d985eeSVladimir Oltean struct flow_cls_offload *cls, bool ingress) 72007d985eeSVladimir Oltean { 72107d985eeSVladimir Oltean struct ocelot *ocelot = ds->priv; 72207d985eeSVladimir Oltean 72307d985eeSVladimir Oltean return ocelot_cls_flower_stats(ocelot, port, cls, ingress); 72407d985eeSVladimir Oltean } 72507d985eeSVladimir Oltean 726fc411eaaSVladimir Oltean static int felix_port_policer_add(struct dsa_switch *ds, int port, 727fc411eaaSVladimir Oltean struct dsa_mall_policer_tc_entry *policer) 728fc411eaaSVladimir Oltean { 729fc411eaaSVladimir Oltean struct ocelot *ocelot = ds->priv; 730fc411eaaSVladimir Oltean struct ocelot_policer pol = { 731fc411eaaSVladimir Oltean .rate = div_u64(policer->rate_bytes_per_sec, 1000) * 8, 7325f035af7SPo Liu .burst = policer->burst, 733fc411eaaSVladimir Oltean }; 734fc411eaaSVladimir Oltean 735fc411eaaSVladimir Oltean return ocelot_port_policer_add(ocelot, port, &pol); 736fc411eaaSVladimir Oltean } 737fc411eaaSVladimir Oltean 738fc411eaaSVladimir Oltean static void felix_port_policer_del(struct dsa_switch *ds, int port) 739fc411eaaSVladimir Oltean { 740fc411eaaSVladimir Oltean struct ocelot *ocelot = ds->priv; 741fc411eaaSVladimir Oltean 742fc411eaaSVladimir Oltean ocelot_port_policer_del(ocelot, port); 743fc411eaaSVladimir Oltean } 744fc411eaaSVladimir Oltean 745de143c0eSXiaoliang Yang static int felix_port_setup_tc(struct dsa_switch *ds, int port, 746de143c0eSXiaoliang Yang enum tc_setup_type type, 747de143c0eSXiaoliang Yang void *type_data) 748de143c0eSXiaoliang Yang { 749de143c0eSXiaoliang Yang struct ocelot *ocelot = ds->priv; 750de143c0eSXiaoliang Yang struct felix *felix = ocelot_to_felix(ocelot); 751de143c0eSXiaoliang Yang 752de143c0eSXiaoliang Yang if (felix->info->port_setup_tc) 753de143c0eSXiaoliang Yang return felix->info->port_setup_tc(ds, port, type, type_data); 754de143c0eSXiaoliang Yang else 755de143c0eSXiaoliang Yang return -EOPNOTSUPP; 756de143c0eSXiaoliang Yang } 757de143c0eSXiaoliang Yang 758375e1314SVladimir Oltean const struct dsa_switch_ops felix_switch_ops = { 75956051948SVladimir Oltean .get_tag_protocol = felix_get_tag_protocol, 76056051948SVladimir Oltean .setup = felix_setup, 76156051948SVladimir Oltean .teardown = felix_teardown, 76256051948SVladimir Oltean .set_ageing_time = felix_set_ageing_time, 76356051948SVladimir Oltean .get_strings = felix_get_strings, 76456051948SVladimir Oltean .get_ethtool_stats = felix_get_ethtool_stats, 76556051948SVladimir Oltean .get_sset_count = felix_get_sset_count, 76656051948SVladimir Oltean .get_ts_info = felix_get_ts_info, 767bdeced75SVladimir Oltean .phylink_validate = felix_phylink_validate, 768bdeced75SVladimir Oltean .phylink_mac_config = felix_phylink_mac_config, 769bdeced75SVladimir Oltean .phylink_mac_link_down = felix_phylink_mac_link_down, 770bdeced75SVladimir Oltean .phylink_mac_link_up = felix_phylink_mac_link_up, 77156051948SVladimir Oltean .port_enable = felix_port_enable, 77256051948SVladimir Oltean .port_disable = felix_port_disable, 77356051948SVladimir Oltean .port_fdb_dump = felix_fdb_dump, 77456051948SVladimir Oltean .port_fdb_add = felix_fdb_add, 77556051948SVladimir Oltean .port_fdb_del = felix_fdb_del, 776209edf95SVladimir Oltean .port_mdb_prepare = felix_mdb_prepare, 777209edf95SVladimir Oltean .port_mdb_add = felix_mdb_add, 778209edf95SVladimir Oltean .port_mdb_del = felix_mdb_del, 77956051948SVladimir Oltean .port_bridge_join = felix_bridge_join, 78056051948SVladimir Oltean .port_bridge_leave = felix_bridge_leave, 78156051948SVladimir Oltean .port_stp_state_set = felix_bridge_stp_state_set, 78256051948SVladimir Oltean .port_vlan_prepare = felix_vlan_prepare, 78356051948SVladimir Oltean .port_vlan_filtering = felix_vlan_filtering, 78456051948SVladimir Oltean .port_vlan_add = felix_vlan_add, 78556051948SVladimir Oltean .port_vlan_del = felix_vlan_del, 786c0bcf537SYangbo Lu .port_hwtstamp_get = felix_hwtstamp_get, 787c0bcf537SYangbo Lu .port_hwtstamp_set = felix_hwtstamp_set, 788c0bcf537SYangbo Lu .port_rxtstamp = felix_rxtstamp, 789c0bcf537SYangbo Lu .port_txtstamp = felix_txtstamp, 7900b912fc9SVladimir Oltean .port_change_mtu = felix_change_mtu, 7910b912fc9SVladimir Oltean .port_max_mtu = felix_get_max_mtu, 792fc411eaaSVladimir Oltean .port_policer_add = felix_port_policer_add, 793fc411eaaSVladimir Oltean .port_policer_del = felix_port_policer_del, 79407d985eeSVladimir Oltean .cls_flower_add = felix_cls_flower_add, 79507d985eeSVladimir Oltean .cls_flower_del = felix_cls_flower_del, 79607d985eeSVladimir Oltean .cls_flower_stats = felix_cls_flower_stats, 797de143c0eSXiaoliang Yang .port_setup_tc = felix_port_setup_tc, 79856051948SVladimir Oltean }; 799319e4dd1SVladimir Oltean 800319e4dd1SVladimir Oltean struct net_device *felix_port_to_netdev(struct ocelot *ocelot, int port) 801319e4dd1SVladimir Oltean { 802319e4dd1SVladimir Oltean struct felix *felix = ocelot_to_felix(ocelot); 803319e4dd1SVladimir Oltean struct dsa_switch *ds = felix->ds; 804319e4dd1SVladimir Oltean 805319e4dd1SVladimir Oltean if (!dsa_is_user_port(ds, port)) 806319e4dd1SVladimir Oltean return NULL; 807319e4dd1SVladimir Oltean 808319e4dd1SVladimir Oltean return dsa_to_port(ds, port)->slave; 809319e4dd1SVladimir Oltean } 810319e4dd1SVladimir Oltean 811319e4dd1SVladimir Oltean int felix_netdev_to_port(struct net_device *dev) 812319e4dd1SVladimir Oltean { 813319e4dd1SVladimir Oltean struct dsa_port *dp; 814319e4dd1SVladimir Oltean 815319e4dd1SVladimir Oltean dp = dsa_port_from_netdev(dev); 816319e4dd1SVladimir Oltean if (IS_ERR(dp)) 817319e4dd1SVladimir Oltean return -EINVAL; 818319e4dd1SVladimir Oltean 819319e4dd1SVladimir Oltean return dp->index; 820319e4dd1SVladimir Oltean } 821