1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
|
/*
* LED Triggers Core
*
* Copyright 2005 Dirk Opfer
*
* Author: Dirk Opfer <Dirk@Opfer-Online.de>
* based on spitz.c
*
* 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/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/leds.h>
#include <asm/hardware/scoop.h>
#include <asm/mach-types.h>
#include <asm/arch/hardware.h>
#include <asm/arch/pxa-regs.h>
#include <asm/arch/tosa.h>
static void tosaled_amber_set(struct led_classdev *led_cdev,
enum led_brightness value)
{
if (value)
set_scoop_gpio(&tosascoop_jc_device.dev,
TOSA_SCOOP_JC_CHRG_ERR_LED);
else
reset_scoop_gpio(&tosascoop_jc_device.dev,
TOSA_SCOOP_JC_CHRG_ERR_LED);
}
static void tosaled_green_set(struct led_classdev *led_cdev,
enum led_brightness value)
{
if (value)
set_scoop_gpio(&tosascoop_jc_device.dev,
TOSA_SCOOP_JC_NOTE_LED);
else
reset_scoop_gpio(&tosascoop_jc_device.dev,
TOSA_SCOOP_JC_NOTE_LED);
}
static struct led_classdev tosa_amber_led = {
.name = "tosa:amber",
.default_trigger = "sharpsl-charge",
.brightness_set = tosaled_amber_set,
};
static struct led_classdev tosa_green_led = {
.name = "tosa:green",
.default_trigger = "nand-disk",
.brightness_set = tosaled_green_set,
};
#ifdef CONFIG_PM
static int tosaled_suspend(struct platform_device *dev, pm_message_t state)
{
#ifdef CONFIG_LEDS_TRIGGERS
if (tosa_amber_led.trigger && strcmp(tosa_amber_led.trigger->name,
"sharpsl-charge"))
#endif
led_classdev_suspend(&tosa_amber_led);
led_classdev_suspend(&tosa_green_led);
return 0;
}
static int tosaled_resume(struct platform_device *dev)
{
led_classdev_resume(&tosa_amber_led);
led_classdev_resume(&tosa_green_led);
return 0;
}
#else
#define tosaled_suspend NULL
#define tosaled_resume NULL
#endif
static int tosaled_probe(struct platform_device *pdev)
{
int ret;
ret = led_classdev_register(&pdev->dev, &tosa_amber_led);
if (ret < 0)
return ret;
ret = led_classdev_register(&pdev->dev, &tosa_green_led);
if (ret < 0)
led_classdev_unregister(&tosa_amber_led);
return ret;
}
static int tosaled_remove(struct platform_device *pdev)
{
led_classdev_unregister(&tosa_amber_led);
led_classdev_unregister(&tosa_green_led);
return 0;
}
static struct platform_driver tosaled_driver = {
.probe = tosaled_probe,
.remove = tosaled_remove,
.suspend = tosaled_suspend,
.resume = tosaled_resume,
.driver = {
.name = "tosa-led",
},
};
static int __init tosaled_init(void)
{
return platform_driver_register(&tosaled_driver);
}
static void __exit tosaled_exit(void)
{
platform_driver_unregister(&tosaled_driver);
}
module_init(tosaled_init);
module_exit(tosaled_exit);
MODULE_AUTHOR("Dirk Opfer <Dirk@Opfer-Online.de>");
MODULE_DESCRIPTION("Tosa LED driver");
MODULE_LICENSE("GPL");
|
