Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * LED Driver for SGI Octane machines
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #define IP30_LED_SYSTEM	0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #define IP30_LED_FAULT	1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) struct ip30_led {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	struct led_classdev cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	u32 __iomem *reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) static void ip30led_set(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 			enum led_brightness value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	struct ip30_led *led = container_of(led_cdev, struct ip30_led, cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	writel(value, led->reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static int ip30led_create(struct platform_device *pdev, int num)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	struct ip30_led *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	res = platform_get_resource(pdev, IORESOURCE_MEM, num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	if (!res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 		return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	if (!data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	data->reg = devm_ioremap_resource(&pdev->dev, res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	if (IS_ERR(data->reg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 		return PTR_ERR(data->reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	switch (num) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	case IP30_LED_SYSTEM:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 		data->cdev.name = "white:power";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	case IP30_LED_FAULT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 		data->cdev.name = "red:fault";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 		return -EINVAL;
^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) 	data->cdev.brightness = readl(data->reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	data->cdev.max_brightness = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	data->cdev.brightness_set = ip30led_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 	return devm_led_classdev_register(&pdev->dev, &data->cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) static int ip30led_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	ret = ip30led_create(pdev, IP30_LED_SYSTEM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	return ip30led_create(pdev, IP30_LED_FAULT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) static struct platform_driver ip30led_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 	.probe		= ip30led_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	.driver		= {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 		.name		= "ip30-leds",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) module_platform_driver(ip30led_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) MODULE_AUTHOR("Thomas Bogendoerfer <tbogendoerfer@suse.de>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) MODULE_DESCRIPTION("SGI Octane LED driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) MODULE_ALIAS("platform:ip30-leds");