1 // SPDX-License-Identifier: GPL-2.0-only
7 struct linkstate_req_info {
8 struct ethnl_req_info base;
11 struct linkstate_reply_data {
12 struct ethnl_reply_data base;
18 #define LINKSTATE_REPDATA(__reply_base) \
19 container_of(__reply_base, struct linkstate_reply_data, base)
21 static const struct nla_policy
22 linkstate_get_policy[ETHTOOL_A_LINKSTATE_MAX + 1] = {
23 [ETHTOOL_A_LINKSTATE_UNSPEC] = { .type = NLA_REJECT },
24 [ETHTOOL_A_LINKSTATE_HEADER] = { .type = NLA_NESTED },
25 [ETHTOOL_A_LINKSTATE_LINK] = { .type = NLA_REJECT },
26 [ETHTOOL_A_LINKSTATE_SQI] = { .type = NLA_REJECT },
27 [ETHTOOL_A_LINKSTATE_SQI_MAX] = { .type = NLA_REJECT },
30 static int linkstate_get_sqi(struct net_device *dev)
32 struct phy_device *phydev = dev->phydev;
38 mutex_lock(&phydev->lock);
39 if (!phydev->drv || !phydev->drv->get_sqi)
42 ret = phydev->drv->get_sqi(phydev);
43 mutex_unlock(&phydev->lock);
48 static int linkstate_get_sqi_max(struct net_device *dev)
50 struct phy_device *phydev = dev->phydev;
56 mutex_lock(&phydev->lock);
57 if (!phydev->drv || !phydev->drv->get_sqi_max)
60 ret = phydev->drv->get_sqi_max(phydev);
61 mutex_unlock(&phydev->lock);
66 static int linkstate_prepare_data(const struct ethnl_req_info *req_base,
67 struct ethnl_reply_data *reply_base,
68 struct genl_info *info)
70 struct linkstate_reply_data *data = LINKSTATE_REPDATA(reply_base);
71 struct net_device *dev = reply_base->dev;
74 ret = ethnl_ops_begin(dev);
77 data->link = __ethtool_get_link(dev);
79 ret = linkstate_get_sqi(dev);
80 if (ret < 0 && ret != -EOPNOTSUPP)
85 ret = linkstate_get_sqi_max(dev);
86 if (ret < 0 && ret != -EOPNOTSUPP)
91 ethnl_ops_complete(dev);
96 static int linkstate_reply_size(const struct ethnl_req_info *req_base,
97 const struct ethnl_reply_data *reply_base)
99 struct linkstate_reply_data *data = LINKSTATE_REPDATA(reply_base);
102 len = nla_total_size(sizeof(u8)) /* LINKSTATE_LINK */
105 if (data->sqi != -EOPNOTSUPP)
106 len += nla_total_size(sizeof(u32));
108 if (data->sqi_max != -EOPNOTSUPP)
109 len += nla_total_size(sizeof(u32));
114 static int linkstate_fill_reply(struct sk_buff *skb,
115 const struct ethnl_req_info *req_base,
116 const struct ethnl_reply_data *reply_base)
118 struct linkstate_reply_data *data = LINKSTATE_REPDATA(reply_base);
120 if (data->link >= 0 &&
121 nla_put_u8(skb, ETHTOOL_A_LINKSTATE_LINK, !!data->link))
124 if (data->sqi != -EOPNOTSUPP &&
125 nla_put_u32(skb, ETHTOOL_A_LINKSTATE_SQI, data->sqi))
128 if (data->sqi_max != -EOPNOTSUPP &&
129 nla_put_u32(skb, ETHTOOL_A_LINKSTATE_SQI_MAX, data->sqi_max))
135 const struct ethnl_request_ops ethnl_linkstate_request_ops = {
136 .request_cmd = ETHTOOL_MSG_LINKSTATE_GET,
137 .reply_cmd = ETHTOOL_MSG_LINKSTATE_GET_REPLY,
138 .hdr_attr = ETHTOOL_A_LINKSTATE_HEADER,
139 .max_attr = ETHTOOL_A_LINKSTATE_MAX,
140 .req_info_size = sizeof(struct linkstate_req_info),
141 .reply_data_size = sizeof(struct linkstate_reply_data),
142 .request_policy = linkstate_get_policy,
144 .prepare_data = linkstate_prepare_data,
145 .reply_size = linkstate_reply_size,
146 .fill_reply = linkstate_fill_reply,