[PATCH net-next v3 10/10] net: phy: Send notifier when starting the cable test

[Andrew Lunn]

Given that it takes time to run a cable test, send a notify message at
the start, as well as when it is completed.

v3:
EMSGSIZE when ethnl_bcastmsg_put() fails
Print an error message on failure, since this is a void function.

Signed-off-by: Andrew Lunn <and...@lunn.ch>
Reviewed-by: Michal Kubecek <mkube...@suse.cz>
Reviewed-by: Florian Fainelli <f.faine...@gmail.com>
---
 net/ethtool/cabletest.c | 39 +++++++++++++++++++++++++++++++++++++++
 1 file changed, 39 insertions(+)

diff --git a/net/ethtool/cabletest.c b/net/ethtool/cabletest.c
index e0c917918c70..2d1ad343bd4f 100644
--- a/net/ethtool/cabletest.c
+++ b/net/ethtool/cabletest.c
@@ -13,6 +13,41 @@ cable_test_act_policy[ETHTOOL_A_CABLE_TEST_MAX + 1] = {
        [ETHTOOL_A_CABLE_TEST_HEADER]           = { .type = NLA_NESTED },
 };
 
+static void ethnl_cable_test_started(struct phy_device *phydev)
+{
+       struct sk_buff *skb;
+       int err = -ENOMEM;
+       void *ehdr;
+
+       skb = genlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
+       if (!skb)
+               goto out;
+
+       ehdr = ethnl_bcastmsg_put(skb, ETHTOOL_MSG_CABLE_TEST_NTF);
+       if (!ehdr) {
+               err = -EMSGSIZE;
+               goto out;
+       }
+
+       err = ethnl_fill_reply_header(skb, phydev->attached_dev,
+                                     ETHTOOL_A_CABLE_TEST_NTF_HEADER);
+       if (err)
+               goto out;
+
+       err = nla_put_u8(skb, ETHTOOL_A_CABLE_TEST_NTF_STATUS,
+                        ETHTOOL_A_CABLE_TEST_NTF_STATUS_STARTED);
+       if (err)
+               goto out;
+
+       genlmsg_end(skb, ehdr);
+       ethnl_multicast(skb, phydev->attached_dev);
+       return;
+
+out:
+       nlmsg_free(skb);
+       phydev_err(phydev, "%s: Error %pe\n", __func__, ERR_PTR(err));
+}
+
 int ethnl_act_cable_test(struct sk_buff *skb, struct genl_info *info)
 {
        struct nlattr *tb[ETHTOOL_A_CABLE_TEST_MAX + 1];
@@ -47,6 +82,10 @@ int ethnl_act_cable_test(struct sk_buff *skb, struct 
genl_info *info)
        ret = phy_start_cable_test(dev->phydev, info->extack);
 
        ethnl_ops_complete(dev);
+
+       if (!ret)
+               ethnl_cable_test_started(dev->phydev);
+
 out_rtnl:
        rtnl_unlock();
 out_dev_put:
-- 
2.26.2