net/ethtool/cabletest.c

19 static int ethnl_cable_test_started(struct phy_device *phydev, u8 cmd)
35 	err = ethnl_fill_reply_header(skb, phydev->attached_dev,
47 	return ethnl_multicast(skb, phydev->attached_dev);
51 	phydev_err(phydev, "%s: Error %pe\n", __func__, ERR_PTR(err));
72 	if (!dev->phydev) {
88 	ret = ops->start_cable_test(dev->phydev, info->extack);
93 		ethnl_cable_test_started(dev->phydev,
103 int ethnl_cable_test_alloc(struct phy_device *phydev, u8 cmd)
110 	phydev->skb = genlmsg_new(SZ_16K, GFP_KERNEL);
111 	if (!phydev->skb)
114 	phydev->ehdr = ethnl_bcastmsg_put(phydev->skb, cmd);
115 	if (!phydev->ehdr) {
120 	err = ethnl_fill_reply_header(phydev->skb, phydev->attached_dev,
125 	err = nla_put_u8(phydev->skb, ETHTOOL_A_CABLE_TEST_NTF_STATUS,
130 	phydev->nest = nla_nest_start(phydev->skb,
132 	if (!phydev->nest) {
140 	nlmsg_free(phydev->skb);
141 	phydev->skb = NULL;
146 void ethnl_cable_test_free(struct phy_device *phydev)
148 	nlmsg_free(phydev->skb);
149 	phydev->skb = NULL;
153 void ethnl_cable_test_finished(struct phy_device *phydev)
155 	nla_nest_end(phydev->skb, phydev->nest);
157 	genlmsg_end(phydev->skb, phydev->ehdr);
159 	ethnl_multicast(phydev->skb, phydev->attached_dev);
163 int ethnl_cable_test_result(struct phy_device *phydev, u8 pair, u8 result)
168 	nest = nla_nest_start(phydev->skb, ETHTOOL_A_CABLE_NEST_RESULT);
172 	if (nla_put_u8(phydev->skb, ETHTOOL_A_CABLE_RESULT_PAIR, pair))
174 	if (nla_put_u8(phydev->skb, ETHTOOL_A_CABLE_RESULT_CODE, result))
177 	nla_nest_end(phydev->skb, nest);
181 	nla_nest_cancel(phydev->skb, nest);
186 int ethnl_cable_test_fault_length(struct phy_device *phydev, u8 pair, u32 cm)
191 	nest = nla_nest_start(phydev->skb,
196 	if (nla_put_u8(phydev->skb, ETHTOOL_A_CABLE_FAULT_LENGTH_PAIR, pair))
198 	if (nla_put_u32(phydev->skb, ETHTOOL_A_CABLE_FAULT_LENGTH_CM, cm))
201 	nla_nest_end(phydev->skb, nest);
205 	nla_nest_cancel(phydev->skb, nest);
324 	if (!dev->phydev) {
345 	ret = ops->start_cable_test_tdr(dev->phydev, info->extack, &cfg);
350 		ethnl_cable_test_started(dev->phydev,
360 int ethnl_cable_test_amplitude(struct phy_device *phydev,
366 	nest = nla_nest_start(phydev->skb,
371 	if (nla_put_u8(phydev->skb, ETHTOOL_A_CABLE_AMPLITUDE_PAIR, pair))
373 	if (nla_put_u16(phydev->skb, ETHTOOL_A_CABLE_AMPLITUDE_mV, mV))
376 	nla_nest_end(phydev->skb, nest);
380 	nla_nest_cancel(phydev->skb, nest);
385 int ethnl_cable_test_pulse(struct phy_device *phydev, u16 mV)
390 	nest = nla_nest_start(phydev->skb, ETHTOOL_A_CABLE_TDR_NEST_PULSE);
394 	if (nla_put_u16(phydev->skb, ETHTOOL_A_CABLE_PULSE_mV, mV))
397 	nla_nest_end(phydev->skb, nest);
401 	nla_nest_cancel(phydev->skb, nest);
406 int ethnl_cable_test_step(struct phy_device *phydev, u32 first, u32 last,
412 	nest = nla_nest_start(phydev->skb, ETHTOOL_A_CABLE_TDR_NEST_STEP);
416 	if (nla_put_u32(phydev->skb, ETHTOOL_A_CABLE_STEP_FIRST_DISTANCE,
420 	if (nla_put_u32(phydev->skb, ETHTOOL_A_CABLE_STEP_LAST_DISTANCE, last))
423 	if (nla_put_u32(phydev->skb, ETHTOOL_A_CABLE_STEP_STEP_DISTANCE, step))
426 	nla_nest_end(phydev->skb, nest);
430 	nla_nest_cancel(phydev->skb, nest);