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) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * linux/drivers/leds/leds-locomo.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) 
^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/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <mach/hardware.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <asm/hardware/locomo.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) static void locomoled_brightness_set(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 				enum led_brightness value, int offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	struct locomo_dev *locomo_dev = LOCOMO_DEV(led_cdev->dev->parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	local_irq_save(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	if (value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 		locomo_writel(LOCOMO_LPT_TOFH, locomo_dev->mapbase + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 		locomo_writel(LOCOMO_LPT_TOFL, locomo_dev->mapbase + offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	local_irq_restore(flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) static void locomoled_brightness_set0(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 				enum led_brightness value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	locomoled_brightness_set(led_cdev, value, LOCOMO_LPT0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) static void locomoled_brightness_set1(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 				enum led_brightness value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	locomoled_brightness_set(led_cdev, value, LOCOMO_LPT1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) static struct led_classdev locomo_led0 = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	.name			= "locomo:amber:charge",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	.default_trigger	= "main-battery-charging",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	.brightness_set		= locomoled_brightness_set0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) static struct led_classdev locomo_led1 = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	.name			= "locomo:green:mail",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	.default_trigger	= "nand-disk",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	.brightness_set		= locomoled_brightness_set1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) static int locomoled_probe(struct locomo_dev *ldev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	ret = devm_led_classdev_register(&ldev->dev, &locomo_led0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 	return  devm_led_classdev_register(&ldev->dev, &locomo_led1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) static struct locomo_driver locomoled_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	.drv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 		.name = "locomoled"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	.devid	= LOCOMO_DEVID_LED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	.probe	= locomoled_probe,
^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 int __init locomoled_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	return locomo_driver_register(&locomoled_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) module_init(locomoled_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) MODULE_DESCRIPTION("Locomo LED driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) MODULE_LICENSE("GPL");