2 * swconfig_led.c: LED trigger support for the switch configuration API
4 * Copyright (C) 2011 Gabor Juhos <juhosg@openwrt.org>
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
13 #ifdef CONFIG_SWCONFIG_LEDS
15 #include <linux/leds.h>
16 #include <linux/ctype.h>
17 #include <linux/device.h>
18 #include <linux/workqueue.h>
20 #define SWCONFIG_LED_TIMER_INTERVAL (HZ / 10)
21 #define SWCONFIG_LED_NUM_PORTS 32
23 #define SWCONFIG_LED_PORT_SPEED_NA 0x01 /* unknown speed */
24 #define SWCONFIG_LED_PORT_SPEED_10 0x02 /* 10 Mbps */
25 #define SWCONFIG_LED_PORT_SPEED_100 0x04 /* 100 Mbps */
26 #define SWCONFIG_LED_PORT_SPEED_1000 0x08 /* 1000 Mbps */
27 #define SWCONFIG_LED_PORT_SPEED_ALL (SWCONFIG_LED_PORT_SPEED_NA | \
28 SWCONFIG_LED_PORT_SPEED_10 | \
29 SWCONFIG_LED_PORT_SPEED_100 | \
30 SWCONFIG_LED_PORT_SPEED_1000)
32 struct switch_led_trigger
{
33 struct led_trigger trig
;
34 struct switch_dev
*swdev
;
36 struct delayed_work sw_led_work
;
39 unsigned long long port_traffic
[SWCONFIG_LED_NUM_PORTS
];
40 u8 link_speed
[SWCONFIG_LED_NUM_PORTS
];
43 struct swconfig_trig_data
{
44 struct led_classdev
*led_cdev
;
45 struct switch_dev
*swdev
;
51 unsigned long prev_traffic
;
52 enum led_brightness prev_brightness
;
57 swconfig_trig_set_brightness(struct swconfig_trig_data
*trig_data
,
58 enum led_brightness brightness
)
60 led_set_brightness(trig_data
->led_cdev
, brightness
);
61 trig_data
->prev_brightness
= brightness
;
65 swconfig_trig_update_port_mask(struct led_trigger
*trigger
)
67 struct list_head
*entry
;
68 struct switch_led_trigger
*sw_trig
;
74 sw_trig
= (void *) trigger
;
77 read_lock(&trigger
->leddev_list_lock
);
78 list_for_each(entry
, &trigger
->led_cdevs
) {
79 struct led_classdev
*led_cdev
;
80 struct swconfig_trig_data
*trig_data
;
82 led_cdev
= list_entry(entry
, struct led_classdev
, trig_list
);
83 trig_data
= led_cdev
->trigger_data
;
85 read_lock(&trig_data
->lock
);
86 port_mask
|= trig_data
->port_mask
;
87 read_unlock(&trig_data
->lock
);
90 read_unlock(&trigger
->leddev_list_lock
);
92 sw_trig
->port_mask
= port_mask
;
95 schedule_delayed_work(&sw_trig
->sw_led_work
,
96 SWCONFIG_LED_TIMER_INTERVAL
);
98 cancel_delayed_work_sync(&sw_trig
->sw_led_work
);
102 swconfig_trig_port_mask_store(struct device
*dev
, struct device_attribute
*attr
,
103 const char *buf
, size_t size
)
105 struct led_classdev
*led_cdev
= dev_get_drvdata(dev
);
106 struct swconfig_trig_data
*trig_data
= led_cdev
->trigger_data
;
107 unsigned long port_mask
;
111 ret
= kstrtoul(buf
, 0, &port_mask
);
115 write_lock(&trig_data
->lock
);
117 changed
= (trig_data
->port_mask
!= port_mask
);
119 trig_data
->port_mask
= port_mask
;
121 swconfig_trig_set_brightness(trig_data
, LED_OFF
);
124 write_unlock(&trig_data
->lock
);
127 swconfig_trig_update_port_mask(led_cdev
->trigger
);
133 swconfig_trig_port_mask_show(struct device
*dev
, struct device_attribute
*attr
,
136 struct led_classdev
*led_cdev
= dev_get_drvdata(dev
);
137 struct swconfig_trig_data
*trig_data
= led_cdev
->trigger_data
;
139 read_lock(&trig_data
->lock
);
140 sprintf(buf
, "%#x\n", trig_data
->port_mask
);
141 read_unlock(&trig_data
->lock
);
143 return strlen(buf
) + 1;
146 static DEVICE_ATTR(port_mask
, 0644, swconfig_trig_port_mask_show
,
147 swconfig_trig_port_mask_store
);
149 /* speed_mask file handler - display value */
150 static ssize_t
swconfig_trig_speed_mask_show(struct device
*dev
,
151 struct device_attribute
*attr
,
154 struct led_classdev
*led_cdev
= dev_get_drvdata(dev
);
155 struct swconfig_trig_data
*trig_data
= led_cdev
->trigger_data
;
157 read_lock(&trig_data
->lock
);
158 sprintf(buf
, "%#x\n", trig_data
->speed_mask
);
159 read_unlock(&trig_data
->lock
);
161 return strlen(buf
) + 1;
164 /* speed_mask file handler - store value */
165 static ssize_t
swconfig_trig_speed_mask_store(struct device
*dev
,
166 struct device_attribute
*attr
,
167 const char *buf
, size_t size
)
169 struct led_classdev
*led_cdev
= dev_get_drvdata(dev
);
170 struct swconfig_trig_data
*trig_data
= led_cdev
->trigger_data
;
174 ret
= kstrtou8(buf
, 0, &speed_mask
);
178 write_lock(&trig_data
->lock
);
179 trig_data
->speed_mask
= speed_mask
& SWCONFIG_LED_PORT_SPEED_ALL
;
180 write_unlock(&trig_data
->lock
);
185 /* speed_mask special file */
186 static DEVICE_ATTR(speed_mask
, 0644, swconfig_trig_speed_mask_show
,
187 swconfig_trig_speed_mask_store
);
190 swconfig_trig_activate(struct led_classdev
*led_cdev
)
192 struct switch_led_trigger
*sw_trig
;
193 struct swconfig_trig_data
*trig_data
;
196 if (led_cdev
->trigger
->activate
!= swconfig_trig_activate
)
199 trig_data
= kzalloc(sizeof(struct swconfig_trig_data
), GFP_KERNEL
);
203 sw_trig
= (void *) led_cdev
->trigger
;
205 rwlock_init(&trig_data
->lock
);
206 trig_data
->led_cdev
= led_cdev
;
207 trig_data
->swdev
= sw_trig
->swdev
;
208 trig_data
->speed_mask
= SWCONFIG_LED_PORT_SPEED_ALL
;
209 led_cdev
->trigger_data
= trig_data
;
211 err
= device_create_file(led_cdev
->dev
, &dev_attr_port_mask
);
215 err
= device_create_file(led_cdev
->dev
, &dev_attr_speed_mask
);
222 device_remove_file(led_cdev
->dev
, &dev_attr_port_mask
);
225 led_cdev
->trigger_data
= NULL
;
230 swconfig_trig_deactivate(struct led_classdev
*led_cdev
)
232 struct swconfig_trig_data
*trig_data
;
234 swconfig_trig_update_port_mask(led_cdev
->trigger
);
236 trig_data
= (void *) led_cdev
->trigger_data
;
238 device_remove_file(led_cdev
->dev
, &dev_attr_port_mask
);
239 device_remove_file(led_cdev
->dev
, &dev_attr_speed_mask
);
245 swconfig_trig_led_event(struct switch_led_trigger
*sw_trig
,
246 struct led_classdev
*led_cdev
)
248 struct swconfig_trig_data
*trig_data
;
253 trig_data
= led_cdev
->trigger_data
;
257 read_lock(&trig_data
->lock
);
258 port_mask
= trig_data
->port_mask
;
259 speed_mask
= trig_data
->speed_mask
;
260 read_unlock(&trig_data
->lock
);
262 link
= !!(sw_trig
->port_link
& port_mask
);
264 if (link
!= trig_data
->prev_link
)
265 swconfig_trig_set_brightness(trig_data
, LED_OFF
);
267 unsigned long traffic
;
268 int speedok
; /* link speed flag */
273 for (i
= 0; i
< SWCONFIG_LED_NUM_PORTS
; i
++) {
274 if (port_mask
& (1 << i
))
275 if (sw_trig
->link_speed
[i
] & speed_mask
) {
276 traffic
+= sw_trig
->port_traffic
[i
];
282 /* At least one port speed matches speed_mask */
283 if (trig_data
->prev_brightness
!= LED_FULL
)
284 swconfig_trig_set_brightness(trig_data
,
286 else if (traffic
!= trig_data
->prev_traffic
)
287 swconfig_trig_set_brightness(trig_data
,
289 } else if (trig_data
->prev_brightness
!= LED_OFF
)
290 swconfig_trig_set_brightness(trig_data
, LED_OFF
);
292 trig_data
->prev_traffic
= traffic
;
295 trig_data
->prev_link
= link
;
299 swconfig_trig_update_leds(struct switch_led_trigger
*sw_trig
)
301 struct list_head
*entry
;
302 struct led_trigger
*trigger
;
304 trigger
= &sw_trig
->trig
;
305 read_lock(&trigger
->leddev_list_lock
);
306 list_for_each(entry
, &trigger
->led_cdevs
) {
307 struct led_classdev
*led_cdev
;
309 led_cdev
= list_entry(entry
, struct led_classdev
, trig_list
);
310 swconfig_trig_led_event(sw_trig
, led_cdev
);
312 read_unlock(&trigger
->leddev_list_lock
);
316 swconfig_led_work_func(struct work_struct
*work
)
318 struct switch_led_trigger
*sw_trig
;
319 struct switch_dev
*swdev
;
324 sw_trig
= container_of(work
, struct switch_led_trigger
,
327 port_mask
= sw_trig
->port_mask
;
328 swdev
= sw_trig
->swdev
;
331 for (i
= 0; i
< SWCONFIG_LED_NUM_PORTS
; i
++) {
334 sw_trig
->link_speed
[i
] = 0;
337 if ((port_mask
& port_bit
) == 0)
340 if (swdev
->ops
->get_port_link
) {
341 struct switch_port_link port_link
;
343 memset(&port_link
, '\0', sizeof(port_link
));
344 swdev
->ops
->get_port_link(swdev
, i
, &port_link
);
346 if (port_link
.link
) {
348 switch (port_link
.speed
) {
349 case SWITCH_PORT_SPEED_UNKNOWN
:
350 sw_trig
->link_speed
[i
] =
351 SWCONFIG_LED_PORT_SPEED_NA
;
353 case SWITCH_PORT_SPEED_10
:
354 sw_trig
->link_speed
[i
] =
355 SWCONFIG_LED_PORT_SPEED_10
;
357 case SWITCH_PORT_SPEED_100
:
358 sw_trig
->link_speed
[i
] =
359 SWCONFIG_LED_PORT_SPEED_100
;
361 case SWITCH_PORT_SPEED_1000
:
362 sw_trig
->link_speed
[i
] =
363 SWCONFIG_LED_PORT_SPEED_1000
;
369 if (swdev
->ops
->get_port_stats
) {
370 struct switch_port_stats port_stats
;
372 memset(&port_stats
, '\0', sizeof(port_stats
));
373 swdev
->ops
->get_port_stats(swdev
, i
, &port_stats
);
374 sw_trig
->port_traffic
[i
] = port_stats
.tx_bytes
+
379 sw_trig
->port_link
= link
;
381 swconfig_trig_update_leds(sw_trig
);
383 schedule_delayed_work(&sw_trig
->sw_led_work
,
384 SWCONFIG_LED_TIMER_INTERVAL
);
388 swconfig_create_led_trigger(struct switch_dev
*swdev
)
390 struct switch_led_trigger
*sw_trig
;
393 if (!swdev
->ops
->get_port_link
)
396 sw_trig
= kzalloc(sizeof(struct switch_led_trigger
), GFP_KERNEL
);
400 sw_trig
->swdev
= swdev
;
401 sw_trig
->trig
.name
= swdev
->devname
;
402 sw_trig
->trig
.activate
= swconfig_trig_activate
;
403 sw_trig
->trig
.deactivate
= swconfig_trig_deactivate
;
405 INIT_DELAYED_WORK(&sw_trig
->sw_led_work
, swconfig_led_work_func
);
407 err
= led_trigger_register(&sw_trig
->trig
);
411 swdev
->led_trigger
= sw_trig
;
421 swconfig_destroy_led_trigger(struct switch_dev
*swdev
)
423 struct switch_led_trigger
*sw_trig
;
425 sw_trig
= swdev
->led_trigger
;
427 cancel_delayed_work_sync(&sw_trig
->sw_led_work
);
428 led_trigger_unregister(&sw_trig
->trig
);
433 #else /* SWCONFIG_LEDS */
435 swconfig_create_led_trigger(struct switch_dev
*swdev
) { return 0; }
438 swconfig_destroy_led_trigger(struct switch_dev
*swdev
) { }
439 #endif /* CONFIG_SWCONFIG_LEDS */