^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) /* The industrial I/O core, trigger handling functions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (c) 2008 Jonathan Cameron
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/idr.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/list.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/iio/iio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/iio/trigger.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include "iio_core.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include "iio_core_trigger.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/iio/trigger_consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) /* RFC - Question of approach
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) * Make the common case (single sensor single trigger)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) * simple by starting trigger capture from when first sensors
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) * is added.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * Complex simultaneous start requires use of 'hold' functionality
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * of the trigger. (not implemented)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * Any other suggestions?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) static DEFINE_IDA(iio_trigger_ida);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) /* Single list of all available triggers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) static LIST_HEAD(iio_trigger_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) static DEFINE_MUTEX(iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) * iio_trigger_read_name() - retrieve useful identifying name
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) * @dev: device associated with the iio_trigger
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) * @attr: pointer to the device_attribute structure that is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) * being processed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) * @buf: buffer to print the name into
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) * Return: a negative number on failure or the number of written
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) * characters on success.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) static ssize_t iio_trigger_read_name(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) struct iio_trigger *trig = to_iio_trigger(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) return sprintf(buf, "%s\n", trig->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) static DEVICE_ATTR(name, S_IRUGO, iio_trigger_read_name, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static struct attribute *iio_trig_dev_attrs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) &dev_attr_name.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) ATTRIBUTE_GROUPS(iio_trig_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) static struct iio_trigger *__iio_trigger_find_by_name(const char *name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) int __iio_trigger_register(struct iio_trigger *trig_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) struct module *this_mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) trig_info->owner = this_mod;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) trig_info->id = ida_simple_get(&iio_trigger_ida, 0, 0, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) if (trig_info->id < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) return trig_info->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) /* Set the name used for the sysfs directory etc */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) dev_set_name(&trig_info->dev, "trigger%ld",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) (unsigned long) trig_info->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) ret = device_add(&trig_info->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) goto error_unregister_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) /* Add to list of available triggers held by the IIO core */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) mutex_lock(&iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (__iio_trigger_find_by_name(trig_info->name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) pr_err("Duplicate trigger name '%s'\n", trig_info->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) ret = -EEXIST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) goto error_device_del;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) list_add_tail(&trig_info->list, &iio_trigger_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) mutex_unlock(&iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) error_device_del:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) mutex_unlock(&iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) device_del(&trig_info->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) error_unregister_id:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) ida_simple_remove(&iio_trigger_ida, trig_info->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) EXPORT_SYMBOL(__iio_trigger_register);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) void iio_trigger_unregister(struct iio_trigger *trig_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) mutex_lock(&iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) list_del(&trig_info->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) mutex_unlock(&iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) ida_simple_remove(&iio_trigger_ida, trig_info->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) /* Possible issue in here */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) device_del(&trig_info->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) EXPORT_SYMBOL(iio_trigger_unregister);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) int iio_trigger_set_immutable(struct iio_dev *indio_dev, struct iio_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) if (!indio_dev || !trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) mutex_lock(&indio_dev->mlock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) WARN_ON(indio_dev->trig_readonly);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) indio_dev->trig = iio_trigger_get(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) indio_dev->trig_readonly = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) mutex_unlock(&indio_dev->mlock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) EXPORT_SYMBOL(iio_trigger_set_immutable);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) /* Search for trigger by name, assuming iio_trigger_list_lock held */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) static struct iio_trigger *__iio_trigger_find_by_name(const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) struct iio_trigger *iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) list_for_each_entry(iter, &iio_trigger_list, list)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) if (!strcmp(iter->name, name))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) return iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static struct iio_trigger *iio_trigger_acquire_by_name(const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) struct iio_trigger *trig = NULL, *iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) mutex_lock(&iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) list_for_each_entry(iter, &iio_trigger_list, list)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) if (sysfs_streq(iter->name, name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) trig = iter;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) iio_trigger_get(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) mutex_unlock(&iio_trigger_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) return trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) void iio_trigger_poll(struct iio_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) if (!atomic_read(&trig->use_count)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) atomic_set(&trig->use_count, CONFIG_IIO_CONSUMERS_PER_TRIGGER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) for (i = 0; i < CONFIG_IIO_CONSUMERS_PER_TRIGGER; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (trig->subirqs[i].enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) generic_handle_irq(trig->subirq_base + i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) iio_trigger_notify_done(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) EXPORT_SYMBOL(iio_trigger_poll);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) irqreturn_t iio_trigger_generic_data_rdy_poll(int irq, void *private)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) iio_trigger_poll(private);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) EXPORT_SYMBOL(iio_trigger_generic_data_rdy_poll);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) void iio_trigger_poll_chained(struct iio_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) if (!atomic_read(&trig->use_count)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) atomic_set(&trig->use_count, CONFIG_IIO_CONSUMERS_PER_TRIGGER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) for (i = 0; i < CONFIG_IIO_CONSUMERS_PER_TRIGGER; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) if (trig->subirqs[i].enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) handle_nested_irq(trig->subirq_base + i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) iio_trigger_notify_done(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) EXPORT_SYMBOL(iio_trigger_poll_chained);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) void iio_trigger_notify_done(struct iio_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) if (atomic_dec_and_test(&trig->use_count) && trig->ops &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) trig->ops->try_reenable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) if (trig->ops->try_reenable(trig))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) /* Missed an interrupt so launch new poll now */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) iio_trigger_poll(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) EXPORT_SYMBOL(iio_trigger_notify_done);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) /* Trigger Consumer related functions */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) static int iio_trigger_get_irq(struct iio_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) mutex_lock(&trig->pool_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) ret = bitmap_find_free_region(trig->pool,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) CONFIG_IIO_CONSUMERS_PER_TRIGGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) ilog2(1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) mutex_unlock(&trig->pool_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) if (ret >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) ret += trig->subirq_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) static void iio_trigger_put_irq(struct iio_trigger *trig, int irq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) mutex_lock(&trig->pool_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) clear_bit(irq - trig->subirq_base, trig->pool);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) mutex_unlock(&trig->pool_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) /* Complexity in here. With certain triggers (datardy) an acknowledgement
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) * may be needed if the pollfuncs do not include the data read for the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) * triggering device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) * This is not currently handled. Alternative of not enabling trigger unless
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) * the relevant function is in there may be the best option.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) /* Worth protecting against double additions? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) int iio_trigger_attach_poll_func(struct iio_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) struct iio_poll_func *pf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) bool notinuse
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) = bitmap_empty(trig->pool, CONFIG_IIO_CONSUMERS_PER_TRIGGER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) /* Prevent the module from being removed whilst attached to a trigger */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) __module_get(pf->indio_dev->driver_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) /* Get irq number */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) pf->irq = iio_trigger_get_irq(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) if (pf->irq < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) pr_err("Could not find an available irq for trigger %s, CONFIG_IIO_CONSUMERS_PER_TRIGGER=%d limit might be exceeded\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) trig->name, CONFIG_IIO_CONSUMERS_PER_TRIGGER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) goto out_put_module;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) /* Request irq */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) ret = request_threaded_irq(pf->irq, pf->h, pf->thread,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) pf->type, pf->name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) pf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) goto out_put_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) /* Enable trigger in driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) if (trig->ops && trig->ops->set_trigger_state && notinuse) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) ret = trig->ops->set_trigger_state(trig, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) goto out_free_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) * Check if we just registered to our own trigger: we determine that
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) * this is the case if the IIO device and the trigger device share the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) * same parent device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) if (pf->indio_dev->dev.parent == trig->dev.parent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) trig->attached_own_device = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) out_free_irq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) free_irq(pf->irq, pf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) out_put_irq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) iio_trigger_put_irq(trig, pf->irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) out_put_module:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) module_put(pf->indio_dev->driver_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) int iio_trigger_detach_poll_func(struct iio_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) struct iio_poll_func *pf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) bool no_other_users
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) = (bitmap_weight(trig->pool,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) CONFIG_IIO_CONSUMERS_PER_TRIGGER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) == 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (trig->ops && trig->ops->set_trigger_state && no_other_users) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) ret = trig->ops->set_trigger_state(trig, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) if (pf->indio_dev->dev.parent == trig->dev.parent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) trig->attached_own_device = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) iio_trigger_put_irq(trig, pf->irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) free_irq(pf->irq, pf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) module_put(pf->indio_dev->driver_module);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) irqreturn_t iio_pollfunc_store_time(int irq, void *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) struct iio_poll_func *pf = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) pf->timestamp = iio_get_time_ns(pf->indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) return IRQ_WAKE_THREAD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) EXPORT_SYMBOL(iio_pollfunc_store_time);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) struct iio_poll_func
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) *iio_alloc_pollfunc(irqreturn_t (*h)(int irq, void *p),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) irqreturn_t (*thread)(int irq, void *p),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) int type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) struct iio_dev *indio_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) const char *fmt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) va_list vargs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) struct iio_poll_func *pf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) pf = kmalloc(sizeof *pf, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) if (pf == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) va_start(vargs, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) pf->name = kvasprintf(GFP_KERNEL, fmt, vargs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) va_end(vargs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (pf->name == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) kfree(pf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) pf->h = h;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) pf->thread = thread;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) pf->type = type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) pf->indio_dev = indio_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) return pf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) EXPORT_SYMBOL_GPL(iio_alloc_pollfunc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) void iio_dealloc_pollfunc(struct iio_poll_func *pf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) kfree(pf->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) kfree(pf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) EXPORT_SYMBOL_GPL(iio_dealloc_pollfunc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) * iio_trigger_read_current() - trigger consumer sysfs query current trigger
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) * @dev: device associated with an industrial I/O device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) * @attr: pointer to the device_attribute structure that
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) * is being processed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) * @buf: buffer where the current trigger name will be printed into
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) * For trigger consumers the current_trigger interface allows the trigger
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) * used by the device to be queried.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) * Return: a negative number on failure, the number of characters written
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) * on success or 0 if no trigger is available
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) static ssize_t iio_trigger_read_current(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) struct iio_dev *indio_dev = dev_to_iio_dev(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) if (indio_dev->trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) return sprintf(buf, "%s\n", indio_dev->trig->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) * iio_trigger_write_current() - trigger consumer sysfs set current trigger
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) * @dev: device associated with an industrial I/O device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) * @attr: device attribute that is being processed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) * @buf: string buffer that holds the name of the trigger
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) * @len: length of the trigger name held by buf
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) * For trigger consumers the current_trigger interface allows the trigger
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) * used for this device to be specified at run time based on the trigger's
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) * name.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) * Return: negative error code on failure or length of the buffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) * on success
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) static ssize_t iio_trigger_write_current(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) struct device_attribute *attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) const char *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) struct iio_dev *indio_dev = dev_to_iio_dev(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) struct iio_trigger *oldtrig = indio_dev->trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) struct iio_trigger *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) mutex_lock(&indio_dev->mlock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) if (indio_dev->currentmode == INDIO_BUFFER_TRIGGERED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) mutex_unlock(&indio_dev->mlock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) if (indio_dev->trig_readonly) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) mutex_unlock(&indio_dev->mlock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) mutex_unlock(&indio_dev->mlock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) trig = iio_trigger_acquire_by_name(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) if (oldtrig == trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) ret = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) goto out_trigger_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) if (trig && indio_dev->info->validate_trigger) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) ret = indio_dev->info->validate_trigger(indio_dev, trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) goto out_trigger_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) if (trig && trig->ops && trig->ops->validate_device) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) ret = trig->ops->validate_device(trig, indio_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) goto out_trigger_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) indio_dev->trig = trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) if (oldtrig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) if (indio_dev->modes & INDIO_EVENT_TRIGGERED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) iio_trigger_detach_poll_func(oldtrig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) indio_dev->pollfunc_event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) iio_trigger_put(oldtrig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if (indio_dev->trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) if (indio_dev->modes & INDIO_EVENT_TRIGGERED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) iio_trigger_attach_poll_func(indio_dev->trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) indio_dev->pollfunc_event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) return len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) out_trigger_put:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) if (trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) iio_trigger_put(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) static DEVICE_ATTR(current_trigger, S_IRUGO | S_IWUSR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) iio_trigger_read_current,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) iio_trigger_write_current);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) static struct attribute *iio_trigger_consumer_attrs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) &dev_attr_current_trigger.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) static const struct attribute_group iio_trigger_consumer_attr_group = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) .name = "trigger",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) .attrs = iio_trigger_consumer_attrs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) static void iio_trig_release(struct device *device)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) struct iio_trigger *trig = to_iio_trigger(device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) if (trig->subirq_base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) for (i = 0; i < CONFIG_IIO_CONSUMERS_PER_TRIGGER; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) irq_modify_status(trig->subirq_base + i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) IRQ_NOAUTOEN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) IRQ_NOREQUEST | IRQ_NOPROBE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) irq_set_chip(trig->subirq_base + i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) irq_set_handler(trig->subirq_base + i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) irq_free_descs(trig->subirq_base,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) CONFIG_IIO_CONSUMERS_PER_TRIGGER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) kfree(trig->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) kfree(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) static const struct device_type iio_trig_type = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) .release = iio_trig_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) .groups = iio_trig_dev_groups,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) static void iio_trig_subirqmask(struct irq_data *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) struct irq_chip *chip = irq_data_get_irq_chip(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) struct iio_trigger *trig
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) = container_of(chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) struct iio_trigger, subirq_chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) trig->subirqs[d->irq - trig->subirq_base].enabled = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) static void iio_trig_subirqunmask(struct irq_data *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) struct irq_chip *chip = irq_data_get_irq_chip(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) struct iio_trigger *trig
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) = container_of(chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) struct iio_trigger, subirq_chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) trig->subirqs[d->irq - trig->subirq_base].enabled = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) static __printf(1, 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) struct iio_trigger *viio_trigger_alloc(const char *fmt, va_list vargs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) struct iio_trigger *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) trig = kzalloc(sizeof *trig, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) if (!trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) trig->dev.type = &iio_trig_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) trig->dev.bus = &iio_bus_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) device_initialize(&trig->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) mutex_init(&trig->pool_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) trig->subirq_base = irq_alloc_descs(-1, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) CONFIG_IIO_CONSUMERS_PER_TRIGGER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) if (trig->subirq_base < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) goto free_trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) trig->name = kvasprintf(GFP_KERNEL, fmt, vargs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) if (trig->name == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) goto free_descs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) trig->subirq_chip.name = trig->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) trig->subirq_chip.irq_mask = &iio_trig_subirqmask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) trig->subirq_chip.irq_unmask = &iio_trig_subirqunmask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) for (i = 0; i < CONFIG_IIO_CONSUMERS_PER_TRIGGER; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) irq_set_chip(trig->subirq_base + i, &trig->subirq_chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) irq_set_handler(trig->subirq_base + i, &handle_simple_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) irq_modify_status(trig->subirq_base + i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) IRQ_NOREQUEST | IRQ_NOAUTOEN, IRQ_NOPROBE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) return trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) free_descs:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) irq_free_descs(trig->subirq_base, CONFIG_IIO_CONSUMERS_PER_TRIGGER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) free_trig:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) kfree(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) struct iio_trigger *iio_trigger_alloc(const char *fmt, ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) struct iio_trigger *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) va_list vargs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) va_start(vargs, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) trig = viio_trigger_alloc(fmt, vargs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) va_end(vargs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) return trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) EXPORT_SYMBOL(iio_trigger_alloc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) void iio_trigger_free(struct iio_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) if (trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) put_device(&trig->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) EXPORT_SYMBOL(iio_trigger_free);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) static void devm_iio_trigger_release(struct device *dev, void *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) iio_trigger_free(*(struct iio_trigger **)res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) * devm_iio_trigger_alloc - Resource-managed iio_trigger_alloc()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) * @dev: Device to allocate iio_trigger for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) * @fmt: trigger name format. If it includes format
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) * specifiers, the additional arguments following
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) * format are formatted and inserted in the resulting
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) * string replacing their respective specifiers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) * Managed iio_trigger_alloc. iio_trigger allocated with this function is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) * automatically freed on driver detach.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) * RETURNS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) * Pointer to allocated iio_trigger on success, NULL on failure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) struct iio_trigger *devm_iio_trigger_alloc(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) const char *fmt, ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) struct iio_trigger **ptr, *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) va_list vargs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) ptr = devres_alloc(devm_iio_trigger_release, sizeof(*ptr),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) if (!ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) /* use raw alloc_dr for kmalloc caller tracing */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) va_start(vargs, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) trig = viio_trigger_alloc(fmt, vargs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) va_end(vargs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) if (trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) *ptr = trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) devres_add(dev, ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) devres_free(ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) return trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) EXPORT_SYMBOL_GPL(devm_iio_trigger_alloc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) static void devm_iio_trigger_unreg(struct device *dev, void *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) iio_trigger_unregister(*(struct iio_trigger **)res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) * __devm_iio_trigger_register - Resource-managed iio_trigger_register()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) * @dev: device this trigger was allocated for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) * @trig_info: trigger to register
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) * @this_mod: module registering the trigger
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) * Managed iio_trigger_register(). The IIO trigger registered with this
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) * function is automatically unregistered on driver detach. This function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) * calls iio_trigger_register() internally. Refer to that function for more
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) * information.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) * RETURNS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) * 0 on success, negative error number on failure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) int __devm_iio_trigger_register(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) struct iio_trigger *trig_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) struct module *this_mod)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) struct iio_trigger **ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) ptr = devres_alloc(devm_iio_trigger_unreg, sizeof(*ptr), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) if (!ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) *ptr = trig_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) ret = __iio_trigger_register(trig_info, this_mod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) if (!ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) devres_add(dev, ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) devres_free(ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) EXPORT_SYMBOL_GPL(__devm_iio_trigger_register);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) bool iio_trigger_using_own(struct iio_dev *indio_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) return indio_dev->trig->attached_own_device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) EXPORT_SYMBOL(iio_trigger_using_own);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) * iio_trigger_validate_own_device - Check if a trigger and IIO device belong to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) * the same device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) * @trig: The IIO trigger to check
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) * @indio_dev: the IIO device to check
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) * This function can be used as the validate_device callback for triggers that
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) * can only be attached to their own device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) * Return: 0 if both the trigger and the IIO device belong to the same
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) * device, -EINVAL otherwise.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) int iio_trigger_validate_own_device(struct iio_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) struct iio_dev *indio_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) if (indio_dev->dev.parent != trig->dev.parent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) EXPORT_SYMBOL(iio_trigger_validate_own_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) void iio_device_register_trigger_consumer(struct iio_dev *indio_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) indio_dev->groups[indio_dev->groupcounter++] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) &iio_trigger_consumer_attr_group;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) void iio_device_unregister_trigger_consumer(struct iio_dev *indio_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) /* Clean up an associated but not attached trigger reference */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) if (indio_dev->trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) iio_trigger_put(indio_dev->trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags