add LEDs trigger for switch port states, thanks to Bernhard Held (closes: #2153)
SVN-Revision: 9362master
Gabor Juhos
17 years ago
parent
4c093ed622
commit
d2cfb2934f
@ -0,0 +1,149 @@ |
||||
/*
|
||||
* LED ADM5120 Switch Port State Trigger |
||||
* |
||||
* Copyright (C) 2007 Bernhard Held <bernhard at bernhardheld.de> |
||||
* Copyright (C) 2007 Gabor Juhos <juhosg at 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 <asm/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 at openwrt.org>"); |
||||
MODULE_DESCRIPTION(DRV_DESC); |
||||
MODULE_LICENSE("GPL"); |
||||
@ -0,0 +1,26 @@ |
||||
Index: linux-2.6.23/drivers/leds/Kconfig
|
||||
===================================================================
|
||||
--- linux-2.6.23.orig/drivers/leds/Kconfig
|
||||
+++ linux-2.6.23/drivers/leds/Kconfig
|
||||
@@ -152,4 +152,12 @@ config LEDS_TRIGGER_MORSE
|
||||
tristate "LED Morse Trigger"
|
||||
depends on LEDS_TRIGGERS
|
||||
|
||||
+config LEDS_TRIGGER_ADM5120_SWITCH
|
||||
+ tristate "LED ADM5120 Switch Port Status Trigger"
|
||||
+ depends on LEDS_TRIGGERS && LEDS_ADM5120
|
||||
+ help
|
||||
+ This allows LEDs to be controlled by the port states of
|
||||
+ the ADM5120 built-in Ethernet Switch
|
||||
+ If unsure, say N.
|
||||
+
|
||||
endif # NEW_LEDS
|
||||
Index: linux-2.6.23/drivers/leds/Makefile
|
||||
===================================================================
|
||||
--- linux-2.6.23.orig/drivers/leds/Makefile
|
||||
+++ linux-2.6.23/drivers/leds/Makefile
|
||||
@@ -24,3 +24,4 @@ obj-$(CONFIG_LEDS_TRIGGER_TIMER) += ledt
|
||||
obj-$(CONFIG_LEDS_TRIGGER_IDE_DISK) += ledtrig-ide-disk.o
|
||||
obj-$(CONFIG_LEDS_TRIGGER_HEARTBEAT) += ledtrig-heartbeat.o
|
||||
obj-$(CONFIG_LEDS_TRIGGER_MORSE) += ledtrig-morse.o
|
||||
+obj-$(CONFIG_LEDS_TRIGGER_ADM5120_SWITCH) += ledtrig-adm5120-switch.o
|
||||
Loading…
Reference in new issue