1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only 2*4882a593Smuzhiyun /* 3*4882a593Smuzhiyun * Driver for the LED found on the EBSA110 machine 4*4882a593Smuzhiyun * Based on Versatile and RealView machine LED code 5*4882a593Smuzhiyun * 6*4882a593Smuzhiyun * Author: Bryan Wu <bryan.wu@canonical.com> 7*4882a593Smuzhiyun */ 8*4882a593Smuzhiyun #include <linux/kernel.h> 9*4882a593Smuzhiyun #include <linux/init.h> 10*4882a593Smuzhiyun #include <linux/io.h> 11*4882a593Smuzhiyun #include <linux/slab.h> 12*4882a593Smuzhiyun #include <linux/leds.h> 13*4882a593Smuzhiyun 14*4882a593Smuzhiyun #include <asm/mach-types.h> 15*4882a593Smuzhiyun 16*4882a593Smuzhiyun #include "core.h" 17*4882a593Smuzhiyun 18*4882a593Smuzhiyun #if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS) ebsa110_led_set(struct led_classdev * cdev,enum led_brightness b)19*4882a593Smuzhiyunstatic void ebsa110_led_set(struct led_classdev *cdev, 20*4882a593Smuzhiyun enum led_brightness b) 21*4882a593Smuzhiyun { 22*4882a593Smuzhiyun u8 reg = __raw_readb(SOFT_BASE); 23*4882a593Smuzhiyun 24*4882a593Smuzhiyun if (b != LED_OFF) 25*4882a593Smuzhiyun reg |= 0x80; 26*4882a593Smuzhiyun else 27*4882a593Smuzhiyun reg &= ~0x80; 28*4882a593Smuzhiyun 29*4882a593Smuzhiyun __raw_writeb(reg, SOFT_BASE); 30*4882a593Smuzhiyun } 31*4882a593Smuzhiyun ebsa110_led_get(struct led_classdev * cdev)32*4882a593Smuzhiyunstatic enum led_brightness ebsa110_led_get(struct led_classdev *cdev) 33*4882a593Smuzhiyun { 34*4882a593Smuzhiyun u8 reg = __raw_readb(SOFT_BASE); 35*4882a593Smuzhiyun 36*4882a593Smuzhiyun return (reg & 0x80) ? LED_FULL : LED_OFF; 37*4882a593Smuzhiyun } 38*4882a593Smuzhiyun ebsa110_leds_init(void)39*4882a593Smuzhiyunstatic int __init ebsa110_leds_init(void) 40*4882a593Smuzhiyun { 41*4882a593Smuzhiyun 42*4882a593Smuzhiyun struct led_classdev *cdev; 43*4882a593Smuzhiyun int ret; 44*4882a593Smuzhiyun 45*4882a593Smuzhiyun if (!machine_is_ebsa110()) 46*4882a593Smuzhiyun return -ENODEV; 47*4882a593Smuzhiyun 48*4882a593Smuzhiyun cdev = kzalloc(sizeof(*cdev), GFP_KERNEL); 49*4882a593Smuzhiyun if (!cdev) 50*4882a593Smuzhiyun return -ENOMEM; 51*4882a593Smuzhiyun 52*4882a593Smuzhiyun cdev->name = "ebsa110:0"; 53*4882a593Smuzhiyun cdev->brightness_set = ebsa110_led_set; 54*4882a593Smuzhiyun cdev->brightness_get = ebsa110_led_get; 55*4882a593Smuzhiyun cdev->default_trigger = "heartbeat"; 56*4882a593Smuzhiyun 57*4882a593Smuzhiyun ret = led_classdev_register(NULL, cdev); 58*4882a593Smuzhiyun if (ret < 0) { 59*4882a593Smuzhiyun kfree(cdev); 60*4882a593Smuzhiyun return ret; 61*4882a593Smuzhiyun } 62*4882a593Smuzhiyun 63*4882a593Smuzhiyun return 0; 64*4882a593Smuzhiyun } 65*4882a593Smuzhiyun 66*4882a593Smuzhiyun /* 67*4882a593Smuzhiyun * Since we may have triggers on any subsystem, defer registration 68*4882a593Smuzhiyun * until after subsystem_init. 69*4882a593Smuzhiyun */ 70*4882a593Smuzhiyun fs_initcall(ebsa110_leds_init); 71*4882a593Smuzhiyun #endif 72