1 // SPDX-License-Identifier: GPL-2.0-only
15 #include <linux/iio/iio.h>
16 #include <linux/iio/iio-opaque.h>
17 #include <linux/iio/trigger.h>
20 #include <linux/iio/trigger_consumer.h>
22 /* RFC - Question of approach
40  * name_show() - retrieve useful identifying name
54 	return sysfs_emit(buf, "%s\n", trig->name);  in name_show()
71 	trig_info->id = ida_alloc(&iio_trigger_ida, GFP_KERNEL);  in iio_trigger_register()
72 	if (trig_info->id < 0)  in iio_trigger_register()
73 		return trig_info->id;  in iio_trigger_register()
76 	dev_set_name(&trig_info->dev, "trigger%d", trig_info->id);  in iio_trigger_register()
78 	ret = device_add(&trig_info->dev);  in iio_trigger_register()
82 	/* Add to list of available triggers held by the IIO core */  in iio_trigger_register()
84 	if (__iio_trigger_find_by_name(trig_info->name)) {  in iio_trigger_register()
85 		pr_err("Duplicate trigger name '%s'\n", trig_info->name);  in iio_trigger_register()
86 		ret = -EEXIST;  in iio_trigger_register()
89 	list_add_tail(&trig_info->list, &iio_trigger_list);  in iio_trigger_register()
96 	device_del(&trig_info->dev);  in iio_trigger_register()
98 	ida_free(&iio_trigger_ida, trig_info->id);  in iio_trigger_register()
106 	list_del(&trig_info->list);  in iio_trigger_unregister()
109 	ida_free(&iio_trigger_ida, trig_info->id);  in iio_trigger_unregister()
111 	device_del(&trig_info->dev);  in iio_trigger_unregister()
120 		return -EINVAL;  in iio_trigger_set_immutable()
123 	mutex_lock(&iio_dev_opaque->mlock);  in iio_trigger_set_immutable()
124 	WARN_ON(iio_dev_opaque->trig_readonly);  in iio_trigger_set_immutable()
126 	indio_dev->trig = iio_trigger_get(trig);  in iio_trigger_set_immutable()
127 	iio_dev_opaque->trig_readonly = true;  in iio_trigger_set_immutable()
128 	mutex_unlock(&iio_dev_opaque->mlock);  in iio_trigger_set_immutable()
140 		if (!strcmp(iter->name, name))  in __iio_trigger_find_by_name()
152 		if (sysfs_streq(iter->name, name)) {  in iio_trigger_acquire_by_name()
168 	 * This 'might' occur after the trigger state is set to disabled -  in iio_reenable_work_fn()
171 	trig->ops->reenable(trig);  in iio_reenable_work_fn()
190 	if (atomic_dec_and_test(&trig->use_count) && trig->ops &&  in iio_trigger_notify_done_atomic()
191 	    trig->ops->reenable)  in iio_trigger_notify_done_atomic()
192 		schedule_work(&trig->reenable_work);  in iio_trigger_notify_done_atomic()
196  * iio_trigger_poll() - Call the IRQ trigger handler of the consumers
205 	if (!atomic_read(&trig->use_count)) {  in iio_trigger_poll()
206 		atomic_set(&trig->use_count, CONFIG_IIO_CONSUMERS_PER_TRIGGER);  in iio_trigger_poll()
209 			if (trig->subirqs[i].enabled)  in iio_trigger_poll()
210 				generic_handle_irq(trig->subirq_base + i);  in iio_trigger_poll()
226  * iio_trigger_poll_nested() - Call the threaded trigger handler of the
236 	if (!atomic_read(&trig->use_count)) {  in iio_trigger_poll_nested()
237 		atomic_set(&trig->use_count, CONFIG_IIO_CONSUMERS_PER_TRIGGER);  in iio_trigger_poll_nested()
240 			if (trig->subirqs[i].enabled)  in iio_trigger_poll_nested()
241 				handle_nested_irq(trig->subirq_base + i);  in iio_trigger_poll_nested()
251 	if (atomic_dec_and_test(&trig->use_count) && trig->ops &&  in iio_trigger_notify_done()
252 	    trig->ops->reenable)  in iio_trigger_notify_done()
253 		trig->ops->reenable(trig);  in iio_trigger_notify_done()
257 /* Trigger Consumer related functions */
262 	mutex_lock(&trig->pool_lock);  in iio_trigger_get_irq()
263 	ret = bitmap_find_free_region(trig->pool,  in iio_trigger_get_irq()
266 	mutex_unlock(&trig->pool_lock);  in iio_trigger_get_irq()
268 		ret += trig->subirq_base;  in iio_trigger_get_irq()
275 	mutex_lock(&trig->pool_lock);  in iio_trigger_put_irq()
276 	clear_bit(irq - trig->subirq_base, trig->pool);  in iio_trigger_put_irq()
277 	mutex_unlock(&trig->pool_lock);  in iio_trigger_put_irq()
290 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(pf->indio_dev);  in iio_trigger_attach_poll_func()
292 		bitmap_empty(trig->pool, CONFIG_IIO_CONSUMERS_PER_TRIGGER);  in iio_trigger_attach_poll_func()
296 	__module_get(iio_dev_opaque->driver_module);  in iio_trigger_attach_poll_func()
299 	pf->irq = iio_trigger_get_irq(trig);  in iio_trigger_attach_poll_func()
300 	if (pf->irq < 0) {  in iio_trigger_attach_poll_func()
302 			trig->name, CONFIG_IIO_CONSUMERS_PER_TRIGGER);  in iio_trigger_attach_poll_func()
307 	ret = request_threaded_irq(pf->irq, pf->h, pf->thread,  in iio_trigger_attach_poll_func()
308 				   pf->type, pf->name,  in iio_trigger_attach_poll_func()
314 	if (trig->ops && trig->ops->set_trigger_state && notinuse) {  in iio_trigger_attach_poll_func()
315 		ret = trig->ops->set_trigger_state(trig, true);  in iio_trigger_attach_poll_func()
322 	 * this is the case if the IIO device and the trigger device share the  in iio_trigger_attach_poll_func()
325 	if (!iio_validate_own_trigger(pf->indio_dev, trig))  in iio_trigger_attach_poll_func()
326 		trig->attached_own_device = true;  in iio_trigger_attach_poll_func()
331 	free_irq(pf->irq, pf);  in iio_trigger_attach_poll_func()
333 	iio_trigger_put_irq(trig, pf->irq);  in iio_trigger_attach_poll_func()
335 	module_put(iio_dev_opaque->driver_module);  in iio_trigger_attach_poll_func()
342 	struct iio_dev_opaque *iio_dev_opaque = to_iio_dev_opaque(pf->indio_dev);  in iio_trigger_detach_poll_func()
344 		bitmap_weight(trig->pool, CONFIG_IIO_CONSUMERS_PER_TRIGGER) == 1;  in iio_trigger_detach_poll_func()
347 	if (trig->ops && trig->ops->set_trigger_state && no_other_users) {  in iio_trigger_detach_poll_func()
348 		ret = trig->ops->set_trigger_state(trig, false);  in iio_trigger_detach_poll_func()
352 	if (pf->indio_dev->dev.parent == trig->dev.parent)  in iio_trigger_detach_poll_func()
353 		trig->attached_own_device = false;  in iio_trigger_detach_poll_func()
354 	iio_trigger_put_irq(trig, pf->irq);  in iio_trigger_detach_poll_func()
355 	free_irq(pf->irq, pf);  in iio_trigger_detach_poll_func()
356 	module_put(iio_dev_opaque->driver_module);  in iio_trigger_detach_poll_func()
365 	pf->timestamp = iio_get_time_ns(pf->indio_dev);  in iio_pollfunc_store_time()
385 	pf->name = kvasprintf(GFP_KERNEL, fmt, vargs);  in iio_alloc_pollfunc()
387 	if (pf->name == NULL) {  in iio_alloc_pollfunc()
391 	pf->h = h;  in iio_alloc_pollfunc()
392 	pf->thread = thread;  in iio_alloc_pollfunc()
393 	pf->type = type;  in iio_alloc_pollfunc()
394 	pf->indio_dev = indio_dev;  in iio_alloc_pollfunc()
402 	kfree(pf->name);  in iio_dealloc_pollfunc()
408  * current_trigger_show() - trigger consumer sysfs query current trigger
425 	if (indio_dev->trig)  in current_trigger_show()
426 		return sysfs_emit(buf, "%s\n", indio_dev->trig->name);  in current_trigger_show()
431  * current_trigger_store() - trigger consumer sysfs set current trigger
450 	struct iio_trigger *oldtrig = indio_dev->trig;  in current_trigger_store()
454 	mutex_lock(&iio_dev_opaque->mlock);  in current_trigger_store()
455 	if (iio_dev_opaque->currentmode == INDIO_BUFFER_TRIGGERED) {  in current_trigger_store()
456 		mutex_unlock(&iio_dev_opaque->mlock);  in current_trigger_store()
457 		return -EBUSY;  in current_trigger_store()
459 	if (iio_dev_opaque->trig_readonly) {  in current_trigger_store()
460 		mutex_unlock(&iio_dev_opaque->mlock);  in current_trigger_store()
461 		return -EPERM;  in current_trigger_store()
463 	mutex_unlock(&iio_dev_opaque->mlock);  in current_trigger_store()
471 	if (trig && indio_dev->info->validate_trigger) {  in current_trigger_store()
472 		ret = indio_dev->info->validate_trigger(indio_dev, trig);  in current_trigger_store()
477 	if (trig && trig->ops && trig->ops->validate_device) {  in current_trigger_store()
478 		ret = trig->ops->validate_device(trig, indio_dev);  in current_trigger_store()
483 	indio_dev->trig = trig;  in current_trigger_store()
486 		if (indio_dev->modes & INDIO_EVENT_TRIGGERED)  in current_trigger_store()
488 						     indio_dev->pollfunc_event);  in current_trigger_store()
491 	if (indio_dev->trig) {  in current_trigger_store()
492 		if (indio_dev->modes & INDIO_EVENT_TRIGGERED)  in current_trigger_store()
493 			iio_trigger_attach_poll_func(indio_dev->trig,  in current_trigger_store()
494 						     indio_dev->pollfunc_event);  in current_trigger_store()
522 	if (trig->subirq_base) {  in iio_trig_release()
524 			irq_modify_status(trig->subirq_base + i,  in iio_trig_release()
527 			irq_set_chip(trig->subirq_base + i,  in iio_trig_release()
529 			irq_set_handler(trig->subirq_base + i,  in iio_trig_release()
533 		irq_free_descs(trig->subirq_base,  in iio_trig_release()
536 	kfree(trig->name);  in iio_trig_release()
550 	trig->subirqs[d->irq - trig->subirq_base].enabled = false;  in iio_trig_subirqmask()
558 	trig->subirqs[d->irq - trig->subirq_base].enabled = true;  in iio_trig_subirqunmask()
574 	trig->dev.parent = parent;  in viio_trigger_alloc()
575 	trig->dev.type = &iio_trig_type;  in viio_trigger_alloc()
576 	trig->dev.bus = &iio_bus_type;  in viio_trigger_alloc()
577 	device_initialize(&trig->dev);  in viio_trigger_alloc()
578 	INIT_WORK(&trig->reenable_work, iio_reenable_work_fn);  in viio_trigger_alloc()
580 	mutex_init(&trig->pool_lock);  in viio_trigger_alloc()
581 	trig->subirq_base = irq_alloc_descs(-1, 0,  in viio_trigger_alloc()
584 	if (trig->subirq_base < 0)  in viio_trigger_alloc()
587 	trig->name = kvasprintf(GFP_KERNEL, fmt, vargs);  in viio_trigger_alloc()
588 	if (trig->name == NULL)  in viio_trigger_alloc()
591 	INIT_LIST_HEAD(&trig->list);  in viio_trigger_alloc()
593 	trig->owner = this_mod;  in viio_trigger_alloc()
595 	trig->subirq_chip.name = trig->name;  in viio_trigger_alloc()
596 	trig->subirq_chip.irq_mask = &iio_trig_subirqmask;  in viio_trigger_alloc()
597 	trig->subirq_chip.irq_unmask = &iio_trig_subirqunmask;  in viio_trigger_alloc()
599 		irq_set_chip(trig->subirq_base + i, &trig->subirq_chip);  in viio_trigger_alloc()
600 		irq_set_handler(trig->subirq_base + i, &handle_simple_irq);  in viio_trigger_alloc()
601 		irq_modify_status(trig->subirq_base + i,  in viio_trigger_alloc()
608 	irq_free_descs(trig->subirq_base, CONFIG_IIO_CONSUMERS_PER_TRIGGER);  in viio_trigger_alloc()
615  * __iio_trigger_alloc - Allocate a trigger
643 		put_device(&trig->dev);  in iio_trigger_free()
653  * __devm_iio_trigger_alloc - Resource-managed iio_trigger_alloc()
700  * devm_iio_trigger_register - Resource-managed iio_trigger_register()
704  * Managed iio_trigger_register().  The IIO trigger registered with this
727 	return indio_dev->trig->attached_own_device;  in iio_trigger_using_own()
732  * iio_validate_own_trigger - Check if a trigger and IIO device belong to
734  * @idev: the IIO device to check
735  * @trig: the IIO trigger to check
740  * Return: 0 if both the trigger and the IIO device belong to the same
741  * device, -EINVAL otherwise.
745 	if (idev->dev.parent != trig->dev.parent)  in iio_validate_own_trigger()
746 		return -EINVAL;  in iio_validate_own_trigger()
752  * iio_trigger_validate_own_device - Check if a trigger and IIO device belong to
754  * @trig: The IIO trigger to check
755  * @indio_dev: the IIO device to check
760  * Return: 0 if both the trigger and the IIO device belong to the same
761  * device, -EINVAL otherwise.
766 	if (indio_dev->dev.parent != trig->dev.parent)  in iio_trigger_validate_own_device()
767 		return -EINVAL;  in iio_trigger_validate_own_device()
781 	if (indio_dev->trig)  in iio_device_unregister_trigger_consumer()
782 		iio_trigger_put(indio_dev->trig);  in iio_device_unregister_trigger_consumer()