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
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
|
/*
* LED ADM5120 Switch Port State Trigger
*
* Copyright (C) 2007 Bernhard Held <bernhard at bernhardheld.de>
* Copyright (C) 2007-2008 Gabor Juhos <juhosg@openwrt.org>
*
* This file was based on: drivers/leds/ledtrig-timer.c
* Copyright 2005-2006 Openedhand Ltd.
* Author: Richard Purdie
*
* 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/module.h>
#include <linux/init.h>
#include <linux/device.h>
#include <linux/gpio.h>
#include "leds.h"
#define DRV_NAME "port_state"
#define DRV_DESC "LED ADM5120 Switch Port State Trigger"
struct port_state {
char *name;
unsigned int value;
};
#define PORT_STATE(n, v) {.name = (n), .value = (v)}
static struct port_state port_states[] = {
PORT_STATE("off", LED_OFF),
PORT_STATE("on", LED_FULL),
PORT_STATE("flash", ADM5120_GPIO_FLASH),
PORT_STATE("link", ADM5120_GPIO_LINK),
PORT_STATE("speed", ADM5120_GPIO_SPEED),
PORT_STATE("duplex", ADM5120_GPIO_DUPLEX),
PORT_STATE("act", ADM5120_GPIO_ACT),
PORT_STATE("coll", ADM5120_GPIO_COLL),
PORT_STATE("link_act", ADM5120_GPIO_LINK_ACT),
PORT_STATE("duplex_coll", ADM5120_GPIO_DUPLEX_COLL),
PORT_STATE("10M_act", ADM5120_GPIO_10M_ACT),
PORT_STATE("100M_act", ADM5120_GPIO_100M_ACT),
};
static ssize_t led_port_state_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct led_classdev *led_cdev = dev_get_drvdata(dev);
struct port_state *state = led_cdev->trigger_data;
int len = 0;
int i;
*buf = '\0';
for (i = 0; i < ARRAY_SIZE(port_states); i++) {
if (&port_states[i] == state)
len += sprintf(buf+len, "[%s] ", port_states[i].name);
else
len += sprintf(buf+len, "%s ", port_states[i].name);
}
len += sprintf(buf+len, "\n");
return len;
}
static ssize_t led_port_state_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t size)
{
struct led_classdev *led_cdev = dev_get_drvdata(dev);
size_t len;
int i;
for (i = 0; i < ARRAY_SIZE(port_states); i++) {
len = strlen(port_states[i].name);
if (strncmp(port_states[i].name, buf, len) != 0)
continue;
if (buf[len] != '\0' && buf[len] != '\n')
continue;
led_cdev->trigger_data = &port_states[i];
led_set_brightness(led_cdev, port_states[i].value);
return size;
}
return -EINVAL;
}
static DEVICE_ATTR(port_state, 0644, led_port_state_show,
led_port_state_store);
static void adm5120_switch_trig_activate(struct led_classdev *led_cdev)
{
struct port_state *state = port_states;
int rc;
led_cdev->trigger_data = state;
rc = device_create_file(led_cdev->dev, &dev_attr_port_state);
if (rc)
goto err;
led_set_brightness(led_cdev, state->value);
return;
err:
led_cdev->trigger_data = NULL;
}
static void adm5120_switch_trig_deactivate(struct led_classdev *led_cdev)
{
struct port_state *state = led_cdev->trigger_data;
if (!state)
return;
device_remove_file(led_cdev->dev, &dev_attr_port_state);
}
static struct led_trigger adm5120_switch_led_trigger = {
.name = DRV_NAME,
.activate = adm5120_switch_trig_activate,
.deactivate = adm5120_switch_trig_deactivate,
};
static int __init adm5120_switch_trig_init(void)
{
led_trigger_register(&adm5120_switch_led_trigger);
return 0;
}
static void __exit adm5120_switch_trig_exit(void)
{
led_trigger_unregister(&adm5120_switch_led_trigger);
}
module_init(adm5120_switch_trig_init);
module_exit(adm5120_switch_trig_exit);
MODULE_AUTHOR("Bernhard Held <bernhard at bernhardheld.de>, "
"Gabor Juhos <juhosg@openwrt.org>");
MODULE_DESCRIPTION(DRV_DESC);
MODULE_LICENSE("GPL v2");
|
