@@ -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);
@@ -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;
};