LXR linux/drivers/net/ethernet/marvell/prestera/prestera

   1// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
   2/* Copyright (c) 2019-2020 Marvell International Ltd. All rights reserved */
   3
   4#include <net/devlink.h>
   5
   6#include "prestera_devlink.h"
   7
   8static int prestera_dl_info_get(struct devlink *dl,
   9                                struct devlink_info_req *req,
  10                                struct netlink_ext_ack *extack)
  11{
  12        struct prestera_switch *sw = devlink_priv(dl);
  13        char buf[16];
  14        int err;
  15
  16        err = devlink_info_driver_name_put(req, PRESTERA_DRV_NAME);
  17        if (err)
  18                return err;
  19
  20        snprintf(buf, sizeof(buf), "%d.%d.%d",
  21                 sw->dev->fw_rev.maj,
  22                 sw->dev->fw_rev.min,
  23                 sw->dev->fw_rev.sub);
  24
  25        return devlink_info_version_running_put(req,
  26                                               DEVLINK_INFO_VERSION_GENERIC_FW,
  27                                               buf);
  28}
  29
  30static const struct devlink_ops prestera_dl_ops = {
  31        .info_get = prestera_dl_info_get,
  32};
  33
  34struct prestera_switch *prestera_devlink_alloc(void)
  35{
  36        struct devlink *dl;
  37
  38        dl = devlink_alloc(&prestera_dl_ops, sizeof(struct prestera_switch));
  39
  40        return devlink_priv(dl);
  41}
  42
  43void prestera_devlink_free(struct prestera_switch *sw)
  44{
  45        struct devlink *dl = priv_to_devlink(sw);
  46
  47        devlink_free(dl);
  48}
  49
  50int prestera_devlink_register(struct prestera_switch *sw)
  51{
  52        struct devlink *dl = priv_to_devlink(sw);
  53        int err;
  54
  55        err = devlink_register(dl, sw->dev->dev);
  56        if (err)
  57                dev_err(prestera_dev(sw), "devlink_register failed: %d\n", err);
  58
  59        return err;
  60}
  61
  62void prestera_devlink_unregister(struct prestera_switch *sw)
  63{
  64        struct devlink *dl = priv_to_devlink(sw);
  65
  66        devlink_unregister(dl);
  67}
  68
  69int prestera_devlink_port_register(struct prestera_port *port)
  70{
  71        struct prestera_switch *sw = port->sw;
  72        struct devlink *dl = priv_to_devlink(sw);
  73        struct devlink_port_attrs attrs = {};
  74        int err;
  75
  76        attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;
  77        attrs.phys.port_number = port->fp_id;
  78        attrs.switch_id.id_len = sizeof(sw->id);
  79        memcpy(attrs.switch_id.id, &sw->id, attrs.switch_id.id_len);
  80
  81        devlink_port_attrs_set(&port->dl_port, &attrs);
  82
  83        err = devlink_port_register(dl, &port->dl_port, port->fp_id);
  84        if (err) {
  85                dev_err(prestera_dev(sw), "devlink_port_register failed: %d\n", err);
  86                return err;
  87        }
  88
  89        return 0;
  90}
  91
  92void prestera_devlink_port_unregister(struct prestera_port *port)
  93{
  94        devlink_port_unregister(&port->dl_port);
  95}
  96
  97void prestera_devlink_port_set(struct prestera_port *port)
  98{
  99        devlink_port_type_eth_set(&port->dl_port, port->dev);
 100}
 101
 102void prestera_devlink_port_clear(struct prestera_port *port)
 103{
 104        devlink_port_type_clear(&port->dl_port);
 105}
 106
 107struct devlink_port *prestera_devlink_get_port(struct net_device *dev)
 108{
 109        struct prestera_port *port = netdev_priv(dev);
 110
 111        return &port->dl_port;
 112}
 113