mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-27 06:34:11 +08:00
fb61f86223
The CM_CTRL register was accessed directly from the LED driver, which does not work now that we get the base for the register from the device tree. Add an accessor function to do this and make the LED driver compile again. Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
126 lines
2.7 KiB
C
126 lines
2.7 KiB
C
/*
|
|
* Driver for the 4 user LEDs found on the Integrator AP/CP baseboard
|
|
* 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 <mach/cm.h>
|
|
#include <mach/hardware.h>
|
|
#include <mach/platform.h>
|
|
|
|
#if defined(CONFIG_NEW_LEDS) && defined(CONFIG_LEDS_CLASS)
|
|
|
|
#define ALPHA_REG __io_address(INTEGRATOR_DBG_BASE)
|
|
#define LEDREG (__io_address(INTEGRATOR_DBG_BASE) + INTEGRATOR_DBG_LEDS_OFFSET)
|
|
|
|
struct integrator_led {
|
|
struct led_classdev cdev;
|
|
u8 mask;
|
|
};
|
|
|
|
/*
|
|
* The triggers lines up below will only be used if the
|
|
* LED triggers are compiled in.
|
|
*/
|
|
static const struct {
|
|
const char *name;
|
|
const char *trigger;
|
|
} integrator_leds[] = {
|
|
{ "integrator:green0", "heartbeat", },
|
|
{ "integrator:yellow", },
|
|
{ "integrator:red", },
|
|
{ "integrator:green1", },
|
|
{ "integrator:core_module", "cpu0", },
|
|
};
|
|
|
|
static void integrator_led_set(struct led_classdev *cdev,
|
|
enum led_brightness b)
|
|
{
|
|
struct integrator_led *led = container_of(cdev,
|
|
struct integrator_led, cdev);
|
|
u32 reg = __raw_readl(LEDREG);
|
|
|
|
if (b != LED_OFF)
|
|
reg |= led->mask;
|
|
else
|
|
reg &= ~led->mask;
|
|
|
|
while (__raw_readl(ALPHA_REG) & 1)
|
|
cpu_relax();
|
|
|
|
__raw_writel(reg, LEDREG);
|
|
}
|
|
|
|
static enum led_brightness integrator_led_get(struct led_classdev *cdev)
|
|
{
|
|
struct integrator_led *led = container_of(cdev,
|
|
struct integrator_led, cdev);
|
|
u32 reg = __raw_readl(LEDREG);
|
|
|
|
return (reg & led->mask) ? LED_FULL : LED_OFF;
|
|
}
|
|
|
|
static void cm_led_set(struct led_classdev *cdev,
|
|
enum led_brightness b)
|
|
{
|
|
if (b != LED_OFF)
|
|
cm_control(CM_CTRL_LED, CM_CTRL_LED);
|
|
else
|
|
cm_control(CM_CTRL_LED, 0);
|
|
}
|
|
|
|
static enum led_brightness cm_led_get(struct led_classdev *cdev)
|
|
{
|
|
u32 reg = cm_get();
|
|
|
|
return (reg & CM_CTRL_LED) ? LED_FULL : LED_OFF;
|
|
}
|
|
|
|
static int __init integrator_leds_init(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(integrator_leds); i++) {
|
|
struct integrator_led *led;
|
|
|
|
led = kzalloc(sizeof(*led), GFP_KERNEL);
|
|
if (!led)
|
|
break;
|
|
|
|
|
|
led->cdev.name = integrator_leds[i].name;
|
|
|
|
if (i == 4) { /* Setting for LED in core module */
|
|
led->cdev.brightness_set = cm_led_set;
|
|
led->cdev.brightness_get = cm_led_get;
|
|
} else {
|
|
led->cdev.brightness_set = integrator_led_set;
|
|
led->cdev.brightness_get = integrator_led_get;
|
|
}
|
|
|
|
led->cdev.default_trigger = integrator_leds[i].trigger;
|
|
led->mask = BIT(i);
|
|
|
|
if (led_classdev_register(NULL, &led->cdev) < 0) {
|
|
kfree(led);
|
|
break;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Since we may have triggers on any subsystem, defer registration
|
|
* until after subsystem_init.
|
|
*/
|
|
fs_initcall(integrator_leds_init);
|
|
#endif
|