1501ef306SVadym Kochan // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0 2501ef306SVadym Kochan /* Copyright (c) 2019-2020 Marvell International Ltd. All rights reserved */ 3501ef306SVadym Kochan 4501ef306SVadym Kochan #include <linux/etherdevice.h> 5501ef306SVadym Kochan #include <linux/jiffies.h> 6501ef306SVadym Kochan #include <linux/list.h> 7501ef306SVadym Kochan #include <linux/module.h> 8501ef306SVadym Kochan #include <linux/netdev_features.h> 9501ef306SVadym Kochan #include <linux/of.h> 10501ef306SVadym Kochan #include <linux/of_net.h> 11501ef306SVadym Kochan 12501ef306SVadym Kochan #include "prestera.h" 13501ef306SVadym Kochan #include "prestera_hw.h" 14501ef306SVadym Kochan #include "prestera_rxtx.h" 1534dd1710SVadym Kochan #include "prestera_devlink.h" 16a97d3c69SVadym Kochan #include "prestera_ethtool.h" 17e1189d9aSVadym Kochan #include "prestera_switchdev.h" 18501ef306SVadym Kochan 19501ef306SVadym Kochan #define PRESTERA_MTU_DEFAULT 1536 20501ef306SVadym Kochan 21501ef306SVadym Kochan #define PRESTERA_STATS_DELAY_MS 1000 22501ef306SVadym Kochan 23501ef306SVadym Kochan #define PRESTERA_MAC_ADDR_NUM_MAX 255 24501ef306SVadym Kochan 25501ef306SVadym Kochan static struct workqueue_struct *prestera_wq; 26501ef306SVadym Kochan 27e1189d9aSVadym Kochan int prestera_port_pvid_set(struct prestera_port *port, u16 vid) 28e1189d9aSVadym Kochan { 29e1189d9aSVadym Kochan enum prestera_accept_frm_type frm_type; 30e1189d9aSVadym Kochan int err; 31e1189d9aSVadym Kochan 32e1189d9aSVadym Kochan frm_type = PRESTERA_ACCEPT_FRAME_TYPE_TAGGED; 33e1189d9aSVadym Kochan 34e1189d9aSVadym Kochan if (vid) { 35e1189d9aSVadym Kochan err = prestera_hw_vlan_port_vid_set(port, vid); 36e1189d9aSVadym Kochan if (err) 37e1189d9aSVadym Kochan return err; 38e1189d9aSVadym Kochan 39e1189d9aSVadym Kochan frm_type = PRESTERA_ACCEPT_FRAME_TYPE_ALL; 40e1189d9aSVadym Kochan } 41e1189d9aSVadym Kochan 42e1189d9aSVadym Kochan err = prestera_hw_port_accept_frm_type(port, frm_type); 43e1189d9aSVadym Kochan if (err && frm_type == PRESTERA_ACCEPT_FRAME_TYPE_ALL) 44e1189d9aSVadym Kochan prestera_hw_vlan_port_vid_set(port, port->pvid); 45e1189d9aSVadym Kochan 46e1189d9aSVadym Kochan port->pvid = vid; 47e1189d9aSVadym Kochan return 0; 48e1189d9aSVadym Kochan } 49e1189d9aSVadym Kochan 50501ef306SVadym Kochan struct prestera_port *prestera_port_find_by_hwid(struct prestera_switch *sw, 51501ef306SVadym Kochan u32 dev_id, u32 hw_id) 52501ef306SVadym Kochan { 53501ef306SVadym Kochan struct prestera_port *port = NULL; 54501ef306SVadym Kochan 55501ef306SVadym Kochan read_lock(&sw->port_list_lock); 56501ef306SVadym Kochan list_for_each_entry(port, &sw->port_list, list) { 57501ef306SVadym Kochan if (port->dev_id == dev_id && port->hw_id == hw_id) 58501ef306SVadym Kochan break; 59501ef306SVadym Kochan } 60501ef306SVadym Kochan read_unlock(&sw->port_list_lock); 61501ef306SVadym Kochan 62501ef306SVadym Kochan return port; 63501ef306SVadym Kochan } 64501ef306SVadym Kochan 65e1189d9aSVadym Kochan struct prestera_port *prestera_find_port(struct prestera_switch *sw, u32 id) 66501ef306SVadym Kochan { 67501ef306SVadym Kochan struct prestera_port *port = NULL; 68501ef306SVadym Kochan 69501ef306SVadym Kochan read_lock(&sw->port_list_lock); 70501ef306SVadym Kochan list_for_each_entry(port, &sw->port_list, list) { 71501ef306SVadym Kochan if (port->id == id) 72501ef306SVadym Kochan break; 73501ef306SVadym Kochan } 74501ef306SVadym Kochan read_unlock(&sw->port_list_lock); 75501ef306SVadym Kochan 76501ef306SVadym Kochan return port; 77501ef306SVadym Kochan } 78501ef306SVadym Kochan 79501ef306SVadym Kochan static int prestera_port_open(struct net_device *dev) 80501ef306SVadym Kochan { 81501ef306SVadym Kochan struct prestera_port *port = netdev_priv(dev); 82501ef306SVadym Kochan int err; 83501ef306SVadym Kochan 84501ef306SVadym Kochan err = prestera_hw_port_state_set(port, true); 85501ef306SVadym Kochan if (err) 86501ef306SVadym Kochan return err; 87501ef306SVadym Kochan 88501ef306SVadym Kochan netif_start_queue(dev); 89501ef306SVadym Kochan 90501ef306SVadym Kochan return 0; 91501ef306SVadym Kochan } 92501ef306SVadym Kochan 93501ef306SVadym Kochan static int prestera_port_close(struct net_device *dev) 94501ef306SVadym Kochan { 95501ef306SVadym Kochan struct prestera_port *port = netdev_priv(dev); 96501ef306SVadym Kochan 97501ef306SVadym Kochan netif_stop_queue(dev); 98501ef306SVadym Kochan 99*05372c45SZheng Yongjun return prestera_hw_port_state_set(port, false); 100501ef306SVadym Kochan } 101501ef306SVadym Kochan 102501ef306SVadym Kochan static netdev_tx_t prestera_port_xmit(struct sk_buff *skb, 103501ef306SVadym Kochan struct net_device *dev) 104501ef306SVadym Kochan { 105501ef306SVadym Kochan return prestera_rxtx_xmit(netdev_priv(dev), skb); 106501ef306SVadym Kochan } 107501ef306SVadym Kochan 108501ef306SVadym Kochan static int prestera_is_valid_mac_addr(struct prestera_port *port, u8 *addr) 109501ef306SVadym Kochan { 110501ef306SVadym Kochan if (!is_valid_ether_addr(addr)) 111501ef306SVadym Kochan return -EADDRNOTAVAIL; 112501ef306SVadym Kochan 113501ef306SVadym Kochan /* firmware requires that port's MAC address contains first 5 bytes 114501ef306SVadym Kochan * of the base MAC address 115501ef306SVadym Kochan */ 116501ef306SVadym Kochan if (memcmp(port->sw->base_mac, addr, ETH_ALEN - 1)) 117501ef306SVadym Kochan return -EINVAL; 118501ef306SVadym Kochan 119501ef306SVadym Kochan return 0; 120501ef306SVadym Kochan } 121501ef306SVadym Kochan 122501ef306SVadym Kochan static int prestera_port_set_mac_address(struct net_device *dev, void *p) 123501ef306SVadym Kochan { 124501ef306SVadym Kochan struct prestera_port *port = netdev_priv(dev); 125501ef306SVadym Kochan struct sockaddr *addr = p; 126501ef306SVadym Kochan int err; 127501ef306SVadym Kochan 128501ef306SVadym Kochan err = prestera_is_valid_mac_addr(port, addr->sa_data); 129501ef306SVadym Kochan if (err) 130501ef306SVadym Kochan return err; 131501ef306SVadym Kochan 132501ef306SVadym Kochan err = prestera_hw_port_mac_set(port, addr->sa_data); 133501ef306SVadym Kochan if (err) 134501ef306SVadym Kochan return err; 135501ef306SVadym Kochan 136501ef306SVadym Kochan ether_addr_copy(dev->dev_addr, addr->sa_data); 137501ef306SVadym Kochan 138501ef306SVadym Kochan return 0; 139501ef306SVadym Kochan } 140501ef306SVadym Kochan 141501ef306SVadym Kochan static int prestera_port_change_mtu(struct net_device *dev, int mtu) 142501ef306SVadym Kochan { 143501ef306SVadym Kochan struct prestera_port *port = netdev_priv(dev); 144501ef306SVadym Kochan int err; 145501ef306SVadym Kochan 146501ef306SVadym Kochan err = prestera_hw_port_mtu_set(port, mtu); 147501ef306SVadym Kochan if (err) 148501ef306SVadym Kochan return err; 149501ef306SVadym Kochan 150501ef306SVadym Kochan dev->mtu = mtu; 151501ef306SVadym Kochan 152501ef306SVadym Kochan return 0; 153501ef306SVadym Kochan } 154501ef306SVadym Kochan 155501ef306SVadym Kochan static void prestera_port_get_stats64(struct net_device *dev, 156501ef306SVadym Kochan struct rtnl_link_stats64 *stats) 157501ef306SVadym Kochan { 158501ef306SVadym Kochan struct prestera_port *port = netdev_priv(dev); 159501ef306SVadym Kochan struct prestera_port_stats *port_stats = &port->cached_hw_stats.stats; 160501ef306SVadym Kochan 161501ef306SVadym Kochan stats->rx_packets = port_stats->broadcast_frames_received + 162501ef306SVadym Kochan port_stats->multicast_frames_received + 163501ef306SVadym Kochan port_stats->unicast_frames_received; 164501ef306SVadym Kochan 165501ef306SVadym Kochan stats->tx_packets = port_stats->broadcast_frames_sent + 166501ef306SVadym Kochan port_stats->multicast_frames_sent + 167501ef306SVadym Kochan port_stats->unicast_frames_sent; 168501ef306SVadym Kochan 169501ef306SVadym Kochan stats->rx_bytes = port_stats->good_octets_received; 170501ef306SVadym Kochan 171501ef306SVadym Kochan stats->tx_bytes = port_stats->good_octets_sent; 172501ef306SVadym Kochan 173501ef306SVadym Kochan stats->rx_errors = port_stats->rx_error_frame_received; 174501ef306SVadym Kochan stats->tx_errors = port_stats->mac_trans_error; 175501ef306SVadym Kochan 176501ef306SVadym Kochan stats->rx_dropped = port_stats->buffer_overrun; 177501ef306SVadym Kochan stats->tx_dropped = 0; 178501ef306SVadym Kochan 179501ef306SVadym Kochan stats->multicast = port_stats->multicast_frames_received; 180501ef306SVadym Kochan stats->collisions = port_stats->excessive_collision; 181501ef306SVadym Kochan 182501ef306SVadym Kochan stats->rx_crc_errors = port_stats->bad_crc; 183501ef306SVadym Kochan } 184501ef306SVadym Kochan 185501ef306SVadym Kochan static void prestera_port_get_hw_stats(struct prestera_port *port) 186501ef306SVadym Kochan { 187501ef306SVadym Kochan prestera_hw_port_stats_get(port, &port->cached_hw_stats.stats); 188501ef306SVadym Kochan } 189501ef306SVadym Kochan 190501ef306SVadym Kochan static void prestera_port_stats_update(struct work_struct *work) 191501ef306SVadym Kochan { 192501ef306SVadym Kochan struct prestera_port *port = 193501ef306SVadym Kochan container_of(work, struct prestera_port, 194501ef306SVadym Kochan cached_hw_stats.caching_dw.work); 195501ef306SVadym Kochan 196501ef306SVadym Kochan prestera_port_get_hw_stats(port); 197501ef306SVadym Kochan 198501ef306SVadym Kochan queue_delayed_work(prestera_wq, &port->cached_hw_stats.caching_dw, 199501ef306SVadym Kochan msecs_to_jiffies(PRESTERA_STATS_DELAY_MS)); 200501ef306SVadym Kochan } 201501ef306SVadym Kochan 202501ef306SVadym Kochan static const struct net_device_ops prestera_netdev_ops = { 203501ef306SVadym Kochan .ndo_open = prestera_port_open, 204501ef306SVadym Kochan .ndo_stop = prestera_port_close, 205501ef306SVadym Kochan .ndo_start_xmit = prestera_port_xmit, 206501ef306SVadym Kochan .ndo_change_mtu = prestera_port_change_mtu, 207501ef306SVadym Kochan .ndo_get_stats64 = prestera_port_get_stats64, 208501ef306SVadym Kochan .ndo_set_mac_address = prestera_port_set_mac_address, 20934dd1710SVadym Kochan .ndo_get_devlink_port = prestera_devlink_get_port, 210501ef306SVadym Kochan }; 211501ef306SVadym Kochan 212a97d3c69SVadym Kochan int prestera_port_autoneg_set(struct prestera_port *port, bool enable, 213a97d3c69SVadym Kochan u64 adver_link_modes, u8 adver_fec) 214501ef306SVadym Kochan { 215501ef306SVadym Kochan bool refresh = false; 216a97d3c69SVadym Kochan u64 link_modes; 217501ef306SVadym Kochan int err; 218a97d3c69SVadym Kochan u8 fec; 219501ef306SVadym Kochan 220501ef306SVadym Kochan if (port->caps.type != PRESTERA_PORT_TYPE_TP) 221501ef306SVadym Kochan return enable ? -EINVAL : 0; 222501ef306SVadym Kochan 223a97d3c69SVadym Kochan if (!enable) 224a97d3c69SVadym Kochan goto set_autoneg; 225a97d3c69SVadym Kochan 226a97d3c69SVadym Kochan link_modes = port->caps.supp_link_modes & adver_link_modes; 227a97d3c69SVadym Kochan fec = port->caps.supp_fec & adver_fec; 228a97d3c69SVadym Kochan 229a97d3c69SVadym Kochan if (!link_modes && !fec) 230a97d3c69SVadym Kochan return -EOPNOTSUPP; 231a97d3c69SVadym Kochan 232a97d3c69SVadym Kochan if (link_modes && port->adver_link_modes != link_modes) { 233501ef306SVadym Kochan port->adver_link_modes = link_modes; 234501ef306SVadym Kochan refresh = true; 235501ef306SVadym Kochan } 236501ef306SVadym Kochan 237a97d3c69SVadym Kochan if (fec && port->adver_fec != fec) { 238a97d3c69SVadym Kochan port->adver_fec = fec; 239a97d3c69SVadym Kochan refresh = true; 240a97d3c69SVadym Kochan } 241a97d3c69SVadym Kochan 242a97d3c69SVadym Kochan set_autoneg: 243a97d3c69SVadym Kochan if (port->autoneg == enable && !refresh) 244501ef306SVadym Kochan return 0; 245501ef306SVadym Kochan 246501ef306SVadym Kochan err = prestera_hw_port_autoneg_set(port, enable, port->adver_link_modes, 247501ef306SVadym Kochan port->adver_fec); 248501ef306SVadym Kochan if (err) 249501ef306SVadym Kochan return err; 250501ef306SVadym Kochan 251501ef306SVadym Kochan port->autoneg = enable; 252501ef306SVadym Kochan 253501ef306SVadym Kochan return 0; 254501ef306SVadym Kochan } 255501ef306SVadym Kochan 256501ef306SVadym Kochan static void prestera_port_list_add(struct prestera_port *port) 257501ef306SVadym Kochan { 258501ef306SVadym Kochan write_lock(&port->sw->port_list_lock); 259501ef306SVadym Kochan list_add(&port->list, &port->sw->port_list); 260501ef306SVadym Kochan write_unlock(&port->sw->port_list_lock); 261501ef306SVadym Kochan } 262501ef306SVadym Kochan 263501ef306SVadym Kochan static void prestera_port_list_del(struct prestera_port *port) 264501ef306SVadym Kochan { 265501ef306SVadym Kochan write_lock(&port->sw->port_list_lock); 266501ef306SVadym Kochan list_del(&port->list); 267501ef306SVadym Kochan write_unlock(&port->sw->port_list_lock); 268501ef306SVadym Kochan } 269501ef306SVadym Kochan 270501ef306SVadym Kochan static int prestera_port_create(struct prestera_switch *sw, u32 id) 271501ef306SVadym Kochan { 272501ef306SVadym Kochan struct prestera_port *port; 273501ef306SVadym Kochan struct net_device *dev; 274501ef306SVadym Kochan int err; 275501ef306SVadym Kochan 276501ef306SVadym Kochan dev = alloc_etherdev(sizeof(*port)); 277501ef306SVadym Kochan if (!dev) 278501ef306SVadym Kochan return -ENOMEM; 279501ef306SVadym Kochan 280501ef306SVadym Kochan port = netdev_priv(dev); 281501ef306SVadym Kochan 282e1189d9aSVadym Kochan INIT_LIST_HEAD(&port->vlans_list); 283e1189d9aSVadym Kochan port->pvid = PRESTERA_DEFAULT_VID; 284501ef306SVadym Kochan port->dev = dev; 285501ef306SVadym Kochan port->id = id; 286501ef306SVadym Kochan port->sw = sw; 287501ef306SVadym Kochan 288501ef306SVadym Kochan err = prestera_hw_port_info_get(port, &port->dev_id, &port->hw_id, 289501ef306SVadym Kochan &port->fp_id); 290501ef306SVadym Kochan if (err) { 291501ef306SVadym Kochan dev_err(prestera_dev(sw), "Failed to get port(%u) info\n", id); 29234dd1710SVadym Kochan goto err_port_info_get; 293501ef306SVadym Kochan } 294501ef306SVadym Kochan 29534dd1710SVadym Kochan err = prestera_devlink_port_register(port); 29634dd1710SVadym Kochan if (err) 29734dd1710SVadym Kochan goto err_dl_port_register; 29834dd1710SVadym Kochan 299501ef306SVadym Kochan dev->features |= NETIF_F_NETNS_LOCAL; 300501ef306SVadym Kochan dev->netdev_ops = &prestera_netdev_ops; 301a97d3c69SVadym Kochan dev->ethtool_ops = &prestera_ethtool_ops; 302501ef306SVadym Kochan 303501ef306SVadym Kochan netif_carrier_off(dev); 304501ef306SVadym Kochan 305501ef306SVadym Kochan dev->mtu = min_t(unsigned int, sw->mtu_max, PRESTERA_MTU_DEFAULT); 306501ef306SVadym Kochan dev->min_mtu = sw->mtu_min; 307501ef306SVadym Kochan dev->max_mtu = sw->mtu_max; 308501ef306SVadym Kochan 309501ef306SVadym Kochan err = prestera_hw_port_mtu_set(port, dev->mtu); 310501ef306SVadym Kochan if (err) { 311501ef306SVadym Kochan dev_err(prestera_dev(sw), "Failed to set port(%u) mtu(%d)\n", 312501ef306SVadym Kochan id, dev->mtu); 313501ef306SVadym Kochan goto err_port_init; 314501ef306SVadym Kochan } 315501ef306SVadym Kochan 316501ef306SVadym Kochan if (port->fp_id >= PRESTERA_MAC_ADDR_NUM_MAX) 317501ef306SVadym Kochan goto err_port_init; 318501ef306SVadym Kochan 319501ef306SVadym Kochan /* firmware requires that port's MAC address consist of the first 320501ef306SVadym Kochan * 5 bytes of the base MAC address 321501ef306SVadym Kochan */ 322501ef306SVadym Kochan memcpy(dev->dev_addr, sw->base_mac, dev->addr_len - 1); 323501ef306SVadym Kochan dev->dev_addr[dev->addr_len - 1] = port->fp_id; 324501ef306SVadym Kochan 325501ef306SVadym Kochan err = prestera_hw_port_mac_set(port, dev->dev_addr); 326501ef306SVadym Kochan if (err) { 327501ef306SVadym Kochan dev_err(prestera_dev(sw), "Failed to set port(%u) mac addr\n", id); 328501ef306SVadym Kochan goto err_port_init; 329501ef306SVadym Kochan } 330501ef306SVadym Kochan 331501ef306SVadym Kochan err = prestera_hw_port_cap_get(port, &port->caps); 332501ef306SVadym Kochan if (err) { 333501ef306SVadym Kochan dev_err(prestera_dev(sw), "Failed to get port(%u) caps\n", id); 334501ef306SVadym Kochan goto err_port_init; 335501ef306SVadym Kochan } 336501ef306SVadym Kochan 337501ef306SVadym Kochan port->adver_fec = BIT(PRESTERA_PORT_FEC_OFF); 338501ef306SVadym Kochan prestera_port_autoneg_set(port, true, port->caps.supp_link_modes, 339501ef306SVadym Kochan port->caps.supp_fec); 340501ef306SVadym Kochan 341501ef306SVadym Kochan err = prestera_hw_port_state_set(port, false); 342501ef306SVadym Kochan if (err) { 343501ef306SVadym Kochan dev_err(prestera_dev(sw), "Failed to set port(%u) down\n", id); 344501ef306SVadym Kochan goto err_port_init; 345501ef306SVadym Kochan } 346501ef306SVadym Kochan 347501ef306SVadym Kochan err = prestera_rxtx_port_init(port); 348501ef306SVadym Kochan if (err) 349501ef306SVadym Kochan goto err_port_init; 350501ef306SVadym Kochan 351501ef306SVadym Kochan INIT_DELAYED_WORK(&port->cached_hw_stats.caching_dw, 352501ef306SVadym Kochan &prestera_port_stats_update); 353501ef306SVadym Kochan 354501ef306SVadym Kochan prestera_port_list_add(port); 355501ef306SVadym Kochan 356501ef306SVadym Kochan err = register_netdev(dev); 357501ef306SVadym Kochan if (err) 358501ef306SVadym Kochan goto err_register_netdev; 359501ef306SVadym Kochan 36034dd1710SVadym Kochan prestera_devlink_port_set(port); 36134dd1710SVadym Kochan 362501ef306SVadym Kochan return 0; 363501ef306SVadym Kochan 364501ef306SVadym Kochan err_register_netdev: 365501ef306SVadym Kochan prestera_port_list_del(port); 366501ef306SVadym Kochan err_port_init: 36734dd1710SVadym Kochan prestera_devlink_port_unregister(port); 36834dd1710SVadym Kochan err_dl_port_register: 36934dd1710SVadym Kochan err_port_info_get: 370501ef306SVadym Kochan free_netdev(dev); 371501ef306SVadym Kochan return err; 372501ef306SVadym Kochan } 373501ef306SVadym Kochan 374501ef306SVadym Kochan static void prestera_port_destroy(struct prestera_port *port) 375501ef306SVadym Kochan { 376501ef306SVadym Kochan struct net_device *dev = port->dev; 377501ef306SVadym Kochan 378501ef306SVadym Kochan cancel_delayed_work_sync(&port->cached_hw_stats.caching_dw); 37934dd1710SVadym Kochan prestera_devlink_port_clear(port); 380501ef306SVadym Kochan unregister_netdev(dev); 381501ef306SVadym Kochan prestera_port_list_del(port); 38234dd1710SVadym Kochan prestera_devlink_port_unregister(port); 383501ef306SVadym Kochan free_netdev(dev); 384501ef306SVadym Kochan } 385501ef306SVadym Kochan 386501ef306SVadym Kochan static void prestera_destroy_ports(struct prestera_switch *sw) 387501ef306SVadym Kochan { 388501ef306SVadym Kochan struct prestera_port *port, *tmp; 389501ef306SVadym Kochan 390501ef306SVadym Kochan list_for_each_entry_safe(port, tmp, &sw->port_list, list) 391501ef306SVadym Kochan prestera_port_destroy(port); 392501ef306SVadym Kochan } 393501ef306SVadym Kochan 394501ef306SVadym Kochan static int prestera_create_ports(struct prestera_switch *sw) 395501ef306SVadym Kochan { 396501ef306SVadym Kochan struct prestera_port *port, *tmp; 397501ef306SVadym Kochan u32 port_idx; 398501ef306SVadym Kochan int err; 399501ef306SVadym Kochan 400501ef306SVadym Kochan for (port_idx = 0; port_idx < sw->port_count; port_idx++) { 401501ef306SVadym Kochan err = prestera_port_create(sw, port_idx); 402501ef306SVadym Kochan if (err) 403501ef306SVadym Kochan goto err_port_create; 404501ef306SVadym Kochan } 405501ef306SVadym Kochan 406501ef306SVadym Kochan return 0; 407501ef306SVadym Kochan 408501ef306SVadym Kochan err_port_create: 409501ef306SVadym Kochan list_for_each_entry_safe(port, tmp, &sw->port_list, list) 410501ef306SVadym Kochan prestera_port_destroy(port); 411501ef306SVadym Kochan 412501ef306SVadym Kochan return err; 413501ef306SVadym Kochan } 414501ef306SVadym Kochan 415501ef306SVadym Kochan static void prestera_port_handle_event(struct prestera_switch *sw, 416501ef306SVadym Kochan struct prestera_event *evt, void *arg) 417501ef306SVadym Kochan { 418501ef306SVadym Kochan struct delayed_work *caching_dw; 419501ef306SVadym Kochan struct prestera_port *port; 420501ef306SVadym Kochan 421501ef306SVadym Kochan port = prestera_find_port(sw, evt->port_evt.port_id); 422501ef306SVadym Kochan if (!port || !port->dev) 423501ef306SVadym Kochan return; 424501ef306SVadym Kochan 425501ef306SVadym Kochan caching_dw = &port->cached_hw_stats.caching_dw; 426501ef306SVadym Kochan 427501ef306SVadym Kochan if (evt->id == PRESTERA_PORT_EVENT_STATE_CHANGED) { 428501ef306SVadym Kochan if (evt->port_evt.data.oper_state) { 429501ef306SVadym Kochan netif_carrier_on(port->dev); 430501ef306SVadym Kochan if (!delayed_work_pending(caching_dw)) 431501ef306SVadym Kochan queue_delayed_work(prestera_wq, caching_dw, 0); 432501ef306SVadym Kochan } else { 433501ef306SVadym Kochan netif_carrier_off(port->dev); 434501ef306SVadym Kochan if (delayed_work_pending(caching_dw)) 435501ef306SVadym Kochan cancel_delayed_work(caching_dw); 436501ef306SVadym Kochan } 437501ef306SVadym Kochan } 438501ef306SVadym Kochan } 439501ef306SVadym Kochan 440501ef306SVadym Kochan static int prestera_event_handlers_register(struct prestera_switch *sw) 441501ef306SVadym Kochan { 442501ef306SVadym Kochan return prestera_hw_event_handler_register(sw, PRESTERA_EVENT_TYPE_PORT, 443501ef306SVadym Kochan prestera_port_handle_event, 444501ef306SVadym Kochan NULL); 445501ef306SVadym Kochan } 446501ef306SVadym Kochan 447501ef306SVadym Kochan static void prestera_event_handlers_unregister(struct prestera_switch *sw) 448501ef306SVadym Kochan { 449501ef306SVadym Kochan prestera_hw_event_handler_unregister(sw, PRESTERA_EVENT_TYPE_PORT, 450501ef306SVadym Kochan prestera_port_handle_event); 451501ef306SVadym Kochan } 452501ef306SVadym Kochan 453501ef306SVadym Kochan static int prestera_switch_set_base_mac_addr(struct prestera_switch *sw) 454501ef306SVadym Kochan { 455501ef306SVadym Kochan struct device_node *base_mac_np; 456501ef306SVadym Kochan struct device_node *np; 457501ef306SVadym Kochan const char *base_mac; 458501ef306SVadym Kochan 459501ef306SVadym Kochan np = of_find_compatible_node(NULL, NULL, "marvell,prestera"); 460501ef306SVadym Kochan base_mac_np = of_parse_phandle(np, "base-mac-provider", 0); 461501ef306SVadym Kochan 462501ef306SVadym Kochan base_mac = of_get_mac_address(base_mac_np); 463501ef306SVadym Kochan of_node_put(base_mac_np); 464501ef306SVadym Kochan if (!IS_ERR(base_mac)) 465501ef306SVadym Kochan ether_addr_copy(sw->base_mac, base_mac); 466501ef306SVadym Kochan 467501ef306SVadym Kochan if (!is_valid_ether_addr(sw->base_mac)) { 468501ef306SVadym Kochan eth_random_addr(sw->base_mac); 469501ef306SVadym Kochan dev_info(prestera_dev(sw), "using random base mac address\n"); 470501ef306SVadym Kochan } 471501ef306SVadym Kochan 472501ef306SVadym Kochan return prestera_hw_switch_mac_set(sw, sw->base_mac); 473501ef306SVadym Kochan } 474501ef306SVadym Kochan 475e1189d9aSVadym Kochan bool prestera_netdev_check(const struct net_device *dev) 476e1189d9aSVadym Kochan { 477e1189d9aSVadym Kochan return dev->netdev_ops == &prestera_netdev_ops; 478e1189d9aSVadym Kochan } 479e1189d9aSVadym Kochan 4808b0308feSDavid S. Miller static int prestera_lower_dev_walk(struct net_device *dev, 4818b0308feSDavid S. Miller struct netdev_nested_priv *priv) 482e1189d9aSVadym Kochan { 4838b0308feSDavid S. Miller struct prestera_port **pport = (struct prestera_port **)priv->data; 484e1189d9aSVadym Kochan 485e1189d9aSVadym Kochan if (prestera_netdev_check(dev)) { 486e1189d9aSVadym Kochan *pport = netdev_priv(dev); 487e1189d9aSVadym Kochan return 1; 488e1189d9aSVadym Kochan } 489e1189d9aSVadym Kochan 490e1189d9aSVadym Kochan return 0; 491e1189d9aSVadym Kochan } 492e1189d9aSVadym Kochan 493e1189d9aSVadym Kochan struct prestera_port *prestera_port_dev_lower_find(struct net_device *dev) 494e1189d9aSVadym Kochan { 495e1189d9aSVadym Kochan struct prestera_port *port = NULL; 4968b0308feSDavid S. Miller struct netdev_nested_priv priv = { 4978b0308feSDavid S. Miller .data = (void *)&port, 4988b0308feSDavid S. Miller }; 499e1189d9aSVadym Kochan 500e1189d9aSVadym Kochan if (prestera_netdev_check(dev)) 501e1189d9aSVadym Kochan return netdev_priv(dev); 502e1189d9aSVadym Kochan 5038b0308feSDavid S. Miller netdev_walk_all_lower_dev(dev, prestera_lower_dev_walk, &priv); 504e1189d9aSVadym Kochan 505e1189d9aSVadym Kochan return port; 506e1189d9aSVadym Kochan } 507e1189d9aSVadym Kochan 508e1189d9aSVadym Kochan static int prestera_netdev_port_event(struct net_device *dev, 509e1189d9aSVadym Kochan unsigned long event, void *ptr) 510e1189d9aSVadym Kochan { 511e1189d9aSVadym Kochan switch (event) { 512e1189d9aSVadym Kochan case NETDEV_PRECHANGEUPPER: 513e1189d9aSVadym Kochan case NETDEV_CHANGEUPPER: 514e1189d9aSVadym Kochan return prestera_bridge_port_event(dev, event, ptr); 515e1189d9aSVadym Kochan default: 516e1189d9aSVadym Kochan return 0; 517e1189d9aSVadym Kochan } 518e1189d9aSVadym Kochan } 519e1189d9aSVadym Kochan 520e1189d9aSVadym Kochan static int prestera_netdev_event_handler(struct notifier_block *nb, 521e1189d9aSVadym Kochan unsigned long event, void *ptr) 522e1189d9aSVadym Kochan { 523e1189d9aSVadym Kochan struct net_device *dev = netdev_notifier_info_to_dev(ptr); 524e1189d9aSVadym Kochan int err = 0; 525e1189d9aSVadym Kochan 526e1189d9aSVadym Kochan if (prestera_netdev_check(dev)) 527e1189d9aSVadym Kochan err = prestera_netdev_port_event(dev, event, ptr); 528e1189d9aSVadym Kochan 529e1189d9aSVadym Kochan return notifier_from_errno(err); 530e1189d9aSVadym Kochan } 531e1189d9aSVadym Kochan 532e1189d9aSVadym Kochan static int prestera_netdev_event_handler_register(struct prestera_switch *sw) 533e1189d9aSVadym Kochan { 534e1189d9aSVadym Kochan sw->netdev_nb.notifier_call = prestera_netdev_event_handler; 535e1189d9aSVadym Kochan 536e1189d9aSVadym Kochan return register_netdevice_notifier(&sw->netdev_nb); 537e1189d9aSVadym Kochan } 538e1189d9aSVadym Kochan 539e1189d9aSVadym Kochan static void prestera_netdev_event_handler_unregister(struct prestera_switch *sw) 540e1189d9aSVadym Kochan { 541e1189d9aSVadym Kochan unregister_netdevice_notifier(&sw->netdev_nb); 542e1189d9aSVadym Kochan } 543e1189d9aSVadym Kochan 544501ef306SVadym Kochan static int prestera_switch_init(struct prestera_switch *sw) 545501ef306SVadym Kochan { 546501ef306SVadym Kochan int err; 547501ef306SVadym Kochan 548501ef306SVadym Kochan err = prestera_hw_switch_init(sw); 549501ef306SVadym Kochan if (err) { 550501ef306SVadym Kochan dev_err(prestera_dev(sw), "Failed to init Switch device\n"); 551501ef306SVadym Kochan return err; 552501ef306SVadym Kochan } 553501ef306SVadym Kochan 554501ef306SVadym Kochan rwlock_init(&sw->port_list_lock); 555501ef306SVadym Kochan INIT_LIST_HEAD(&sw->port_list); 556501ef306SVadym Kochan 557501ef306SVadym Kochan err = prestera_switch_set_base_mac_addr(sw); 558501ef306SVadym Kochan if (err) 559501ef306SVadym Kochan return err; 560501ef306SVadym Kochan 561e1189d9aSVadym Kochan err = prestera_netdev_event_handler_register(sw); 562501ef306SVadym Kochan if (err) 563501ef306SVadym Kochan return err; 564501ef306SVadym Kochan 565e1189d9aSVadym Kochan err = prestera_switchdev_init(sw); 566e1189d9aSVadym Kochan if (err) 567e1189d9aSVadym Kochan goto err_swdev_register; 568e1189d9aSVadym Kochan 569e1189d9aSVadym Kochan err = prestera_rxtx_switch_init(sw); 570e1189d9aSVadym Kochan if (err) 571e1189d9aSVadym Kochan goto err_rxtx_register; 572e1189d9aSVadym Kochan 573501ef306SVadym Kochan err = prestera_event_handlers_register(sw); 574501ef306SVadym Kochan if (err) 575501ef306SVadym Kochan goto err_handlers_register; 576501ef306SVadym Kochan 57734dd1710SVadym Kochan err = prestera_devlink_register(sw); 57834dd1710SVadym Kochan if (err) 57934dd1710SVadym Kochan goto err_dl_register; 58034dd1710SVadym Kochan 581501ef306SVadym Kochan err = prestera_create_ports(sw); 582501ef306SVadym Kochan if (err) 583501ef306SVadym Kochan goto err_ports_create; 584501ef306SVadym Kochan 585501ef306SVadym Kochan return 0; 586501ef306SVadym Kochan 587501ef306SVadym Kochan err_ports_create: 58834dd1710SVadym Kochan prestera_devlink_unregister(sw); 58934dd1710SVadym Kochan err_dl_register: 590501ef306SVadym Kochan prestera_event_handlers_unregister(sw); 591501ef306SVadym Kochan err_handlers_register: 592501ef306SVadym Kochan prestera_rxtx_switch_fini(sw); 593e1189d9aSVadym Kochan err_rxtx_register: 594e1189d9aSVadym Kochan prestera_switchdev_fini(sw); 595e1189d9aSVadym Kochan err_swdev_register: 596e1189d9aSVadym Kochan prestera_netdev_event_handler_unregister(sw); 597501ef306SVadym Kochan prestera_hw_switch_fini(sw); 598501ef306SVadym Kochan 599501ef306SVadym Kochan return err; 600501ef306SVadym Kochan } 601501ef306SVadym Kochan 602501ef306SVadym Kochan static void prestera_switch_fini(struct prestera_switch *sw) 603501ef306SVadym Kochan { 604501ef306SVadym Kochan prestera_destroy_ports(sw); 60534dd1710SVadym Kochan prestera_devlink_unregister(sw); 606501ef306SVadym Kochan prestera_event_handlers_unregister(sw); 607501ef306SVadym Kochan prestera_rxtx_switch_fini(sw); 608e1189d9aSVadym Kochan prestera_switchdev_fini(sw); 609e1189d9aSVadym Kochan prestera_netdev_event_handler_unregister(sw); 610501ef306SVadym Kochan prestera_hw_switch_fini(sw); 611501ef306SVadym Kochan } 612501ef306SVadym Kochan 613501ef306SVadym Kochan int prestera_device_register(struct prestera_device *dev) 614501ef306SVadym Kochan { 615501ef306SVadym Kochan struct prestera_switch *sw; 616501ef306SVadym Kochan int err; 617501ef306SVadym Kochan 61834dd1710SVadym Kochan sw = prestera_devlink_alloc(); 619501ef306SVadym Kochan if (!sw) 620501ef306SVadym Kochan return -ENOMEM; 621501ef306SVadym Kochan 622501ef306SVadym Kochan dev->priv = sw; 623501ef306SVadym Kochan sw->dev = dev; 624501ef306SVadym Kochan 625501ef306SVadym Kochan err = prestera_switch_init(sw); 626501ef306SVadym Kochan if (err) { 62734dd1710SVadym Kochan prestera_devlink_free(sw); 628501ef306SVadym Kochan return err; 629501ef306SVadym Kochan } 630501ef306SVadym Kochan 631501ef306SVadym Kochan return 0; 632501ef306SVadym Kochan } 633501ef306SVadym Kochan EXPORT_SYMBOL(prestera_device_register); 634501ef306SVadym Kochan 635501ef306SVadym Kochan void prestera_device_unregister(struct prestera_device *dev) 636501ef306SVadym Kochan { 637501ef306SVadym Kochan struct prestera_switch *sw = dev->priv; 638501ef306SVadym Kochan 639501ef306SVadym Kochan prestera_switch_fini(sw); 64034dd1710SVadym Kochan prestera_devlink_free(sw); 641501ef306SVadym Kochan } 642501ef306SVadym Kochan EXPORT_SYMBOL(prestera_device_unregister); 643501ef306SVadym Kochan 644501ef306SVadym Kochan static int __init prestera_module_init(void) 645501ef306SVadym Kochan { 646501ef306SVadym Kochan prestera_wq = alloc_workqueue("prestera", 0, 0); 647501ef306SVadym Kochan if (!prestera_wq) 648501ef306SVadym Kochan return -ENOMEM; 649501ef306SVadym Kochan 650501ef306SVadym Kochan return 0; 651501ef306SVadym Kochan } 652501ef306SVadym Kochan 653501ef306SVadym Kochan static void __exit prestera_module_exit(void) 654501ef306SVadym Kochan { 655501ef306SVadym Kochan destroy_workqueue(prestera_wq); 656501ef306SVadym Kochan } 657501ef306SVadym Kochan 658501ef306SVadym Kochan module_init(prestera_module_init); 659501ef306SVadym Kochan module_exit(prestera_module_exit); 660501ef306SVadym Kochan 661501ef306SVadym Kochan MODULE_LICENSE("Dual BSD/GPL"); 662501ef306SVadym Kochan MODULE_DESCRIPTION("Marvell Prestera switch driver"); 663