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 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 */