1 // SPDX-License-Identifier: GPL-2.0
3 * configfs.c - Implementation of configfs interface to the driver stack
5 * Copyright (C) 2013-2015 Microchip Technology Germany II GmbH & Co. KG
8 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
9 #include <linux/module.h>
10 #include <linux/slab.h>
11 #include <linux/init.h>
12 #include <linux/configfs.h>
16 #define MAX_STRING_SIZE 80
19 struct config_item item;
20 struct list_head list;
28 char datatype[MAX_STRING_SIZE];
29 char direction[MAX_STRING_SIZE];
30 char name[MAX_STRING_SIZE];
31 char device[MAX_STRING_SIZE];
32 char channel[MAX_STRING_SIZE];
33 char comp[MAX_STRING_SIZE];
34 char comp_params[MAX_STRING_SIZE];
37 static struct list_head mdev_link_list;
39 static int set_cfg_buffer_size(struct mdev_link *link)
41 return most_set_cfg_buffer_size(link->device, link->channel,
45 static int set_cfg_subbuffer_size(struct mdev_link *link)
47 return most_set_cfg_subbuffer_size(link->device, link->channel,
48 link->subbuffer_size);
51 static int set_cfg_dbr_size(struct mdev_link *link)
53 return most_set_cfg_dbr_size(link->device, link->channel,
57 static int set_cfg_num_buffers(struct mdev_link *link)
59 return most_set_cfg_num_buffers(link->device, link->channel,
63 static int set_cfg_packets_xact(struct mdev_link *link)
65 return most_set_cfg_packets_xact(link->device, link->channel,
66 link->packets_per_xact);
69 static int set_cfg_direction(struct mdev_link *link)
71 return most_set_cfg_direction(link->device, link->channel,
75 static int set_cfg_datatype(struct mdev_link *link)
77 return most_set_cfg_datatype(link->device, link->channel,
81 static int (*set_config_val[])(struct mdev_link *link) = {
83 set_cfg_subbuffer_size,
91 static struct mdev_link *to_mdev_link(struct config_item *item)
93 return container_of(item, struct mdev_link, item);
96 static int set_config_and_add_link(struct mdev_link *mdev_link)
101 for (i = 0; i < ARRAY_SIZE(set_config_val); i++) {
102 ret = set_config_val[i](mdev_link);
103 if (ret < 0 && ret != -ENODEV) {
104 pr_err("Config failed\n");
109 return most_add_link(mdev_link->device, mdev_link->channel,
110 mdev_link->comp, mdev_link->name,
111 mdev_link->comp_params);
114 static ssize_t mdev_link_create_link_store(struct config_item *item,
115 const char *page, size_t count)
117 struct mdev_link *mdev_link = to_mdev_link(item);
121 ret = kstrtobool(page, &tmp);
126 ret = set_config_and_add_link(mdev_link);
127 if (ret && ret != -ENODEV)
129 list_add_tail(&mdev_link->list, &mdev_link_list);
130 mdev_link->create_link = tmp;
134 static ssize_t mdev_link_destroy_link_store(struct config_item *item,
135 const char *page, size_t count)
137 struct mdev_link *mdev_link = to_mdev_link(item);
141 ret = kstrtobool(page, &tmp);
146 mdev_link->destroy_link = tmp;
147 ret = most_remove_link(mdev_link->device, mdev_link->channel,
151 if (!list_empty(&mdev_link_list))
152 list_del(&mdev_link->list);
156 static ssize_t mdev_link_direction_show(struct config_item *item, char *page)
158 return snprintf(page, PAGE_SIZE, "%s\n", to_mdev_link(item)->direction);
161 static ssize_t mdev_link_direction_store(struct config_item *item,
162 const char *page, size_t count)
164 struct mdev_link *mdev_link = to_mdev_link(item);
166 if (!sysfs_streq(page, "dir_rx") && !sysfs_streq(page, "rx") &&
167 !sysfs_streq(page, "dir_tx") && !sysfs_streq(page, "tx"))
169 strcpy(mdev_link->direction, page);
170 strim(mdev_link->direction);
174 static ssize_t mdev_link_datatype_show(struct config_item *item, char *page)
176 return snprintf(page, PAGE_SIZE, "%s\n", to_mdev_link(item)->datatype);
179 static ssize_t mdev_link_datatype_store(struct config_item *item,
180 const char *page, size_t count)
182 struct mdev_link *mdev_link = to_mdev_link(item);
184 if (!sysfs_streq(page, "control") && !sysfs_streq(page, "async") &&
185 !sysfs_streq(page, "sync") && !sysfs_streq(page, "isoc") &&
186 !sysfs_streq(page, "isoc_avp"))
188 strcpy(mdev_link->datatype, page);
189 strim(mdev_link->datatype);
193 static ssize_t mdev_link_device_show(struct config_item *item, char *page)
195 return snprintf(page, PAGE_SIZE, "%s\n", to_mdev_link(item)->device);
198 static ssize_t mdev_link_device_store(struct config_item *item,
199 const char *page, size_t count)
201 struct mdev_link *mdev_link = to_mdev_link(item);
203 strlcpy(mdev_link->device, page, sizeof(mdev_link->device));
204 strim(mdev_link->device);
208 static ssize_t mdev_link_channel_show(struct config_item *item, char *page)
210 return snprintf(page, PAGE_SIZE, "%s\n", to_mdev_link(item)->channel);
213 static ssize_t mdev_link_channel_store(struct config_item *item,
214 const char *page, size_t count)
216 struct mdev_link *mdev_link = to_mdev_link(item);
218 strlcpy(mdev_link->channel, page, sizeof(mdev_link->channel));
219 strim(mdev_link->channel);
223 static ssize_t mdev_link_comp_show(struct config_item *item, char *page)
225 return snprintf(page, PAGE_SIZE, "%s\n", to_mdev_link(item)->comp);
228 static ssize_t mdev_link_comp_store(struct config_item *item,
229 const char *page, size_t count)
231 struct mdev_link *mdev_link = to_mdev_link(item);
233 strlcpy(mdev_link->comp, page, sizeof(mdev_link->comp));
234 strim(mdev_link->comp);
238 static ssize_t mdev_link_comp_params_show(struct config_item *item, char *page)
240 return snprintf(page, PAGE_SIZE, "%s\n",
241 to_mdev_link(item)->comp_params);
244 static ssize_t mdev_link_comp_params_store(struct config_item *item,
245 const char *page, size_t count)
247 struct mdev_link *mdev_link = to_mdev_link(item);
249 strlcpy(mdev_link->comp_params, page, sizeof(mdev_link->comp_params));
250 strim(mdev_link->comp_params);
254 static ssize_t mdev_link_num_buffers_show(struct config_item *item, char *page)
256 return snprintf(page, PAGE_SIZE, "%d\n",
257 to_mdev_link(item)->num_buffers);
260 static ssize_t mdev_link_num_buffers_store(struct config_item *item,
261 const char *page, size_t count)
263 struct mdev_link *mdev_link = to_mdev_link(item);
266 ret = kstrtou16(page, 0, &mdev_link->num_buffers);
272 static ssize_t mdev_link_buffer_size_show(struct config_item *item, char *page)
274 return snprintf(page, PAGE_SIZE, "%d\n",
275 to_mdev_link(item)->buffer_size);
278 static ssize_t mdev_link_buffer_size_store(struct config_item *item,
279 const char *page, size_t count)
281 struct mdev_link *mdev_link = to_mdev_link(item);
284 ret = kstrtou16(page, 0, &mdev_link->buffer_size);
290 static ssize_t mdev_link_subbuffer_size_show(struct config_item *item,
293 return snprintf(page, PAGE_SIZE, "%d\n",
294 to_mdev_link(item)->subbuffer_size);
297 static ssize_t mdev_link_subbuffer_size_store(struct config_item *item,
298 const char *page, size_t count)
300 struct mdev_link *mdev_link = to_mdev_link(item);
303 ret = kstrtou16(page, 0, &mdev_link->subbuffer_size);
309 static ssize_t mdev_link_packets_per_xact_show(struct config_item *item,
312 return snprintf(page, PAGE_SIZE, "%d\n",
313 to_mdev_link(item)->packets_per_xact);
316 static ssize_t mdev_link_packets_per_xact_store(struct config_item *item,
317 const char *page, size_t count)
319 struct mdev_link *mdev_link = to_mdev_link(item);
322 ret = kstrtou16(page, 0, &mdev_link->packets_per_xact);
328 static ssize_t mdev_link_dbr_size_show(struct config_item *item, char *page)
330 return snprintf(page, PAGE_SIZE, "%d\n", to_mdev_link(item)->dbr_size);
333 static ssize_t mdev_link_dbr_size_store(struct config_item *item,
334 const char *page, size_t count)
336 struct mdev_link *mdev_link = to_mdev_link(item);
339 ret = kstrtou16(page, 0, &mdev_link->dbr_size);
345 CONFIGFS_ATTR_WO(mdev_link_, create_link);
346 CONFIGFS_ATTR_WO(mdev_link_, destroy_link);
347 CONFIGFS_ATTR(mdev_link_, device);
348 CONFIGFS_ATTR(mdev_link_, channel);
349 CONFIGFS_ATTR(mdev_link_, comp);
350 CONFIGFS_ATTR(mdev_link_, comp_params);
351 CONFIGFS_ATTR(mdev_link_, num_buffers);
352 CONFIGFS_ATTR(mdev_link_, buffer_size);
353 CONFIGFS_ATTR(mdev_link_, subbuffer_size);
354 CONFIGFS_ATTR(mdev_link_, packets_per_xact);
355 CONFIGFS_ATTR(mdev_link_, datatype);
356 CONFIGFS_ATTR(mdev_link_, direction);
357 CONFIGFS_ATTR(mdev_link_, dbr_size);
359 static struct configfs_attribute *mdev_link_attrs[] = {
360 &mdev_link_attr_create_link,
361 &mdev_link_attr_destroy_link,
362 &mdev_link_attr_device,
363 &mdev_link_attr_channel,
364 &mdev_link_attr_comp,
365 &mdev_link_attr_comp_params,
366 &mdev_link_attr_num_buffers,
367 &mdev_link_attr_buffer_size,
368 &mdev_link_attr_subbuffer_size,
369 &mdev_link_attr_packets_per_xact,
370 &mdev_link_attr_datatype,
371 &mdev_link_attr_direction,
372 &mdev_link_attr_dbr_size,
376 static void mdev_link_release(struct config_item *item)
378 struct mdev_link *mdev_link = to_mdev_link(item);
381 if (!list_empty(&mdev_link_list)) {
382 ret = most_remove_link(mdev_link->device, mdev_link->channel,
384 if (ret && (ret != -ENODEV))
385 pr_err("Removing link failed.\n");
386 list_del(&mdev_link->list);
388 kfree(to_mdev_link(item));
391 static struct configfs_item_operations mdev_link_item_ops = {
392 .release = mdev_link_release,
395 static const struct config_item_type mdev_link_type = {
396 .ct_item_ops = &mdev_link_item_ops,
397 .ct_attrs = mdev_link_attrs,
398 .ct_owner = THIS_MODULE,
402 struct config_group group;
404 struct configfs_subsystem subsys;
407 static struct most_common *to_most_common(struct configfs_subsystem *subsys)
409 return container_of(subsys, struct most_common, subsys);
412 static struct config_item *most_common_make_item(struct config_group *group,
415 struct mdev_link *mdev_link;
416 struct most_common *mc = to_most_common(group->cg_subsys);
418 mdev_link = kzalloc(sizeof(*mdev_link), GFP_KERNEL);
420 return ERR_PTR(-ENOMEM);
422 if (!try_module_get(mc->mod)) {
424 return ERR_PTR(-ENOLCK);
426 config_item_init_type_name(&mdev_link->item, name,
429 if (!strcmp(group->cg_item.ci_namebuf, "most_cdev"))
430 strcpy(mdev_link->comp, "cdev");
431 else if (!strcmp(group->cg_item.ci_namebuf, "most_net"))
432 strcpy(mdev_link->comp, "net");
433 else if (!strcmp(group->cg_item.ci_namebuf, "most_video"))
434 strcpy(mdev_link->comp, "video");
435 strcpy(mdev_link->name, name);
436 return &mdev_link->item;
439 static void most_common_release(struct config_item *item)
441 struct config_group *group = to_config_group(item);
443 kfree(to_most_common(group->cg_subsys));
446 static struct configfs_item_operations most_common_item_ops = {
447 .release = most_common_release,
450 static void most_common_disconnect(struct config_group *group,
451 struct config_item *item)
453 struct most_common *mc = to_most_common(group->cg_subsys);
458 static struct configfs_group_operations most_common_group_ops = {
459 .make_item = most_common_make_item,
460 .disconnect_notify = most_common_disconnect,
463 static const struct config_item_type most_common_type = {
464 .ct_item_ops = &most_common_item_ops,
465 .ct_group_ops = &most_common_group_ops,
466 .ct_owner = THIS_MODULE,
469 static struct most_common most_cdev = {
473 .ci_namebuf = "most_cdev",
474 .ci_type = &most_common_type,
480 static struct most_common most_net = {
484 .ci_namebuf = "most_net",
485 .ci_type = &most_common_type,
491 static struct most_common most_video = {
495 .ci_namebuf = "most_video",
496 .ci_type = &most_common_type,
502 struct most_snd_grp {
503 struct config_group group;
505 struct list_head list;
508 static struct most_snd_grp *to_most_snd_grp(struct config_item *item)
510 return container_of(to_config_group(item), struct most_snd_grp, group);
513 static struct config_item *most_snd_grp_make_item(struct config_group *group,
516 struct mdev_link *mdev_link;
518 mdev_link = kzalloc(sizeof(*mdev_link), GFP_KERNEL);
520 return ERR_PTR(-ENOMEM);
522 config_item_init_type_name(&mdev_link->item, name, &mdev_link_type);
523 mdev_link->create_link = false;
524 strcpy(mdev_link->name, name);
525 strcpy(mdev_link->comp, "sound");
526 return &mdev_link->item;
529 static ssize_t most_snd_grp_create_card_store(struct config_item *item,
530 const char *page, size_t count)
532 struct most_snd_grp *snd_grp = to_most_snd_grp(item);
536 ret = kstrtobool(page, &tmp);
540 ret = most_cfg_complete("sound");
544 snd_grp->create_card = tmp;
548 CONFIGFS_ATTR_WO(most_snd_grp_, create_card);
550 static struct configfs_attribute *most_snd_grp_attrs[] = {
551 &most_snd_grp_attr_create_card,
555 static void most_snd_grp_release(struct config_item *item)
557 struct most_snd_grp *group = to_most_snd_grp(item);
559 list_del(&group->list);
563 static struct configfs_item_operations most_snd_grp_item_ops = {
564 .release = most_snd_grp_release,
567 static struct configfs_group_operations most_snd_grp_group_ops = {
568 .make_item = most_snd_grp_make_item,
571 static const struct config_item_type most_snd_grp_type = {
572 .ct_item_ops = &most_snd_grp_item_ops,
573 .ct_group_ops = &most_snd_grp_group_ops,
574 .ct_attrs = most_snd_grp_attrs,
575 .ct_owner = THIS_MODULE,
579 struct configfs_subsystem subsys;
580 struct list_head soundcard_list;
584 static struct config_group *most_sound_make_group(struct config_group *group,
587 struct most_snd_grp *most;
588 struct most_sound *ms = container_of(group->cg_subsys,
589 struct most_sound, subsys);
591 list_for_each_entry(most, &ms->soundcard_list, list) {
592 if (!most->create_card) {
593 pr_info("adapter configuration still in progress.\n");
594 return ERR_PTR(-EPROTO);
597 if (!try_module_get(ms->mod))
598 return ERR_PTR(-ENOLCK);
599 most = kzalloc(sizeof(*most), GFP_KERNEL);
602 return ERR_PTR(-ENOMEM);
604 config_group_init_type_name(&most->group, name, &most_snd_grp_type);
605 list_add_tail(&most->list, &ms->soundcard_list);
609 static void most_sound_disconnect(struct config_group *group,
610 struct config_item *item)
612 struct most_sound *ms = container_of(group->cg_subsys,
613 struct most_sound, subsys);
617 static struct configfs_group_operations most_sound_group_ops = {
618 .make_group = most_sound_make_group,
619 .disconnect_notify = most_sound_disconnect,
622 static const struct config_item_type most_sound_type = {
623 .ct_group_ops = &most_sound_group_ops,
624 .ct_owner = THIS_MODULE,
627 static struct most_sound most_sound_subsys = {
631 .ci_namebuf = "most_sound",
632 .ci_type = &most_sound_type,
638 int most_register_configfs_subsys(struct most_component *c)
642 if (!strcmp(c->name, "cdev")) {
643 most_cdev.mod = c->mod;
644 ret = configfs_register_subsystem(&most_cdev.subsys);
645 } else if (!strcmp(c->name, "net")) {
646 most_net.mod = c->mod;
647 ret = configfs_register_subsystem(&most_net.subsys);
648 } else if (!strcmp(c->name, "video")) {
649 most_video.mod = c->mod;
650 ret = configfs_register_subsystem(&most_video.subsys);
651 } else if (!strcmp(c->name, "sound")) {
652 most_sound_subsys.mod = c->mod;
653 ret = configfs_register_subsystem(&most_sound_subsys.subsys);
659 pr_err("Error %d while registering subsystem %s\n",
664 EXPORT_SYMBOL_GPL(most_register_configfs_subsys);
666 void most_interface_register_notify(const char *mdev)
668 bool register_snd_card = false;
669 struct mdev_link *mdev_link;
671 list_for_each_entry(mdev_link, &mdev_link_list, list) {
672 if (!strcmp(mdev_link->device, mdev)) {
673 set_config_and_add_link(mdev_link);
674 if (!strcmp(mdev_link->comp, "sound"))
675 register_snd_card = true;
678 if (register_snd_card)
679 most_cfg_complete("sound");
682 void most_deregister_configfs_subsys(struct most_component *c)
684 if (!strcmp(c->name, "cdev"))
685 configfs_unregister_subsystem(&most_cdev.subsys);
686 else if (!strcmp(c->name, "net"))
687 configfs_unregister_subsystem(&most_net.subsys);
688 else if (!strcmp(c->name, "video"))
689 configfs_unregister_subsystem(&most_video.subsys);
690 else if (!strcmp(c->name, "sound"))
691 configfs_unregister_subsystem(&most_sound_subsys.subsys);
693 EXPORT_SYMBOL_GPL(most_deregister_configfs_subsys);
695 int __init configfs_init(void)
697 config_group_init(&most_cdev.subsys.su_group);
698 mutex_init(&most_cdev.subsys.su_mutex);
700 config_group_init(&most_net.subsys.su_group);
701 mutex_init(&most_net.subsys.su_mutex);
703 config_group_init(&most_video.subsys.su_group);
704 mutex_init(&most_video.subsys.su_mutex);
706 config_group_init(&most_sound_subsys.subsys.su_group);
707 mutex_init(&most_sound_subsys.subsys.su_mutex);
709 INIT_LIST_HEAD(&most_sound_subsys.soundcard_list);
710 INIT_LIST_HEAD(&mdev_link_list);