88 lines
2.1 KiB
C
88 lines
2.1 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* kvaser_usb devlink functions
|
|
*
|
|
* Copyright (C) 2025 KVASER AB, Sweden. All rights reserved.
|
|
*/
|
|
#include "kvaser_usb.h"
|
|
|
|
#include <linux/netdevice.h>
|
|
#include <net/devlink.h>
|
|
|
|
#define KVASER_USB_EAN_MSB 0x00073301
|
|
|
|
static int kvaser_usb_devlink_info_get(struct devlink *devlink,
|
|
struct devlink_info_req *req,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct kvaser_usb *dev = devlink_priv(devlink);
|
|
char buf[] = "73301XXXXXXXXXX";
|
|
int ret;
|
|
|
|
if (dev->serial_number) {
|
|
snprintf(buf, sizeof(buf), "%u", dev->serial_number);
|
|
ret = devlink_info_serial_number_put(req, buf);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
if (dev->fw_version.major) {
|
|
snprintf(buf, sizeof(buf), "%u.%u.%u",
|
|
dev->fw_version.major,
|
|
dev->fw_version.minor,
|
|
dev->fw_version.build);
|
|
ret = devlink_info_version_running_put(req,
|
|
DEVLINK_INFO_VERSION_GENERIC_FW,
|
|
buf);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
if (dev->hw_revision) {
|
|
snprintf(buf, sizeof(buf), "%u", dev->hw_revision);
|
|
ret = devlink_info_version_fixed_put(req,
|
|
DEVLINK_INFO_VERSION_GENERIC_BOARD_REV,
|
|
buf);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
if (dev->ean[1] == KVASER_USB_EAN_MSB) {
|
|
snprintf(buf, sizeof(buf), "%x%08x", dev->ean[1], dev->ean[0]);
|
|
ret = devlink_info_version_fixed_put(req,
|
|
DEVLINK_INFO_VERSION_GENERIC_BOARD_ID,
|
|
buf);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
const struct devlink_ops kvaser_usb_devlink_ops = {
|
|
.info_get = kvaser_usb_devlink_info_get,
|
|
};
|
|
|
|
int kvaser_usb_devlink_port_register(struct kvaser_usb_net_priv *priv)
|
|
{
|
|
int ret;
|
|
struct devlink_port_attrs attrs = {
|
|
.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL,
|
|
.phys.port_number = priv->channel,
|
|
};
|
|
devlink_port_attrs_set(&priv->devlink_port, &attrs);
|
|
|
|
ret = devlink_port_register(priv_to_devlink(priv->dev),
|
|
&priv->devlink_port, priv->channel);
|
|
if (ret)
|
|
return ret;
|
|
|
|
SET_NETDEV_DEVLINK_PORT(priv->netdev, &priv->devlink_port);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void kvaser_usb_devlink_port_unregister(struct kvaser_usb_net_priv *priv)
|
|
{
|
|
devlink_port_unregister(&priv->devlink_port);
|
|
}
|