M7350/kernel/drivers/leds/leds-cpld.c

406 lines
9.2 KiB
C
Raw Normal View History

2024-09-09 08:52:07 +00:00
/* include/asm/mach-msm/leds-cpld.c
*
* Copyright (C) 2008 HTC Corporation.
*
* Author: Farmer Tseng
*
* This software is licensed under the terms of the GNU General Public
* License version 2, as published by the Free Software Foundation, and
* may be copied, distributed, and modified under those terms.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/device.h>
#include <linux/leds.h>
#include <linux/spinlock.h>
#include <linux/ctype.h>
#include <linux/platform_device.h>
#include <linux/io.h>
#include <asm/mach-types.h>
#define DEBUG_LED_CHANGE 0
static int _g_cpld_led_addr;
struct CPLD_LED_data {
spinlock_t data_lock;
struct led_classdev leds[4]; /* blue, green, red */
};
static ssize_t led_blink_solid_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct CPLD_LED_data *CPLD_LED;
int idx = 2;
uint8_t reg_val;
struct led_classdev *led_cdev = dev_get_drvdata(dev);
ssize_t ret = 0;
if (!strcmp(led_cdev->name, "red"))
idx = 0;
else if (!strcmp(led_cdev->name, "green"))
idx = 1;
else
idx = 2;
CPLD_LED = container_of(led_cdev, struct CPLD_LED_data, leds[idx]);
spin_lock(&CPLD_LED->data_lock);
reg_val = readb(_g_cpld_led_addr);
reg_val = reg_val >> (2 * idx + 1);
reg_val &= 0x1;
spin_unlock(&CPLD_LED->data_lock);
/* no lock needed for this */
sprintf(buf, "%u\n", reg_val);
ret = strlen(buf) + 1;
return ret;
}
static ssize_t led_blink_solid_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t size)
{
struct CPLD_LED_data *CPLD_LED;
int idx = 2;
uint8_t reg_val;
char *after;
unsigned long state;
ssize_t ret = -EINVAL;
size_t count;
struct led_classdev *led_cdev = dev_get_drvdata(dev);
if (!strcmp(led_cdev->name, "red"))
idx = 0;
else if (!strcmp(led_cdev->name, "green"))
idx = 1;
else
idx = 2;
CPLD_LED = container_of(led_cdev, struct CPLD_LED_data, leds[idx]);
state = simple_strtoul(buf, &after, 10);
count = after - buf;
if (*after && isspace(*after))
count++;
if (count == size) {
ret = count;
spin_lock(&CPLD_LED->data_lock);
reg_val = readb(_g_cpld_led_addr);
if (state)
reg_val |= 1 << (2 * idx + 1);
else
reg_val &= ~(1 << (2 * idx + 1));
writeb(reg_val, _g_cpld_led_addr);
spin_unlock(&CPLD_LED->data_lock);
}
return ret;
}
static DEVICE_ATTR(blink, 0644, led_blink_solid_show, led_blink_solid_store);
static ssize_t cpldled_blink_all_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
uint8_t reg_val;
struct CPLD_LED_data *CPLD_LED = dev_get_drvdata(dev);
ssize_t ret = 0;
spin_lock(&CPLD_LED->data_lock);
reg_val = readb(_g_cpld_led_addr);
reg_val &= 0x2A;
if (reg_val == 0x2A)
reg_val = 1;
else
reg_val = 0;
spin_unlock(&CPLD_LED->data_lock);
/* no lock needed for this */
sprintf(buf, "%u\n", reg_val);
ret = strlen(buf) + 1;
return ret;
}
static ssize_t cpldled_blink_all_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t size)
{
uint8_t reg_val;
char *after;
unsigned long state;
ssize_t ret = -EINVAL;
size_t count;
struct CPLD_LED_data *CPLD_LED = dev_get_drvdata(dev);
state = simple_strtoul(buf, &after, 10);
count = after - buf;
if (*after && isspace(*after))
count++;
if (count == size) {
ret = count;
spin_lock(&CPLD_LED->data_lock);
reg_val = readb(_g_cpld_led_addr);
if (state)
reg_val |= 0x2A;
else
reg_val &= ~0x2A;
writeb(reg_val, _g_cpld_led_addr);
spin_unlock(&CPLD_LED->data_lock);
}
return ret;
}
static struct device_attribute dev_attr_blink_all = {
.attr = {
.name = "blink",
.mode = 0644,
},
.show = cpldled_blink_all_show,
.store = cpldled_blink_all_store,
};
static void led_brightness_set(struct led_classdev *led_cdev,
enum led_brightness brightness)
{
struct CPLD_LED_data *CPLD_LED;
int idx = 2;
struct led_classdev *led;
uint8_t reg_val;
if (!strcmp(led_cdev->name, "jogball-backlight")) {
if (brightness > 7)
reg_val = 1;
else
reg_val = brightness;
writeb(0, _g_cpld_led_addr + 0x8);
writeb(reg_val, _g_cpld_led_addr + 0x8);
#if DEBUG_LED_CHANGE
printk(KERN_INFO "LED change: jogball backlight = %d \n",
reg_val);
#endif
return;
} else if (!strcmp(led_cdev->name, "red")) {
idx = 0;
} else if (!strcmp(led_cdev->name, "green")) {
idx = 1;
} else {
idx = 2;
}
CPLD_LED = container_of(led_cdev, struct CPLD_LED_data, leds[idx]);
spin_lock(&CPLD_LED->data_lock);
reg_val = readb(_g_cpld_led_addr);
led = &CPLD_LED->leds[idx];
if (led->brightness > LED_OFF)
reg_val |= 1 << (2 * idx);
else
reg_val &= ~(1 << (2 * idx));
writeb(reg_val, _g_cpld_led_addr);
#if DEBUG_LED_CHANGE
printk(KERN_INFO "LED change: %s = %d \n", led_cdev->name, led->brightness);
#endif
spin_unlock(&CPLD_LED->data_lock);
}
static ssize_t cpldled_grpfreq_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return sprintf(buf, "%u\n", 0);
}
static ssize_t cpldled_grpfreq_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
return 0;
}
static DEVICE_ATTR(grpfreq, 0644, cpldled_grpfreq_show, cpldled_grpfreq_store);
static ssize_t cpldled_grppwm_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
return sprintf(buf, "%u\n", 0);
}
static ssize_t cpldled_grppwm_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
{
return 0;
}
static DEVICE_ATTR(grppwm, 0644, cpldled_grppwm_show, cpldled_grppwm_store);
static int CPLD_LED_probe(struct platform_device *pdev)
{
int ret = 0;
int i, j;
struct resource *res;
struct CPLD_LED_data *CPLD_LED;
CPLD_LED = kzalloc(sizeof(struct CPLD_LED_data), GFP_KERNEL);
if (CPLD_LED == NULL) {
printk(KERN_ERR "CPLD_LED_probe: no memory for device\n");
ret = -ENOMEM;
goto err_alloc_failed;
}
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (!res) {
ret = -ENOMEM;
goto err_alloc_failed;
}
_g_cpld_led_addr = res->start;
if (!_g_cpld_led_addr) {
ret = -ENOMEM;
goto err_alloc_failed;
}
memset(CPLD_LED, 0, sizeof(struct CPLD_LED_data));
writeb(0x00, _g_cpld_led_addr);
CPLD_LED->leds[0].name = "red";
CPLD_LED->leds[0].brightness_set = led_brightness_set;
CPLD_LED->leds[1].name = "green";
CPLD_LED->leds[1].brightness_set = led_brightness_set;
CPLD_LED->leds[2].name = "blue";
CPLD_LED->leds[2].brightness_set = led_brightness_set;
CPLD_LED->leds[3].name = "jogball-backlight";
CPLD_LED->leds[3].brightness_set = led_brightness_set;
spin_lock_init(&CPLD_LED->data_lock);
for (i = 0; i < 4; i++) { /* red, green, blue jogball */
ret = led_classdev_register(&pdev->dev, &CPLD_LED->leds[i]);
if (ret) {
printk(KERN_ERR
"CPLD_LED: led_classdev_register failed\n");
goto err_led_classdev_register_failed;
}
}
for (i = 0; i < 3; i++) {
ret =
device_create_file(CPLD_LED->leds[i].dev, &dev_attr_blink);
if (ret) {
printk(KERN_ERR
"CPLD_LED: device_create_file failed\n");
goto err_out_attr_blink;
}
}
dev_set_drvdata(&pdev->dev, CPLD_LED);
ret = device_create_file(&pdev->dev, &dev_attr_blink_all);
if (ret) {
printk(KERN_ERR
"CPLD_LED: create dev_attr_blink_all failed\n");
goto err_out_attr_blink;
}
ret = device_create_file(&pdev->dev, &dev_attr_grppwm);
if (ret) {
printk(KERN_ERR
"CPLD_LED: create dev_attr_grppwm failed\n");
goto err_out_attr_grppwm;
}
ret = device_create_file(&pdev->dev, &dev_attr_grpfreq);
if (ret) {
printk(KERN_ERR
"CPLD_LED: create dev_attr_grpfreq failed\n");
goto err_out_attr_grpfreq;
}
return 0;
err_out_attr_grpfreq:
device_remove_file(&pdev->dev, &dev_attr_grppwm);
err_out_attr_grppwm:
device_remove_file(&pdev->dev, &dev_attr_blink_all);
err_out_attr_blink:
for (j = 0; j < i; j++)
device_remove_file(CPLD_LED->leds[j].dev, &dev_attr_blink);
i = 3;
err_led_classdev_register_failed:
for (j = 0; j < i; j++)
led_classdev_unregister(&CPLD_LED->leds[j]);
err_alloc_failed:
kfree(CPLD_LED);
return ret;
}
static int __devexit CPLD_LED_remove(struct platform_device *pdev)
{
struct CPLD_LED_data *CPLD_LED;
int i;
CPLD_LED = platform_get_drvdata(pdev);
for (i = 0; i < 3; i++) {
device_remove_file(CPLD_LED->leds[i].dev, &dev_attr_blink);
led_classdev_unregister(&CPLD_LED->leds[i]);
}
device_remove_file(&pdev->dev, &dev_attr_blink_all);
device_remove_file(&pdev->dev, &dev_attr_grppwm);
device_remove_file(&pdev->dev, &dev_attr_grpfreq);
kfree(CPLD_LED);
return 0;
}
static struct platform_driver CPLD_LED_driver = {
.probe = CPLD_LED_probe,
.remove = __devexit_p(CPLD_LED_remove),
.driver = {
.name = "leds-cpld",
.owner = THIS_MODULE,
},
};
static int __init CPLD_LED_init(void)
{
return platform_driver_register(&CPLD_LED_driver);
}
static void __exit CPLD_LED_exit(void)
{
platform_driver_unregister(&CPLD_LED_driver);
}
MODULE_AUTHOR("Farmer Tseng");
MODULE_DESCRIPTION("CPLD_LED driver");
MODULE_LICENSE("GPL");
module_init(CPLD_LED_init);
module_exit(CPLD_LED_exit);