57 lines
1.3 KiB
C
57 lines
1.3 KiB
C
|
/*
|
||
|
|
* linux/drivers/leds/leds-mb628.c
|
||
|
|
*
|
||
|
|
* Copyright (C) 2008 STMicroelectronics Limited
|
||
|
|
* Author: Stuart Menefy <stuart.menefy@st.com>
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify
|
||
|
|
* it under the terms of the GNU General Public License version 2 as
|
||
|
|
* published by the Free Software Foundation.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/types.h>
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/device.h>
|
||
|
|
#include <linux/leds.h>
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <mach/epld.h>
|
||
|
|
#include <mach/common.h>
|
||
|
|
|
||
|
|
static void mb628_led_set(struct led_classdev *led_cdev,
|
||
|
|
enum led_brightness brightness)
|
||
|
|
{
|
||
|
|
u8 reg;
|
||
|
|
|
||
|
|
/* Locking required here */
|
||
|
|
reg = epld_read(EPLD_ENABLE);
|
||
|
|
if (brightness)
|
||
|
|
reg |= EPLD_ENABLE_HBEAT;
|
||
|
|
else
|
||
|
|
reg &= ~EPLD_ENABLE_HBEAT;
|
||
|
|
epld_write(reg, EPLD_ENABLE);
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct led_classdev mb628_led = {
|
||
|
|
.name = "mb628-led",
|
||
|
|
.brightness_set = mb628_led_set,
|
||
|
|
.default_trigger = "heartbeat"
|
||
|
|
};
|
||
|
|
|
||
|
|
static int __init mb628_led_init(void)
|
||
|
|
{
|
||
|
|
return led_classdev_register(NULL, &mb628_led);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void __exit mb628_led_exit(void)
|
||
|
|
{
|
||
|
|
led_classdev_unregister(&mb628_led);
|
||
|
|
}
|
||
|
|
|
||
|
|
module_init(mb628_led_init);
|
||
|
|
module_exit(mb628_led_exit);
|
||
|
|
|
||
|
|
MODULE_LICENSE("GPL");
|
||
|
|
MODULE_DESCRIPTION("LED support for STMicroelectronics mb628");
|
||
|
|
MODULE_AUTHOR("Stuart Menefy <stuart.menefy@st.com>");
|