Orange Pi5 kernel

^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) /* drivers/leds/leds-s3c24xx.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  * (c) 2006 Simtec Electronics
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  *	http://armlinux.simtec.co.uk/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  *	Ben Dooks <ben@simtec.co.uk>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8)  * S3C24XX - LEDs GPIO driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 
^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/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/gpio/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/platform_data/leds-s3c24xx.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) /* our context */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct s3c24xx_gpio_led {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	struct led_classdev		 cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	struct s3c24xx_led_platdata	*pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	struct gpio_desc		*gpiod;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) static inline struct s3c24xx_gpio_led *to_gpio(struct led_classdev *led_cdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	return container_of(led_cdev, struct s3c24xx_gpio_led, cdev);
^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 void s3c24xx_led_set(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 			    enum led_brightness value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	struct s3c24xx_gpio_led *led = to_gpio(led_cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	gpiod_set_value(led->gpiod, !!value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) static int s3c24xx_led_probe(struct platform_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	struct s3c24xx_led_platdata *pdata = dev_get_platdata(&dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 	struct s3c24xx_gpio_led *led;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	led = devm_kzalloc(&dev->dev, sizeof(struct s3c24xx_gpio_led),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 			   GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	if (!led)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	led->cdev.brightness_set = s3c24xx_led_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	led->cdev.default_trigger = pdata->def_trigger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	led->cdev.name = pdata->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 	led->cdev.flags |= LED_CORE_SUSPENDRESUME;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	led->pdata = pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	/* Default to off */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	led->gpiod = devm_gpiod_get(&dev->dev, NULL, GPIOD_OUT_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	if (IS_ERR(led->gpiod))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 		return PTR_ERR(led->gpiod);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 	/* register our new led device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 	ret = devm_led_classdev_register(&dev->dev, &led->cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 		dev_err(&dev->dev, "led_classdev_register failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) static struct platform_driver s3c24xx_led_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	.probe		= s3c24xx_led_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 	.driver		= {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 		.name		= "s3c24xx_led",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) module_platform_driver(s3c24xx_led_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) MODULE_DESCRIPTION("S3C24XX LED driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) MODULE_ALIAS("platform:s3c24xx_led");