From: Jiri Pirko <j...@nvidia.com>

On real HW, the activation typically happens upon line card insertion.
Emulate such event using write to debugfs file "inserted_type".

Signed-off-by: Jiri Pirko <j...@nvidia.com>
---
RFC->RFCv2:
- converted bool "active" to string "inserted_type" and adjust loginc
  around it wrt provision/unprovision work
---
 drivers/net/netdevsim/dev.c       | 136 ++++++++++++++++++++++++++++++
 drivers/net/netdevsim/netdevsim.h |   2 +
 2 files changed, 138 insertions(+)

diff --git a/drivers/net/netdevsim/dev.c b/drivers/net/netdevsim/dev.c
index 84daef00073b..d37e69fc13d6 100644
--- a/drivers/net/netdevsim/dev.c
+++ b/drivers/net/netdevsim/dev.c
@@ -43,6 +43,16 @@ static const unsigned int nsim_dev_linecard_port_counts[] = {
        1, 2, 4,
 };
 
+static int nsim_dev_linecard_type_index(const char *type)
+{
+       int i;
+
+       for (i = 0; i < ARRAY_SIZE(nsim_dev_linecard_supported_types); i++)
+               if (!strcmp(nsim_dev_linecard_supported_types[i], type))
+                       return i;
+       return -1;
+}
+
 static unsigned int
 nsim_dev_linecard_port_count(struct nsim_dev_linecard *nsim_dev_linecard)
 {
@@ -64,6 +74,60 @@ nsim_dev_port_index(struct nsim_dev_linecard 
*nsim_dev_linecard,
               port_index;
 }
 
+static int
+nsim_dev_linecard_activate(struct nsim_dev_linecard *nsim_dev_linecard)
+{
+       struct nsim_dev_port *nsim_dev_port;
+
+       if (!nsim_dev_linecard->inserted || !nsim_dev_linecard->provisioned)
+               return 0;
+
+       if (nsim_dev_linecard->type_index !=
+           nsim_dev_linecard->inserted_type_index)
+               return -EINVAL;
+
+       list_for_each_entry(nsim_dev_port, &nsim_dev_linecard->port_list,
+                           list_lc)
+               netif_carrier_on(nsim_dev_port->ns->netdev);
+
+       devlink_linecard_activate(nsim_dev_linecard->devlink_linecard);
+       return 0;
+}
+
+static int
+nsim_dev_linecard_insert(struct nsim_dev_linecard *nsim_dev_linecard,
+                        u32 inserted_type_index)
+{
+       if (nsim_dev_linecard->type_index != inserted_type_index)
+               return -EINVAL;
+
+       nsim_dev_linecard->inserted_type_index = inserted_type_index;
+       nsim_dev_linecard->inserted = true;
+       return nsim_dev_linecard_activate(nsim_dev_linecard);
+}
+
+static void
+nsim_dev_linecard_deactivate(struct nsim_dev_linecard *nsim_dev_linecard)
+{
+       struct nsim_dev_port *nsim_dev_port;
+
+       if (!nsim_dev_linecard->inserted)
+               return;
+       list_for_each_entry(nsim_dev_port, &nsim_dev_linecard->port_list,
+                           list_lc)
+               netif_carrier_off(nsim_dev_port->ns->netdev);
+}
+
+static void
+nsim_dev_linecard_remove(struct nsim_dev_linecard *nsim_dev_linecard)
+{
+       if (!nsim_dev_linecard->inserted)
+               return;
+       nsim_dev_linecard_deactivate(nsim_dev_linecard);
+       nsim_dev_linecard->inserted = false;
+       devlink_linecard_deactivate(nsim_dev_linecard->devlink_linecard);
+}
+
 static struct dentry *nsim_dev_ddir;
 
 #define NSIM_DEV_DUMMY_REGION_SIZE (1024 * 32)
@@ -299,6 +363,72 @@ static void nsim_dev_port_debugfs_exit(struct 
nsim_dev_port *nsim_dev_port)
        debugfs_remove_recursive(nsim_dev_port->ddir);
 }
 
+static ssize_t nsim_dev_linecard_inserted_type_read(struct file *file,
+                                                   char __user *data,
+                                                   size_t count, loff_t *ppos)
+{
+       struct nsim_dev_linecard *nsim_dev_linecard = file->private_data;
+       const char *type;
+
+       if (!nsim_dev_linecard->inserted)
+               return -EOPNOTSUPP;
+
+       type = 
nsim_dev_linecard_supported_types[nsim_dev_linecard->inserted_type_index];
+       return simple_read_from_buffer(data, count, ppos, type, strlen(type));
+}
+
+static ssize_t nsim_dev_linecard_inserted_type_write(struct file *file,
+                                                    const char __user *data,
+                                                    size_t count, loff_t *ppos)
+{
+       struct nsim_dev_linecard *nsim_dev_linecard = file->private_data;
+       char *buf;
+       int err;
+       int ret;
+
+       if (*ppos != 0)
+               return -EINVAL;
+       buf = kmalloc(count, GFP_KERNEL | __GFP_NOWARN);
+       if (!buf)
+               return -ENOMEM;
+
+       ret = simple_write_to_buffer(buf, count, ppos, data, count);
+       if (ret < 0)
+               goto free_buf;
+
+       buf[count - 1] = '\0';
+       if (strlen(buf) > 0) {
+               int inserted_type_index;
+
+               inserted_type_index = nsim_dev_linecard_type_index(buf);
+               if (inserted_type_index == -1)
+                       return -EINVAL;
+
+               if (nsim_dev_linecard->inserted)
+                       return -EBUSY;
+
+               err = nsim_dev_linecard_insert(nsim_dev_linecard,
+                                              inserted_type_index);
+               if (err)
+                       return err;
+       } else {
+               nsim_dev_linecard_remove(nsim_dev_linecard);
+       }
+       return count;
+
+free_buf:
+       kfree(buf);
+       return ret;
+}
+
+static const struct file_operations nsim_dev_linecard_inserted_type_fops = {
+       .open = simple_open,
+       .read = nsim_dev_linecard_inserted_type_read,
+       .write = nsim_dev_linecard_inserted_type_write,
+       .llseek = generic_file_llseek,
+       .owner = THIS_MODULE,
+};
+
 static ssize_t nsim_dev_linecard_type_read(struct file *file, char __user 
*data,
                                           size_t count, loff_t *ppos)
 {
@@ -334,6 +464,8 @@ nsim_dev_linecard_debugfs_init(struct nsim_dev *nsim_dev,
        sprintf(dev_link_name, "../../../" DRV_NAME "%u",
                nsim_dev->nsim_bus_dev->dev.id);
        debugfs_create_symlink("dev", nsim_dev_linecard->ddir, dev_link_name);
+       debugfs_create_file("inserted_type", 0600, nsim_dev_linecard->ddir,
+                           nsim_dev_linecard, 
&nsim_dev_linecard_inserted_type_fops);
        debugfs_create_file("type", 0400, nsim_dev_linecard->ddir,
                            nsim_dev_linecard, &nsim_dev_linecard_type_fops);
 
@@ -1110,6 +1242,8 @@ static void nsim_dev_linecard_provision_work(struct 
work_struct *work)
        nsim_dev_linecard->provisioned = true;
        devlink_linecard_provision_set(nsim_dev_linecard->devlink_linecard,
                                       nsim_dev_linecard->type_index);
+
+       nsim_dev_linecard_activate(nsim_dev_linecard);
        return;
 
 err_port_del_all:
@@ -1138,6 +1272,8 @@ static void nsim_dev_linecard_unprovision_work(struct 
work_struct *work)
        nsim_dev_linecard = container_of(work, struct nsim_dev_linecard,
                                         unprovision_work);
 
+       nsim_dev_linecard_deactivate(nsim_dev_linecard);
+
        nsim_bus_dev = nsim_dev_linecard->nsim_dev->nsim_bus_dev;
        nsim_dev_linecard->provisioned = false;
        devlink_linecard_provision_clear(nsim_dev_linecard->devlink_linecard);
diff --git a/drivers/net/netdevsim/netdevsim.h 
b/drivers/net/netdevsim/netdevsim.h
index 01edff939c3a..8ee036e00a56 100644
--- a/drivers/net/netdevsim/netdevsim.h
+++ b/drivers/net/netdevsim/netdevsim.h
@@ -203,6 +203,8 @@ struct nsim_dev_linecard {
        struct dentry *ddir;
        bool provisioned;
        u32 type_index;
+       bool inserted;
+       u32 inserted_type_index;
        struct work_struct provision_work;
        struct work_struct unprovision_work;
 };
-- 
2.26.2

Reply via email to