1 // SPDX-License-Identifier: GPL-2.0-only
2
3 #include "netlink.h"
4 #include "common.h"
5
6 struct linkinfo_req_info {
7 struct ethnl_req_info base;
8 };
9
10 struct linkinfo_reply_data {
11 struct ethnl_reply_data base;
12 struct ethtool_link_ksettings ksettings;
13 struct ethtool_link_settings *lsettings;
14 };
15
16 #define LINKINFO_REPDATA(__reply_base) \
17 container_of(__reply_base, struct linkinfo_reply_data, base)
18
19 const struct nla_policy ethnl_linkinfo_get_policy[] = {
20 [ETHTOOL_A_LINKINFO_HEADER] =
21 NLA_POLICY_NESTED(ethnl_header_policy),
22 };
23
linkinfo_prepare_data(const struct ethnl_req_info * req_base,struct ethnl_reply_data * reply_base,struct genl_info * info)24 static int linkinfo_prepare_data(const struct ethnl_req_info *req_base,
25 struct ethnl_reply_data *reply_base,
26 struct genl_info *info)
27 {
28 struct linkinfo_reply_data *data = LINKINFO_REPDATA(reply_base);
29 struct net_device *dev = reply_base->dev;
30 int ret;
31
32 data->lsettings = &data->ksettings.base;
33
34 ret = ethnl_ops_begin(dev);
35 if (ret < 0)
36 return ret;
37 ret = __ethtool_get_link_ksettings(dev, &data->ksettings);
38 if (ret < 0 && info)
39 GENL_SET_ERR_MSG(info, "failed to retrieve link settings");
40 ethnl_ops_complete(dev);
41
42 return ret;
43 }
44
linkinfo_reply_size(const struct ethnl_req_info * req_base,const struct ethnl_reply_data * reply_base)45 static int linkinfo_reply_size(const struct ethnl_req_info *req_base,
46 const struct ethnl_reply_data *reply_base)
47 {
48 return nla_total_size(sizeof(u8)) /* LINKINFO_PORT */
49 + nla_total_size(sizeof(u8)) /* LINKINFO_PHYADDR */
50 + nla_total_size(sizeof(u8)) /* LINKINFO_TP_MDIX */
51 + nla_total_size(sizeof(u8)) /* LINKINFO_TP_MDIX_CTRL */
52 + nla_total_size(sizeof(u8)) /* LINKINFO_TRANSCEIVER */
53 + 0;
54 }
55
linkinfo_fill_reply(struct sk_buff * skb,const struct ethnl_req_info * req_base,const struct ethnl_reply_data * reply_base)56 static int linkinfo_fill_reply(struct sk_buff *skb,
57 const struct ethnl_req_info *req_base,
58 const struct ethnl_reply_data *reply_base)
59 {
60 const struct linkinfo_reply_data *data = LINKINFO_REPDATA(reply_base);
61
62 if (nla_put_u8(skb, ETHTOOL_A_LINKINFO_PORT, data->lsettings->port) ||
63 nla_put_u8(skb, ETHTOOL_A_LINKINFO_PHYADDR,
64 data->lsettings->phy_address) ||
65 nla_put_u8(skb, ETHTOOL_A_LINKINFO_TP_MDIX,
66 data->lsettings->eth_tp_mdix) ||
67 nla_put_u8(skb, ETHTOOL_A_LINKINFO_TP_MDIX_CTRL,
68 data->lsettings->eth_tp_mdix_ctrl) ||
69 nla_put_u8(skb, ETHTOOL_A_LINKINFO_TRANSCEIVER,
70 data->lsettings->transceiver))
71 return -EMSGSIZE;
72
73 return 0;
74 }
75
76 /* LINKINFO_SET */
77
78 const struct nla_policy ethnl_linkinfo_set_policy[] = {
79 [ETHTOOL_A_LINKINFO_HEADER] =
80 NLA_POLICY_NESTED(ethnl_header_policy),
81 [ETHTOOL_A_LINKINFO_PORT] = { .type = NLA_U8 },
82 [ETHTOOL_A_LINKINFO_PHYADDR] = { .type = NLA_U8 },
83 [ETHTOOL_A_LINKINFO_TP_MDIX_CTRL] = { .type = NLA_U8 },
84 };
85
86 static int
ethnl_set_linkinfo_validate(struct ethnl_req_info * req_info,struct genl_info * info)87 ethnl_set_linkinfo_validate(struct ethnl_req_info *req_info,
88 struct genl_info *info)
89 {
90 const struct ethtool_ops *ops = req_info->dev->ethtool_ops;
91
92 if (!ops->get_link_ksettings || !ops->set_link_ksettings)
93 return -EOPNOTSUPP;
94 return 1;
95 }
96
97 static int
ethnl_set_linkinfo(struct ethnl_req_info * req_info,struct genl_info * info)98 ethnl_set_linkinfo(struct ethnl_req_info *req_info, struct genl_info *info)
99 {
100 struct ethtool_link_ksettings ksettings = {};
101 struct ethtool_link_settings *lsettings;
102 struct net_device *dev = req_info->dev;
103 struct nlattr **tb = info->attrs;
104 bool mod = false;
105 int ret;
106
107 ret = __ethtool_get_link_ksettings(dev, &ksettings);
108 if (ret < 0) {
109 GENL_SET_ERR_MSG(info, "failed to retrieve link settings");
110 return ret;
111 }
112 lsettings = &ksettings.base;
113
114 ethnl_update_u8(&lsettings->port, tb[ETHTOOL_A_LINKINFO_PORT], &mod);
115 ethnl_update_u8(&lsettings->phy_address, tb[ETHTOOL_A_LINKINFO_PHYADDR],
116 &mod);
117 ethnl_update_u8(&lsettings->eth_tp_mdix_ctrl,
118 tb[ETHTOOL_A_LINKINFO_TP_MDIX_CTRL], &mod);
119 if (!mod)
120 return 0;
121
122 ret = dev->ethtool_ops->set_link_ksettings(dev, &ksettings);
123 if (ret < 0) {
124 GENL_SET_ERR_MSG(info, "link settings update failed");
125 return ret;
126 }
127
128 return 1;
129 }
130
131 const struct ethnl_request_ops ethnl_linkinfo_request_ops = {
132 .request_cmd = ETHTOOL_MSG_LINKINFO_GET,
133 .reply_cmd = ETHTOOL_MSG_LINKINFO_GET_REPLY,
134 .hdr_attr = ETHTOOL_A_LINKINFO_HEADER,
135 .req_info_size = sizeof(struct linkinfo_req_info),
136 .reply_data_size = sizeof(struct linkinfo_reply_data),
137
138 .prepare_data = linkinfo_prepare_data,
139 .reply_size = linkinfo_reply_size,
140 .fill_reply = linkinfo_fill_reply,
141
142 .set_validate = ethnl_set_linkinfo_validate,
143 .set = ethnl_set_linkinfo,
144 .set_ntf_cmd = ETHTOOL_MSG_LINKINFO_NTF,
145 };
146