[RFC 2/3] ethtool: add compat for flash update

[Jakub Kicinski]

If driver does not support ethtool flash update operation
call into devlink.

Signed-off-by: Jakub Kicinski <jakub.kicin...@netronome.com>
---
 include/net/devlink.h |  9 +++++++++
 net/core/devlink.c    | 31 +++++++++++++++++++++++++++++++
 net/core/ethtool.c    | 12 +++++++++---
 3 files changed, 49 insertions(+), 3 deletions(-)

diff --git a/include/net/devlink.h b/include/net/devlink.h
index 55b3478b1291..8fdadd0a43ce 100644
--- a/include/net/devlink.h
+++ b/include/net/devlink.h
@@ -1202,11 +1202,20 @@ devlink_health_report(struct devlink_health_reporter 
*reporter,
 #if IS_REACHABLE(CONFIG_NET_DEVLINK)
 void devlink_compat_running_version(struct net_device *dev,
                                    char *buf, size_t len);
+int devlink_compat_flash_update(struct net_device *dev, const char *file_name,
+                               u32 target);
 #else
 static inline void
 devlink_compat_running_version(struct net_device *dev, char *buf, size_t len)
 {
 }
+
+static inline int
+devlink_compat_flash_update(struct net_device *dev, const char *file_name,
+                           u32 target)
+{
+       return -EOPNOTSUPP;
+}
 #endif
 
 #endif /* _NET_DEVLINK_H_ */
diff --git a/net/core/devlink.c b/net/core/devlink.c
index a4b5e194e33e..fb1b0982281b 100644
--- a/net/core/devlink.c
+++ b/net/core/devlink.c
@@ -6435,6 +6435,37 @@ void devlink_compat_running_version(struct net_device 
*dev,
        mutex_unlock(&devlink_mutex);
 }
 
+int devlink_compat_flash_update(struct net_device *dev, const char *file_name,
+                               u32 target)
+{
+       struct devlink_port *devlink_port;
+       struct devlink *devlink;
+
+       mutex_lock(&devlink_mutex);
+       list_for_each_entry(devlink, &devlink_list, list) {
+               mutex_lock(&devlink->lock);
+               list_for_each_entry(devlink_port, &devlink->port_list, list) {
+                       int ret = -EOPNOTSUPP;
+
+                       if (devlink_port->type != DEVLINK_PORT_TYPE_ETH ||
+                           devlink_port->type_dev != dev)
+                               continue;
+
+                       mutex_unlock(&devlink_mutex);
+                       if (devlink->ops->flash_update)
+                               ret = devlink->ops->flash_update(devlink,
+                                                                file_name,
+                                                                target, NULL);
+                       mutex_unlock(&devlink->lock);
+                       return ret;
+               }
+               mutex_unlock(&devlink->lock);
+       }
+       mutex_unlock(&devlink_mutex);
+
+       return -EOPNOTSUPP;
+}
+
 static int __init devlink_module_init(void)
 {
        return genl_register_family(&devlink_nl_family);
diff --git a/net/core/ethtool.c b/net/core/ethtool.c
index d2c47cdf25da..389782ccd4c5 100644
--- a/net/core/ethtool.c
+++ b/net/core/ethtool.c
@@ -2038,11 +2038,17 @@ static noinline_for_stack int 
ethtool_flash_device(struct net_device *dev,
 
        if (copy_from_user(&efl, useraddr, sizeof(efl)))
                return -EFAULT;
+       efl.data[ETHTOOL_FLASH_MAX_FILENAME - 1] = 0;
 
-       if (!dev->ethtool_ops->flash_device)
-               return -EOPNOTSUPP;
+       if (!dev->ethtool_ops->flash_device) {
+               int ret;
 
-       efl.data[ETHTOOL_FLASH_MAX_FILENAME - 1] = 0;
+               rtnl_unlock();
+               ret = devlink_compat_flash_update(dev, efl.data, efl.region);
+               rtnl_lock();
+
+               return ret;
+       }
 
        return dev->ethtool_ops->flash_device(dev, &efl);
 }
-- 
2.19.2