|
|
@@ -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");
|
Gabor Juhos