1// SPDX-License-Identifier: GPL-2.0-only
2
3#include "netlink.h"
4#include "common.h"
5
6struct linkinfo_req_info {
7	struct ethnl_req_info		base;
8};
9
10struct 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
19const struct nla_policy ethnl_linkinfo_get_policy[] = {
20	[ETHTOOL_A_LINKINFO_HEADER]		=
21		NLA_POLICY_NESTED(ethnl_header_policy),
22};
23
24static int linkinfo_prepare_data(const struct ethnl_req_info *req_base,
25				 struct ethnl_reply_data *reply_base,
26				 const 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
45static 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
56static 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
78const 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
86static int
87ethnl_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
97static int
98ethnl_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
131const 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