/* * Driver for the LED found on the EBSA110 machine * Based on Versatile and RealView machine LED code * * License terms: GNU General Public License (GPL) version 2 * Author: Bryan Wu <bryan.wu@canonical.com> */ #include <linux/kernel.h> #include <linux/init.h> #include <linux/io.h> #include <linux/slab.h> #include <linux/leds.h> #include <asm/mach-types.h> #include "core.h" #if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS) static void ebsa110_led_set(struct led_classdev *cdev, enum led_brightness b) { u8 reg = __raw_readb(SOFT_BASE); if (b != LED_OFF) reg |= 0x80; else reg &= ~0x80; __raw_writeb(reg, SOFT_BASE); } static enum led_brightness ebsa110_led_get(struct led_classdev *cdev) { u8 reg = __raw_readb(SOFT_BASE); return (reg & 0x80) ? LED_FULL : LED_OFF; } static int __init ebsa110_leds_init(void) { struct led_classdev *cdev; int ret; if (!machine_is_ebsa110()) return -ENODEV; cdev = kzalloc(sizeof(*cdev), GFP_KERNEL); if (!cdev) return -ENOMEM; cdev->name = "ebsa110:0"; cdev->brightness_set = ebsa110_led_set; cdev->brightness_get = ebsa110_led_get; cdev->default_trigger = "heartbeat"; ret = led_classdev_register(NULL, cdev); if (ret < 0) { kfree(cdev); return ret; } return 0; } /* * Since we may have triggers on any subsystem, defer registration * until after subsystem_init. */ fs_initcall(ebsa110_leds_init); #endif