ethtool: provide link state with LINKSTATE_GET request
[linux-block.git] / net / ethtool / linkstate.c
CommitLineData
3d2b847f
MK
1// SPDX-License-Identifier: GPL-2.0-only
2
3#include "netlink.h"
4#include "common.h"
5
6struct linkstate_req_info {
7 struct ethnl_req_info base;
8};
9
10struct linkstate_reply_data {
11 struct ethnl_reply_data base;
12 int link;
13};
14
15#define LINKSTATE_REPDATA(__reply_base) \
16 container_of(__reply_base, struct linkstate_reply_data, base)
17
18static const struct nla_policy
19linkstate_get_policy[ETHTOOL_A_LINKSTATE_MAX + 1] = {
20 [ETHTOOL_A_LINKSTATE_UNSPEC] = { .type = NLA_REJECT },
21 [ETHTOOL_A_LINKSTATE_HEADER] = { .type = NLA_NESTED },
22 [ETHTOOL_A_LINKSTATE_LINK] = { .type = NLA_REJECT },
23};
24
25static int linkstate_prepare_data(const struct ethnl_req_info *req_base,
26 struct ethnl_reply_data *reply_base,
27 struct genl_info *info)
28{
29 struct linkstate_reply_data *data = LINKSTATE_REPDATA(reply_base);
30 struct net_device *dev = reply_base->dev;
31 int ret;
32
33 ret = ethnl_ops_begin(dev);
34 if (ret < 0)
35 return ret;
36 data->link = __ethtool_get_link(dev);
37 ethnl_ops_complete(dev);
38
39 return 0;
40}
41
42static int linkstate_reply_size(const struct ethnl_req_info *req_base,
43 const struct ethnl_reply_data *reply_base)
44{
45 return nla_total_size(sizeof(u8)) /* LINKSTATE_LINK */
46 + 0;
47}
48
49static int linkstate_fill_reply(struct sk_buff *skb,
50 const struct ethnl_req_info *req_base,
51 const struct ethnl_reply_data *reply_base)
52{
53 struct linkstate_reply_data *data = LINKSTATE_REPDATA(reply_base);
54
55 if (data->link >= 0 &&
56 nla_put_u8(skb, ETHTOOL_A_LINKSTATE_LINK, !!data->link))
57 return -EMSGSIZE;
58
59 return 0;
60}
61
62const struct ethnl_request_ops ethnl_linkstate_request_ops = {
63 .request_cmd = ETHTOOL_MSG_LINKSTATE_GET,
64 .reply_cmd = ETHTOOL_MSG_LINKSTATE_GET_REPLY,
65 .hdr_attr = ETHTOOL_A_LINKSTATE_HEADER,
66 .max_attr = ETHTOOL_A_LINKSTATE_MAX,
67 .req_info_size = sizeof(struct linkstate_req_info),
68 .reply_data_size = sizeof(struct linkstate_reply_data),
69 .request_policy = linkstate_get_policy,
70
71 .prepare_data = linkstate_prepare_data,
72 .reply_size = linkstate_reply_size,
73 .fill_reply = linkstate_fill_reply,
74};