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