^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * The Industrial I/O core, software trigger functions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (c) 2015 Intel Corporation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/kmod.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/list.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/iio/sw_trigger.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/iio/configfs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/configfs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) static struct config_group *iio_triggers_group;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) static const struct config_item_type iio_trigger_type_group_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) static const struct config_item_type iio_triggers_group_type = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) .ct_owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static LIST_HEAD(iio_trigger_types_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static DEFINE_MUTEX(iio_trigger_types_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct iio_sw_trigger_type *__iio_find_sw_trigger_type(const char *name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) unsigned len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct iio_sw_trigger_type *t = NULL, *iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) list_for_each_entry(iter, &iio_trigger_types_list, list)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) if (!strcmp(iter->name, name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) t = iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) return t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) int iio_register_sw_trigger_type(struct iio_sw_trigger_type *t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) struct iio_sw_trigger_type *iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) mutex_lock(&iio_trigger_types_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) iter = __iio_find_sw_trigger_type(t->name, strlen(t->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) if (iter)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) ret = -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) list_add_tail(&t->list, &iio_trigger_types_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) mutex_unlock(&iio_trigger_types_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) t->group = configfs_register_default_group(iio_triggers_group, t->name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) &iio_trigger_type_group_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) if (IS_ERR(t->group))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) ret = PTR_ERR(t->group);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) EXPORT_SYMBOL(iio_register_sw_trigger_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) void iio_unregister_sw_trigger_type(struct iio_sw_trigger_type *t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) struct iio_sw_trigger_type *iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) mutex_lock(&iio_trigger_types_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) iter = __iio_find_sw_trigger_type(t->name, strlen(t->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) if (iter)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) list_del(&t->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) mutex_unlock(&iio_trigger_types_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) configfs_unregister_default_group(t->group);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) EXPORT_SYMBOL(iio_unregister_sw_trigger_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) static
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) struct iio_sw_trigger_type *iio_get_sw_trigger_type(const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) struct iio_sw_trigger_type *t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) mutex_lock(&iio_trigger_types_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) t = __iio_find_sw_trigger_type(name, strlen(name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) if (t && !try_module_get(t->owner))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) t = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) mutex_unlock(&iio_trigger_types_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) return t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) struct iio_sw_trigger *iio_sw_trigger_create(const char *type, const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) struct iio_sw_trigger *t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) struct iio_sw_trigger_type *tt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) tt = iio_get_sw_trigger_type(type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (!tt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) pr_err("Invalid trigger type: %s\n", type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return ERR_PTR(-EINVAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) t = tt->ops->probe(name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) if (IS_ERR(t))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) goto out_module_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) t->trigger_type = tt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) return t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) out_module_put:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) module_put(tt->owner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) return t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) EXPORT_SYMBOL(iio_sw_trigger_create);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) void iio_sw_trigger_destroy(struct iio_sw_trigger *t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) struct iio_sw_trigger_type *tt = t->trigger_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) tt->ops->remove(t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) module_put(tt->owner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) EXPORT_SYMBOL(iio_sw_trigger_destroy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) static struct config_group *trigger_make_group(struct config_group *group,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) struct iio_sw_trigger *t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) t = iio_sw_trigger_create(group->cg_item.ci_name, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) if (IS_ERR(t))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) return ERR_CAST(t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) config_item_set_name(&t->group.cg_item, "%s", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) return &t->group;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) static void trigger_drop_group(struct config_group *group,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) struct config_item *item)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) struct iio_sw_trigger *t = to_iio_sw_trigger(item);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) iio_sw_trigger_destroy(t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) config_item_put(item);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) static struct configfs_group_operations trigger_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) .make_group = &trigger_make_group,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) .drop_item = &trigger_drop_group,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) static const struct config_item_type iio_trigger_type_group_type = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) .ct_group_ops = &trigger_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) .ct_owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) static int __init iio_sw_trigger_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) iio_triggers_group =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) configfs_register_default_group(&iio_configfs_subsys.su_group,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) "triggers",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) &iio_triggers_group_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) return PTR_ERR_OR_ZERO(iio_triggers_group);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) module_init(iio_sw_trigger_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) static void __exit iio_sw_trigger_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) configfs_unregister_default_group(iio_triggers_group);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) module_exit(iio_sw_trigger_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) MODULE_AUTHOR("Daniel Baluta <daniel.baluta@intel.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) MODULE_DESCRIPTION("Industrial I/O software triggers support");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags