Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^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)  * LED Triggers Core
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright 2005-2007 Openedhand Ltd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  * Author: Richard Purdie <rpurdie@openedhand.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/export.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/kernel.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/spinlock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/timer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/rwsem.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include "leds.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23)  * Nests outside led_cdev->trigger_lock
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) static DECLARE_RWSEM(triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) LIST_HEAD(trigger_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28)  /* Used by LED Class */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) static inline bool
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) trigger_relevant(struct led_classdev *led_cdev, struct led_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	return !trig->trigger_type || trig->trigger_type == led_cdev->trigger_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) ssize_t led_trigger_write(struct file *filp, struct kobject *kobj,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 			  struct bin_attribute *bin_attr, char *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 			  loff_t pos, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	struct device *dev = kobj_to_dev(kobj);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	struct led_classdev *led_cdev = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	struct led_trigger *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	int ret = count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	mutex_lock(&led_cdev->led_access);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	if (led_sysfs_is_disabled(led_cdev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 		ret = -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 		goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	if (sysfs_streq(buf, "none")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 		led_trigger_remove(led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 		goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	down_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	list_for_each_entry(trig, &trigger_list, next_trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 		if (sysfs_streq(buf, trig->name) && trigger_relevant(led_cdev, trig)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 			down_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 			led_trigger_set(led_cdev, trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 			up_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 			up_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 			goto unlock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	/* we come here only if buf matches no trigger */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	up_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) unlock:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	mutex_unlock(&led_cdev->led_access);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) EXPORT_SYMBOL_GPL(led_trigger_write);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) __printf(3, 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) static int led_trigger_snprintf(char *buf, ssize_t size, const char *fmt, ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	va_list args;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	va_start(args, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	if (size <= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		i = vsnprintf(NULL, 0, fmt, args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 		i = vscnprintf(buf, size, fmt, args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	va_end(args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	return i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) static int led_trigger_format(char *buf, size_t size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 			      struct led_classdev *led_cdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	struct led_trigger *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	int len = led_trigger_snprintf(buf, size, "%s",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 				       led_cdev->trigger ? "none" : "[none]");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	list_for_each_entry(trig, &trigger_list, next_trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		bool hit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		if (!trigger_relevant(led_cdev, trig))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 		hit = led_cdev->trigger && !strcmp(led_cdev->trigger->name, trig->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 		len += led_trigger_snprintf(buf + len, size - len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 					    " %s%s%s", hit ? "[" : "",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 					    trig->name, hit ? "]" : "");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	len += led_trigger_snprintf(buf + len, size - len, "\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	return len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)  * It was stupid to create 10000 cpu triggers, but we are stuck with it now.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)  * Don't make that mistake again. We work around it here by creating binary
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)  * attribute, which is not limited by length. This is _not_ good design, do not
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)  * copy it.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) ssize_t led_trigger_read(struct file *filp, struct kobject *kobj,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 			struct bin_attribute *attr, char *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 			loff_t pos, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	struct device *dev = kobj_to_dev(kobj);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	struct led_classdev *led_cdev = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	void *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	down_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	down_read(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	len = led_trigger_format(NULL, 0, led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	data = kvmalloc(len + 1, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	if (!data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 		up_read(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 		up_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	len = led_trigger_format(data, len + 1, led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	up_read(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	up_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	len = memory_read_from_buffer(buf, count, &pos, data, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	kvfree(data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	return len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) EXPORT_SYMBOL_GPL(led_trigger_read);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) /* Caller must ensure led_cdev->trigger_lock held */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) int led_trigger_set(struct led_classdev *led_cdev, struct led_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	char *event = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	char *envp[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	const char *name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	if (!led_cdev->trigger && !trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	name = trig ? trig->name : "none";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	event = kasprintf(GFP_KERNEL, "TRIGGER=%s", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	/* Remove any existing trigger */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	if (led_cdev->trigger) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 		write_lock_irqsave(&led_cdev->trigger->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 		list_del(&led_cdev->trig_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		write_unlock_irqrestore(&led_cdev->trigger->leddev_list_lock,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 			flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		cancel_work_sync(&led_cdev->set_brightness_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 		led_stop_software_blink(led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 		if (led_cdev->trigger->deactivate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 			led_cdev->trigger->deactivate(led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		device_remove_groups(led_cdev->dev, led_cdev->trigger->groups);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		led_cdev->trigger = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		led_cdev->trigger_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 		led_cdev->activated = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 		led_set_brightness(led_cdev, LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	if (trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		write_lock_irqsave(&trig->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 		list_add_tail(&led_cdev->trig_list, &trig->led_cdevs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 		write_unlock_irqrestore(&trig->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		led_cdev->trigger = trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 		if (trig->activate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 			ret = trig->activate(led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 			ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 		if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 			goto err_activate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 		ret = device_add_groups(led_cdev->dev, trig->groups);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 		if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 			dev_err(led_cdev->dev, "Failed to add trigger attributes\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 			goto err_add_groups;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	if (event) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		envp[0] = event;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 		envp[1] = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		if (kobject_uevent_env(&led_cdev->dev->kobj, KOBJ_CHANGE, envp))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 			dev_err(led_cdev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 				"%s: Error sending uevent\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		kfree(event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) err_add_groups:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	if (trig->deactivate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		trig->deactivate(led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) err_activate:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	write_lock_irqsave(&led_cdev->trigger->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	list_del(&led_cdev->trig_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	write_unlock_irqrestore(&led_cdev->trigger->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	led_cdev->trigger = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	led_cdev->trigger_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	led_set_brightness(led_cdev, LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	kfree(event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) EXPORT_SYMBOL_GPL(led_trigger_set);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) void led_trigger_remove(struct led_classdev *led_cdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	down_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	led_trigger_set(led_cdev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	up_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) EXPORT_SYMBOL_GPL(led_trigger_remove);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) void led_trigger_set_default(struct led_classdev *led_cdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	struct led_trigger *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	if (!led_cdev->default_trigger)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	down_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	down_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	list_for_each_entry(trig, &trigger_list, next_trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 		if (!strcmp(led_cdev->default_trigger, trig->name) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 		    trigger_relevant(led_cdev, trig)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 			led_cdev->flags |= LED_INIT_DEFAULT_TRIGGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 			led_trigger_set(led_cdev, trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	up_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	up_read(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) EXPORT_SYMBOL_GPL(led_trigger_set_default);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) void led_trigger_rename_static(const char *name, struct led_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	/* new name must be on a temporary string to prevent races */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	BUG_ON(name == trig->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 	down_write(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	/* this assumes that trig->name was originaly allocated to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	 * non constant storage */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	strcpy((char *)trig->name, name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	up_write(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) EXPORT_SYMBOL_GPL(led_trigger_rename_static);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) /* LED Trigger Interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) int led_trigger_register(struct led_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	struct led_classdev *led_cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	struct led_trigger *_trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	rwlock_init(&trig->leddev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	INIT_LIST_HEAD(&trig->led_cdevs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	down_write(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	/* Make sure the trigger's name isn't already in use */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	list_for_each_entry(_trig, &trigger_list, next_trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 		if (!strcmp(_trig->name, trig->name) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 		    (trig->trigger_type == _trig->trigger_type ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 		     !trig->trigger_type || !_trig->trigger_type)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 			up_write(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 			return -EEXIST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	/* Add to the list of led triggers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	list_add_tail(&trig->next_trig, &trigger_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	up_write(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 	/* Register with any LEDs that have this as a default trigger */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	down_read(&leds_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	list_for_each_entry(led_cdev, &leds_list, node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 		down_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 		if (!led_cdev->trigger && led_cdev->default_trigger &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 		    !strcmp(led_cdev->default_trigger, trig->name) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 		    trigger_relevant(led_cdev, trig)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 			led_cdev->flags |= LED_INIT_DEFAULT_TRIGGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 			led_trigger_set(led_cdev, trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 		up_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	up_read(&leds_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) EXPORT_SYMBOL_GPL(led_trigger_register);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) void led_trigger_unregister(struct led_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	struct led_classdev *led_cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	if (list_empty_careful(&trig->next_trig))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	/* Remove from the list of led triggers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	down_write(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	list_del_init(&trig->next_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	up_write(&triggers_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	/* Remove anyone actively using this trigger */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	down_read(&leds_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 	list_for_each_entry(led_cdev, &leds_list, node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 		down_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 		if (led_cdev->trigger == trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 			led_trigger_set(led_cdev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 		up_write(&led_cdev->trigger_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	up_read(&leds_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) EXPORT_SYMBOL_GPL(led_trigger_unregister);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) static void devm_led_trigger_release(struct device *dev, void *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	led_trigger_unregister(*(struct led_trigger **)res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) int devm_led_trigger_register(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 			      struct led_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	struct led_trigger **dr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	dr = devres_alloc(devm_led_trigger_release, sizeof(*dr),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 			  GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	if (!dr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 	*dr = trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	rc = led_trigger_register(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 	if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 		devres_free(dr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 		devres_add(dev, dr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 	return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) EXPORT_SYMBOL_GPL(devm_led_trigger_register);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) /* Simple LED Trigger Interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) void led_trigger_event(struct led_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 			enum led_brightness brightness)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 	struct led_classdev *led_cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 	if (!trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 	read_lock_irqsave(&trig->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 	list_for_each_entry(led_cdev, &trig->led_cdevs, trig_list)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 		led_set_brightness(led_cdev, brightness);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	read_unlock_irqrestore(&trig->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) EXPORT_SYMBOL_GPL(led_trigger_event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) static void led_trigger_blink_setup(struct led_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 			     unsigned long *delay_on,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 			     unsigned long *delay_off,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 			     int oneshot,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 			     int invert)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	struct led_classdev *led_cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 	if (!trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 	read_lock_irqsave(&trig->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	list_for_each_entry(led_cdev, &trig->led_cdevs, trig_list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 		if (oneshot)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 			led_blink_set_oneshot(led_cdev, delay_on, delay_off,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 					      invert);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 			led_blink_set(led_cdev, delay_on, delay_off);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 	read_unlock_irqrestore(&trig->leddev_list_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) void led_trigger_blink(struct led_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 		       unsigned long *delay_on,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 		       unsigned long *delay_off)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 	led_trigger_blink_setup(trig, delay_on, delay_off, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) EXPORT_SYMBOL_GPL(led_trigger_blink);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) void led_trigger_blink_oneshot(struct led_trigger *trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 			       unsigned long *delay_on,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 			       unsigned long *delay_off,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 			       int invert)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 	led_trigger_blink_setup(trig, delay_on, delay_off, 1, invert);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) EXPORT_SYMBOL_GPL(led_trigger_blink_oneshot);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) void led_trigger_register_simple(const char *name, struct led_trigger **tp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 	struct led_trigger *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 	trig = kzalloc(sizeof(struct led_trigger), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 	if (trig) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 		trig->name = name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 		err = led_trigger_register(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 		if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 			kfree(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 			trig = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 			pr_warn("LED trigger %s failed to register (%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 				name, err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 		pr_warn("LED trigger %s failed to register (no memory)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 			name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 	*tp = trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) EXPORT_SYMBOL_GPL(led_trigger_register_simple);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) void led_trigger_unregister_simple(struct led_trigger *trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 	if (trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 		led_trigger_unregister(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 	kfree(trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) EXPORT_SYMBOL_GPL(led_trigger_unregister_simple);