kvaser_usb_devlink.c

 1// SPDX-License-Identifier: GPL-2.0
 2/* kvaser_usb devlink functions
 3 *
 4 * Copyright (C) 2025 KVASER AB, Sweden. All rights reserved.
 5 */
 6#include "kvaser_usb.h"
 7
 8#include <linux/netdevice.h>
 9#include <net/devlink.h>
10
11#define KVASER_USB_EAN_MSB 0x00073301
12
13static int kvaser_usb_devlink_info_get(struct devlink *devlink,
14				       struct devlink_info_req *req,
15				       struct netlink_ext_ack *extack)
16{
17	struct kvaser_usb *dev = devlink_priv(devlink);
18	char buf[] = "73301XXXXXXXXXX";
19	int ret;
20
21	if (dev->serial_number) {
22		snprintf(buf, sizeof(buf), "%u", dev->serial_number);
23		ret = devlink_info_serial_number_put(req, buf);
24		if (ret)
25			return ret;
26	}
27
28	if (dev->fw_version.major) {
29		snprintf(buf, sizeof(buf), "%u.%u.%u",
30			 dev->fw_version.major,
31			 dev->fw_version.minor,
32			 dev->fw_version.build);
33		ret = devlink_info_version_running_put(req,
34						       DEVLINK_INFO_VERSION_GENERIC_FW,
35						       buf);
36		if (ret)
37			return ret;
38	}
39
40	if (dev->hw_revision) {
41		snprintf(buf, sizeof(buf), "%u", dev->hw_revision);
42		ret = devlink_info_version_fixed_put(req,
43						     DEVLINK_INFO_VERSION_GENERIC_BOARD_REV,
44						     buf);
45		if (ret)
46			return ret;
47	}
48
49	if (dev->ean[1] == KVASER_USB_EAN_MSB) {
50		snprintf(buf, sizeof(buf), "%x%08x", dev->ean[1], dev->ean[0]);
51		ret = devlink_info_version_fixed_put(req,
52						     DEVLINK_INFO_VERSION_GENERIC_BOARD_ID,
53						     buf);
54		if (ret)
55			return ret;
56	}
57
58	return 0;
59}
60
61const struct devlink_ops kvaser_usb_devlink_ops = {
62	.info_get = kvaser_usb_devlink_info_get,
63};
64
65int kvaser_usb_devlink_port_register(struct kvaser_usb_net_priv *priv)
66{
67	int ret;
68	struct devlink_port_attrs attrs = {
69		.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL,
70		.phys.port_number = priv->channel,
71	};
72	devlink_port_attrs_set(&priv->devlink_port, &attrs);
73
74	ret = devlink_port_register(priv_to_devlink(priv->dev),
75				    &priv->devlink_port, priv->channel);
76	if (ret)
77		return ret;
78
79	SET_NETDEV_DEVLINK_PORT(priv->netdev, &priv->devlink_port);
80
81	return 0;
82}
83
84void kvaser_usb_devlink_port_unregister(struct kvaser_usb_net_priv *priv)
85{
86	devlink_port_unregister(&priv->devlink_port);
87}