mlxsw: switchib: Introduce SwitchIB and SwitchIB silicon driver
authorElad Raz <eladr@mellanox.com>
Fri, 28 Oct 2016 19:36:01 +0000 (21:36 +0200)
committerDavid S. Miller <davem@davemloft.net>
Sun, 30 Oct 2016 20:50:17 +0000 (16:50 -0400)
SwitchIB and SwitchIB-2 are Infiniband switches with up to 36 ports. This
driver initialize the hardware and Firmware which implements the IB
management and connection with the SM.

Signed-off-by: Elad Raz <eladr@mellanox.com>
Signed-off-by: Jiri Pirko <jiri@mellanox.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/ethernet/mellanox/mlxsw/Kconfig
drivers/net/ethernet/mellanox/mlxsw/Makefile
drivers/net/ethernet/mellanox/mlxsw/pci.h
drivers/net/ethernet/mellanox/mlxsw/port.h
drivers/net/ethernet/mellanox/mlxsw/switchib.c [new file with mode: 0644]

index d0bcf59..bac2e5e 100644 (file)
@@ -29,6 +29,17 @@ config MLXSW_PCI
          To compile this driver as a module, choose M here: the
          module will be called mlxsw_pci.
 
+config MLXSW_SWITCHIB
+       tristate "Mellanox Technologies SwitchIB and SwitchIB-2 support"
+       depends on MLXSW_CORE && NET_SWITCHDEV
+       default m
+       ---help---
+         This driver supports Mellanox Technologies SwitchIB and SwitchIB-2
+         Infiniband Switch ASICs.
+
+         To compile this driver as a module, choose M here: the
+         module will be called mlxsw_switchib.
+
 config MLXSW_SWITCHX2
        tristate "Mellanox Technologies SwitchX-2 support"
        depends on MLXSW_CORE && MLXSW_PCI && NET_SWITCHDEV
index d20ae18..badef87 100644 (file)
@@ -3,6 +3,8 @@ mlxsw_core-objs                 := core.o
 mlxsw_core-$(CONFIG_MLXSW_CORE_HWMON) += core_hwmon.o
 obj-$(CONFIG_MLXSW_PCI)                += mlxsw_pci.o
 mlxsw_pci-objs                 := pci.o
+obj-$(CONFIG_MLXSW_SWITCHIB)   += mlxsw_switchib.o
+mlxsw_switchib-objs            := switchib.o
 obj-$(CONFIG_MLXSW_SWITCHX2)   += mlxsw_switchx2.o
 mlxsw_switchx2-objs            := switchx2.o
 obj-$(CONFIG_MLXSW_SPECTRUM)   += mlxsw_spectrum.o
index 35a0011..d655823 100644 (file)
@@ -39,6 +39,8 @@
 
 #define PCI_DEVICE_ID_MELLANOX_SWITCHX2                0xc738
 #define PCI_DEVICE_ID_MELLANOX_SPECTRUM                0xcb84
+#define PCI_DEVICE_ID_MELLANOX_SWITCHIB                0xcb20
+#define PCI_DEVICE_ID_MELLANOX_SWITCHIB2       0xcf08
 
 #if IS_ENABLED(CONFIG_MLXSW_PCI)
 
index 7296071..3d42146 100644 (file)
@@ -52,6 +52,9 @@
 #define MLXSW_PORT_MAX_PHY_PORTS       0x40
 #define MLXSW_PORT_MAX_PORTS           (MLXSW_PORT_MAX_PHY_PORTS + 1)
 
+#define MLXSW_PORT_MAX_IB_PHY_PORTS    36
+#define MLXSW_PORT_MAX_IB_PORTS                (MLXSW_PORT_MAX_IB_PHY_PORTS + 1)
+
 #define MLXSW_PORT_DEVID_BITS_OFFSET   10
 #define MLXSW_PORT_PHY_BITS_OFFSET     4
 #define MLXSW_PORT_PHY_BITS_MASK       (MLXSW_PORT_MAX_PHY_PORTS - 1)
diff --git a/drivers/net/ethernet/mellanox/mlxsw/switchib.c b/drivers/net/ethernet/mellanox/mlxsw/switchib.c
new file mode 100644 (file)
index 0000000..ec0b27e
--- /dev/null
@@ -0,0 +1,598 @@
+/*
+ * drivers/net/ethernet/mellanox/mlxsw/switchib.c
+ * Copyright (c) 2016 Mellanox Technologies. All rights reserved.
+ * Copyright (c) 2016 Elad Raz <eladr@mellanox.com>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ * 3. Neither the names of the copyright holders nor the names of its
+ *    contributors may be used to endorse or promote products derived from
+ *    this software without specific prior written permission.
+ *
+ * Alternatively, this software may be distributed under the terms of the
+ * GNU General Public License ("GPL") version 2 as published by the Free
+ * Software Foundation.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/types.h>
+#include <linux/pci.h>
+#include <linux/netdevice.h>
+#include <linux/etherdevice.h>
+#include <linux/slab.h>
+#include <linux/device.h>
+#include <linux/skbuff.h>
+#include <linux/if_vlan.h>
+#include <net/switchdev.h>
+#include <generated/utsrelease.h>
+
+#include "pci.h"
+#include "core.h"
+#include "reg.h"
+#include "port.h"
+#include "trap.h"
+#include "txheader.h"
+#include "ib.h"
+
+static const char mlxsw_sib_driver_name[] = "mlxsw_switchib";
+static const char mlxsw_sib2_driver_name[] = "mlxsw_switchib2";
+
+struct mlxsw_sib_port;
+
+struct mlxsw_sib {
+       struct mlxsw_sib_port **ports;
+       struct mlxsw_core *core;
+       const struct mlxsw_bus_info *bus_info;
+};
+
+struct mlxsw_sib_port {
+       struct mlxsw_sib *mlxsw_sib;
+       u8 local_port;
+       struct {
+               u8 module;
+       } mapping;
+};
+
+/* tx_v1_hdr_version
+ * Tx header version.
+ * Must be set to 1.
+ */
+MLXSW_ITEM32(tx_v1, hdr, version, 0x00, 28, 4);
+
+/* tx_v1_hdr_ctl
+ * Packet control type.
+ * 0 - Ethernet control (e.g. EMADs, LACP)
+ * 1 - Ethernet data
+ */
+MLXSW_ITEM32(tx_v1, hdr, ctl, 0x00, 26, 2);
+
+/* tx_v1_hdr_proto
+ * Packet protocol type. Must be set to 1 (Ethernet).
+ */
+MLXSW_ITEM32(tx_v1, hdr, proto, 0x00, 21, 3);
+
+/* tx_v1_hdr_swid
+ * Switch partition ID. Must be set to 0.
+ */
+MLXSW_ITEM32(tx_v1, hdr, swid, 0x00, 12, 3);
+
+/* tx_v1_hdr_control_tclass
+ * Indicates if the packet should use the control TClass and not one
+ * of the data TClasses.
+ */
+MLXSW_ITEM32(tx_v1, hdr, control_tclass, 0x00, 6, 1);
+
+/* tx_v1_hdr_port_mid
+ * Destination local port for unicast packets.
+ * Destination multicast ID for multicast packets.
+ *
+ * Control packets are directed to a specific egress port, while data
+ * packets are transmitted through the CPU port (0) into the switch partition,
+ * where forwarding rules are applied.
+ */
+MLXSW_ITEM32(tx_v1, hdr, port_mid, 0x04, 16, 16);
+
+/* tx_v1_hdr_type
+ * 0 - Data packets
+ * 6 - Control packets
+ */
+MLXSW_ITEM32(tx_v1, hdr, type, 0x0C, 0, 4);
+
+static void
+mlxsw_sib_tx_v1_hdr_construct(struct sk_buff *skb,
+                             const struct mlxsw_tx_info *tx_info)
+{
+       char *txhdr = skb_push(skb, MLXSW_TXHDR_LEN);
+
+       memset(txhdr, 0, MLXSW_TXHDR_LEN);
+
+       mlxsw_tx_v1_hdr_version_set(txhdr, MLXSW_TXHDR_VERSION_1);
+       mlxsw_tx_v1_hdr_ctl_set(txhdr, MLXSW_TXHDR_ETH_CTL);
+       mlxsw_tx_v1_hdr_proto_set(txhdr, MLXSW_TXHDR_PROTO_ETH);
+       mlxsw_tx_v1_hdr_swid_set(txhdr, 0);
+       mlxsw_tx_v1_hdr_control_tclass_set(txhdr, 1);
+       mlxsw_tx_v1_hdr_port_mid_set(txhdr, tx_info->local_port);
+       mlxsw_tx_v1_hdr_type_set(txhdr, MLXSW_TXHDR_TYPE_CONTROL);
+}
+
+static int
+mlxsw_sib_port_admin_status_set(struct mlxsw_sib_port *mlxsw_sib_port,
+                               bool is_up)
+{
+       struct mlxsw_sib *mlxsw_sib = mlxsw_sib_port->mlxsw_sib;
+       char paos_pl[MLXSW_REG_PAOS_LEN];
+
+       mlxsw_reg_paos_pack(paos_pl, mlxsw_sib_port->local_port,
+                           is_up ? MLXSW_PORT_ADMIN_STATUS_UP :
+                           MLXSW_PORT_ADMIN_STATUS_DOWN);
+       return mlxsw_reg_write(mlxsw_sib->core, MLXSW_REG(paos), paos_pl);
+}
+
+static int mlxsw_sib_port_mtu_set(struct mlxsw_sib_port *mlxsw_sib_port,
+                                 u16 mtu)
+{
+       struct mlxsw_sib *mlxsw_sib = mlxsw_sib_port->mlxsw_sib;
+       char pmtu_pl[MLXSW_REG_PMTU_LEN];
+       int max_mtu;
+       int err;
+
+       mlxsw_reg_pmtu_pack(pmtu_pl, mlxsw_sib_port->local_port, 0);
+       err = mlxsw_reg_query(mlxsw_sib->core, MLXSW_REG(pmtu), pmtu_pl);
+       if (err)
+               return err;
+       max_mtu = mlxsw_reg_pmtu_max_mtu_get(pmtu_pl);
+
+       if (mtu > max_mtu)
+               return -EINVAL;
+
+       mlxsw_reg_pmtu_pack(pmtu_pl, mlxsw_sib_port->local_port, mtu);
+       return mlxsw_reg_write(mlxsw_sib->core, MLXSW_REG(pmtu), pmtu_pl);
+}
+
+static int mlxsw_sib_port_set(struct mlxsw_sib_port *mlxsw_sib_port, u8 port)
+{
+       struct mlxsw_sib *mlxsw_sib = mlxsw_sib_port->mlxsw_sib;
+       char plib_pl[MLXSW_REG_PLIB_LEN] = {0};
+       int err;
+
+       mlxsw_reg_plib_local_port_set(plib_pl, mlxsw_sib_port->local_port);
+       mlxsw_reg_plib_ib_port_set(plib_pl, port);
+       err = mlxsw_reg_write(mlxsw_sib->core, MLXSW_REG(plib), plib_pl);
+       return err;
+}
+
+static int mlxsw_sib_port_swid_set(struct mlxsw_sib_port *mlxsw_sib_port,
+                                  u8 swid)
+{
+       struct mlxsw_sib *mlxsw_sib = mlxsw_sib_port->mlxsw_sib;
+       char pspa_pl[MLXSW_REG_PSPA_LEN];
+
+       mlxsw_reg_pspa_pack(pspa_pl, swid, mlxsw_sib_port->local_port);
+       return mlxsw_reg_write(mlxsw_sib->core, MLXSW_REG(pspa), pspa_pl);
+}
+
+static int mlxsw_sib_port_module_info_get(struct mlxsw_sib *mlxsw_sib,
+                                         u8 local_port, u8 *p_module,
+                                         u8 *p_width)
+{
+       char pmlp_pl[MLXSW_REG_PMLP_LEN];
+       int err;
+
+       mlxsw_reg_pmlp_pack(pmlp_pl, local_port);
+       err = mlxsw_reg_query(mlxsw_sib->core, MLXSW_REG(pmlp), pmlp_pl);
+       if (err)
+               return err;
+       *p_module = mlxsw_reg_pmlp_module_get(pmlp_pl, 0);
+       *p_width = mlxsw_reg_pmlp_width_get(pmlp_pl);
+       return 0;
+}
+
+static int mlxsw_sib_port_speed_set(struct mlxsw_sib_port *mlxsw_sib_port,
+                                   u16 speed, u16 width)
+{
+       struct mlxsw_sib *mlxsw_sib = mlxsw_sib_port->mlxsw_sib;
+       char ptys_pl[MLXSW_REG_PTYS_LEN];
+
+       mlxsw_reg_ptys_ib_pack(ptys_pl, mlxsw_sib_port->local_port, speed,
+                              width);
+       return mlxsw_reg_write(mlxsw_sib->core, MLXSW_REG(ptys), ptys_pl);
+}
+
+static bool mlxsw_sib_port_created(struct mlxsw_sib *mlxsw_sib, u8 local_port)
+{
+       return mlxsw_sib->ports[local_port] != NULL;
+}
+
+static int __mlxsw_sib_port_create(struct mlxsw_sib *mlxsw_sib, u8 local_port,
+                                  u8 module, u8 width)
+{
+       struct mlxsw_sib_port *mlxsw_sib_port;
+       int err;
+
+       mlxsw_sib_port = kzalloc(sizeof(*mlxsw_sib_port), GFP_KERNEL);
+       if (!mlxsw_sib_port)
+               return -ENOMEM;
+       mlxsw_sib_port->mlxsw_sib = mlxsw_sib;
+       mlxsw_sib_port->local_port = local_port;
+       mlxsw_sib_port->mapping.module = module;
+
+       err = mlxsw_sib_port_swid_set(mlxsw_sib_port, 0);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Port %d: Failed to set SWID\n",
+                       mlxsw_sib_port->local_port);
+               goto err_port_swid_set;
+       }
+
+       /* Expose the IB port number as it's front panel name */
+       err = mlxsw_sib_port_set(mlxsw_sib_port, module + 1);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Port %d: Failed to set IB port\n",
+                       mlxsw_sib_port->local_port);
+               goto err_port_ib_set;
+       }
+
+       /* Supports all speeds from SDR to FDR (bitmask) and support bus width
+        * of 1x, 2x and 4x (3 bits bitmask)
+        */
+       err = mlxsw_sib_port_speed_set(mlxsw_sib_port,
+                                      MLXSW_REG_PTYS_IB_SPEED_EDR - 1,
+                                      BIT(3) - 1);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Port %d: Failed to set speed\n",
+                       mlxsw_sib_port->local_port);
+               goto err_port_speed_set;
+       }
+
+       /* Change to the maximum MTU the device supports, the SMA will take
+        * care of the active MTU
+        */
+       err = mlxsw_sib_port_mtu_set(mlxsw_sib_port, MLXSW_IB_DEFAULT_MTU);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Port %d: Failed to set MTU\n",
+                       mlxsw_sib_port->local_port);
+               goto err_port_mtu_set;
+       }
+
+       err = mlxsw_sib_port_admin_status_set(mlxsw_sib_port, true);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Port %d: Failed to change admin state to UP\n",
+                       mlxsw_sib_port->local_port);
+               goto err_port_admin_set;
+       }
+
+       mlxsw_core_port_ib_set(mlxsw_sib->core, mlxsw_sib_port->local_port,
+                              mlxsw_sib_port);
+       mlxsw_sib->ports[local_port] = mlxsw_sib_port;
+       return 0;
+
+err_port_admin_set:
+err_port_mtu_set:
+err_port_speed_set:
+err_port_ib_set:
+       mlxsw_sib_port_swid_set(mlxsw_sib_port, MLXSW_PORT_SWID_DISABLED_PORT);
+err_port_swid_set:
+       kfree(mlxsw_sib_port);
+       return err;
+}
+
+static int mlxsw_sib_port_create(struct mlxsw_sib *mlxsw_sib, u8 local_port,
+                                u8 module, u8 width)
+{
+       int err;
+
+       err = mlxsw_core_port_init(mlxsw_sib->core, local_port);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Port %d: Failed to init core port\n",
+                       local_port);
+               return err;
+       }
+       err = __mlxsw_sib_port_create(mlxsw_sib, local_port, module, width);
+       if (err)
+               goto err_port_create;
+
+       return 0;
+
+err_port_create:
+       mlxsw_core_port_fini(mlxsw_sib->core, local_port);
+       return err;
+}
+
+static void __mlxsw_sib_port_remove(struct mlxsw_sib *mlxsw_sib, u8 local_port)
+{
+       struct mlxsw_sib_port *mlxsw_sib_port = mlxsw_sib->ports[local_port];
+
+       mlxsw_core_port_clear(mlxsw_sib->core, local_port, mlxsw_sib);
+       mlxsw_sib->ports[local_port] = NULL;
+       mlxsw_sib_port_admin_status_set(mlxsw_sib_port, false);
+       mlxsw_sib_port_swid_set(mlxsw_sib_port, MLXSW_PORT_SWID_DISABLED_PORT);
+       kfree(mlxsw_sib_port);
+}
+
+static void mlxsw_sib_port_remove(struct mlxsw_sib *mlxsw_sib, u8 local_port)
+{
+       __mlxsw_sib_port_remove(mlxsw_sib, local_port);
+       mlxsw_core_port_fini(mlxsw_sib->core, local_port);
+}
+
+static void mlxsw_sib_ports_remove(struct mlxsw_sib *mlxsw_sib)
+{
+       int i;
+
+       for (i = 1; i < MLXSW_PORT_MAX_IB_PORTS; i++)
+               if (mlxsw_sib_port_created(mlxsw_sib, i))
+                       mlxsw_sib_port_remove(mlxsw_sib, i);
+       kfree(mlxsw_sib->ports);
+}
+
+static int mlxsw_sib_ports_create(struct mlxsw_sib *mlxsw_sib)
+{
+       size_t alloc_size;
+       u8 module, width;
+       int i;
+       int err;
+
+       alloc_size = sizeof(struct mlxsw_sib_port *) * MLXSW_PORT_MAX_IB_PORTS;
+       mlxsw_sib->ports = kzalloc(alloc_size, GFP_KERNEL);
+       if (!mlxsw_sib->ports)
+               return -ENOMEM;
+
+       for (i = 1; i < MLXSW_PORT_MAX_IB_PORTS; i++) {
+               err = mlxsw_sib_port_module_info_get(mlxsw_sib, i, &module,
+                                                    &width);
+               if (err)
+                       goto err_port_module_info_get;
+               if (!width)
+                       continue;
+               err = mlxsw_sib_port_create(mlxsw_sib, i, module, width);
+               if (err)
+                       goto err_port_create;
+       }
+       return 0;
+
+err_port_create:
+err_port_module_info_get:
+       for (i--; i >= 1; i--)
+               if (mlxsw_sib_port_created(mlxsw_sib, i))
+                       mlxsw_sib_port_remove(mlxsw_sib, i);
+       kfree(mlxsw_sib->ports);
+       return err;
+}
+
+static void
+mlxsw_sib_pude_ib_event_func(struct mlxsw_sib_port *mlxsw_sib_port,
+                            enum mlxsw_reg_pude_oper_status status)
+{
+       if (status == MLXSW_PORT_OPER_STATUS_UP)
+               pr_info("ib link for port %d - up\n",
+                       mlxsw_sib_port->mapping.module + 1);
+       else
+               pr_info("ib link for port %d - down\n",
+                       mlxsw_sib_port->mapping.module + 1);
+}
+
+static void mlxsw_sib_pude_event_func(const struct mlxsw_reg_info *reg,
+                                     char *pude_pl, void *priv)
+{
+       struct mlxsw_sib *mlxsw_sib = priv;
+       struct mlxsw_sib_port *mlxsw_sib_port;
+       enum mlxsw_reg_pude_oper_status status;
+       u8 local_port;
+
+       local_port = mlxsw_reg_pude_local_port_get(pude_pl);
+       mlxsw_sib_port = mlxsw_sib->ports[local_port];
+       if (!mlxsw_sib_port) {
+               dev_warn(mlxsw_sib->bus_info->dev, "Port %d: Link event received for non-existent port\n",
+                        local_port);
+               return;
+       }
+
+       status = mlxsw_reg_pude_oper_status_get(pude_pl);
+       mlxsw_sib_pude_ib_event_func(mlxsw_sib_port, status);
+}
+
+static struct mlxsw_event_listener mlxsw_sib_pude_event = {
+       .func = mlxsw_sib_pude_event_func,
+       .trap_id = MLXSW_TRAP_ID_PUDE,
+};
+
+static int mlxsw_sib_event_register(struct mlxsw_sib *mlxsw_sib,
+                                   enum mlxsw_event_trap_id trap_id)
+{
+       struct mlxsw_event_listener *el;
+       char hpkt_pl[MLXSW_REG_HPKT_LEN];
+       int err;
+
+       switch (trap_id) {
+       case MLXSW_TRAP_ID_PUDE:
+               el = &mlxsw_sib_pude_event;
+               break;
+       }
+       err = mlxsw_core_event_listener_register(mlxsw_sib->core, el,
+                                                mlxsw_sib);
+       if (err)
+               return err;
+
+       mlxsw_reg_hpkt_pack(hpkt_pl, MLXSW_REG_HPKT_ACTION_FORWARD, trap_id);
+       err = mlxsw_reg_write(mlxsw_sib->core, MLXSW_REG(hpkt), hpkt_pl);
+       if (err)
+               goto err_event_trap_set;
+
+       return 0;
+
+err_event_trap_set:
+       mlxsw_core_event_listener_unregister(mlxsw_sib->core, el, mlxsw_sib);
+       return err;
+}
+
+static void mlxsw_sib_event_unregister(struct mlxsw_sib *mlxsw_sib,
+                                      enum mlxsw_event_trap_id trap_id)
+{
+       struct mlxsw_event_listener *el;
+
+       switch (trap_id) {
+       case MLXSW_TRAP_ID_PUDE:
+               el = &mlxsw_sib_pude_event;
+               break;
+       }
+       mlxsw_core_event_listener_unregister(mlxsw_sib->core, el, mlxsw_sib);
+}
+
+static int mlxsw_sib_init(struct mlxsw_core *mlxsw_core,
+                         const struct mlxsw_bus_info *mlxsw_bus_info)
+{
+       struct mlxsw_sib *mlxsw_sib = mlxsw_core_driver_priv(mlxsw_core);
+       int err;
+
+       mlxsw_sib->core = mlxsw_core;
+       mlxsw_sib->bus_info = mlxsw_bus_info;
+
+       err = mlxsw_sib_ports_create(mlxsw_sib);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Failed to create ports\n");
+               return err;
+       }
+
+       err = mlxsw_sib_event_register(mlxsw_sib, MLXSW_TRAP_ID_PUDE);
+       if (err) {
+               dev_err(mlxsw_sib->bus_info->dev, "Failed to register for PUDE events\n");
+               goto err_event_register;
+       }
+
+       return 0;
+
+err_event_register:
+       mlxsw_sib_ports_remove(mlxsw_sib);
+       return err;
+}
+
+static void mlxsw_sib_fini(struct mlxsw_core *mlxsw_core)
+{
+       struct mlxsw_sib *mlxsw_sib = mlxsw_core_driver_priv(mlxsw_core);
+
+       mlxsw_sib_event_unregister(mlxsw_sib, MLXSW_TRAP_ID_PUDE);
+       mlxsw_sib_ports_remove(mlxsw_sib);
+}
+
+static struct mlxsw_config_profile mlxsw_sib_config_profile = {
+       .used_max_system_port           = 1,
+       .max_system_port                = 48000,
+       .used_max_ib_mc                 = 1,
+       .max_ib_mc                      = 27,
+       .used_max_pkey                  = 1,
+       .max_pkey                       = 32,
+       .swid_config                    = {
+               {
+                       .used_type      = 1,
+                       .type           = MLXSW_PORT_SWID_TYPE_IB,
+               }
+       },
+       .resource_query_enable          = 0,
+};
+
+static struct mlxsw_driver mlxsw_sib_driver = {
+       .kind                   = mlxsw_sib_driver_name,
+       .priv_size              = sizeof(struct mlxsw_sib),
+       .init                   = mlxsw_sib_init,
+       .fini                   = mlxsw_sib_fini,
+       .txhdr_construct        = mlxsw_sib_tx_v1_hdr_construct,
+       .txhdr_len              = MLXSW_TXHDR_LEN,
+       .profile                = &mlxsw_sib_config_profile,
+};
+
+static struct mlxsw_driver mlxsw_sib2_driver = {
+       .kind                   = mlxsw_sib2_driver_name,
+       .priv_size              = sizeof(struct mlxsw_sib),
+       .init                   = mlxsw_sib_init,
+       .fini                   = mlxsw_sib_fini,
+       .txhdr_construct        = mlxsw_sib_tx_v1_hdr_construct,
+       .txhdr_len              = MLXSW_TXHDR_LEN,
+       .profile                = &mlxsw_sib_config_profile,
+};
+
+static const struct pci_device_id mlxsw_sib_pci_id_table[] = {
+       {PCI_VDEVICE(MELLANOX, PCI_DEVICE_ID_MELLANOX_SWITCHIB), 0},
+       {0, },
+};
+
+static struct pci_driver mlxsw_sib_pci_driver = {
+       .name = mlxsw_sib_driver_name,
+       .id_table = mlxsw_sib_pci_id_table,
+};
+
+static const struct pci_device_id mlxsw_sib2_pci_id_table[] = {
+       {PCI_VDEVICE(MELLANOX, PCI_DEVICE_ID_MELLANOX_SWITCHIB2), 0},
+       {0, },
+};
+
+static struct pci_driver mlxsw_sib2_pci_driver = {
+       .name = mlxsw_sib2_driver_name,
+       .id_table = mlxsw_sib2_pci_id_table,
+};
+
+static int __init mlxsw_sib_module_init(void)
+{
+       int err;
+
+       err = mlxsw_core_driver_register(&mlxsw_sib_driver);
+       if (err)
+               return err;
+
+       err = mlxsw_core_driver_register(&mlxsw_sib2_driver);
+       if (err)
+               goto err_sib2_driver_register;
+
+       err = mlxsw_pci_driver_register(&mlxsw_sib_pci_driver);
+       if (err)
+               goto err_sib_pci_driver_register;
+
+       err = mlxsw_pci_driver_register(&mlxsw_sib2_pci_driver);
+       if (err)
+               goto err_sib2_pci_driver_register;
+
+       return 0;
+
+err_sib2_pci_driver_register:
+       mlxsw_pci_driver_unregister(&mlxsw_sib_pci_driver);
+err_sib_pci_driver_register:
+       mlxsw_core_driver_unregister(&mlxsw_sib2_driver);
+err_sib2_driver_register:
+       mlxsw_core_driver_unregister(&mlxsw_sib_driver);
+       return err;
+}
+
+static void __exit mlxsw_sib_module_exit(void)
+{
+       mlxsw_pci_driver_unregister(&mlxsw_sib2_pci_driver);
+       mlxsw_pci_driver_unregister(&mlxsw_sib_pci_driver);
+       mlxsw_core_driver_unregister(&mlxsw_sib2_driver);
+       mlxsw_core_driver_unregister(&mlxsw_sib_driver);
+}
+
+module_init(mlxsw_sib_module_init);
+module_exit(mlxsw_sib_module_exit);
+
+MODULE_LICENSE("Dual BSD/GPL");
+MODULE_AUTHOR("Elad Raz <eladr@@mellanox.com>");
+MODULE_DESCRIPTION("Mellanox SwitchIB and SwitchIB-2 driver");
+MODULE_ALIAS("mlxsw_switchib2");
+MODULE_DEVICE_TABLE(pci, mlxsw_sib_pci_id_table);
+MODULE_DEVICE_TABLE(pci, mlxsw_sib2_pci_id_table);