adm5120: add 3.18 support

[openwrt/svn-archive/archive.git] / target / linux / adm5120 / files-3.18 / drivers / leds / ledtrig-adm5120-switch.c

diff --git a/target/linux/adm5120/files-3.18/drivers/leds/ledtrig-adm5120-switch.c b/target/linux/adm5120/files-3.18/drivers/leds/ledtrig-adm5120-switch.c
new file mode 100644 (file)
index 0000000..23a54a0
--- /dev/null
+++ b/target/linux/adm5120/files-3.18/drivers/leds/ledtrig-adm5120-switch.c
@@ -0,0 +1,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");