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