83 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * linux/drivers/leds/leds-locomo.c4 *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 else26 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");83