target/linux/adm5120/files/drivers/leds/ledtrig-adm5120-switch.c

   1 /*
   2  * LED ADM5120 Switch Port State Trigger
   3  *
   4  * Copyright (C) 2007 Bernhard Held <bernhard at bernhardheld.de>
   5  * Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
   6  *
   7  * This file was based on: drivers/leds/ledtrig-timer.c
   8  *      Copyright 2005-2006 Openedhand Ltd.
   9  *      Author: Richard Purdie
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  */
  16
  17 #include <linux/kernel.h>
  18 #include <linux/module.h>
  19 #include <linux/init.h>
  20 #include <linux/device.h>
  21
  22 #include <asm/gpio.h>
  23
  24 #include "leds.h"
  25
  26 #define DRV_NAME "port_state"
  27 #define DRV_DESC "LED ADM5120 Switch Port State Trigger"
  28
  29 struct port_state {
  30         char *name;
  31         unsigned int value;
  32 };
  33
  34 #define PORT_STATE(n,v) {.name = (n), .value = (v)}
  35
  36 static struct port_state port_states[] = {
  37         PORT_STATE("off",               LED_OFF),
  38         PORT_STATE("on",                LED_FULL),
  39         PORT_STATE("flash",             ADM5120_GPIO_FLASH),
  40         PORT_STATE("link",              ADM5120_GPIO_LINK),
  41         PORT_STATE("speed",             ADM5120_GPIO_SPEED),
  42         PORT_STATE("duplex",            ADM5120_GPIO_DUPLEX),
  43         PORT_STATE("act",               ADM5120_GPIO_ACT),
  44         PORT_STATE("coll",              ADM5120_GPIO_COLL),
  45         PORT_STATE("link_act",          ADM5120_GPIO_LINK_ACT),
  46         PORT_STATE("duplex_coll",       ADM5120_GPIO_DUPLEX_COLL),
  47         PORT_STATE("10M_act",           ADM5120_GPIO_10M_ACT),
  48         PORT_STATE("100M_act",          ADM5120_GPIO_100M_ACT),
  49 };
  50
  51 static ssize_t led_port_state_show(struct device *dev,
  52                 struct device_attribute *attr, char *buf)
  53 {
  54         struct led_classdev *led_cdev = dev_get_drvdata(dev);
  55         struct port_state *state = led_cdev->trigger_data;
  56         int len = 0;
  57         int i;
  58
  59         *buf = '\0';
  60         for (i = 0; i < ARRAY_SIZE(port_states); i++) {
  61                 if (&port_states[i] == state)
  62                         len += sprintf(buf+len, "[%s] ", port_states[i].name);
  63                 else
  64                         len += sprintf(buf+len, "%s ", port_states[i].name);
  65         }
  66         len += sprintf(buf+len, "\n");
  67
  68         return len;
  69 }
  70
  71 static ssize_t led_port_state_store(struct device *dev,
  72                 struct device_attribute *attr, const char *buf, size_t size)
  73 {
  74         struct led_classdev *led_cdev = dev_get_drvdata(dev);
  75         size_t len;
  76         int i;
  77
  78         for (i = 0; i < ARRAY_SIZE(port_states); i++) {
  79                 len = strlen(port_states[i].name);
  80                 if (strncmp(port_states[i].name, buf, len) != 0)
  81                         continue;
  82
  83                 if (buf[len] != '\0' && buf[len] != '\n')
  84                         continue;
  85
  86                 led_cdev->trigger_data = &port_states[i];
  87                 led_set_brightness(led_cdev, port_states[i].value);
  88                 return size;
  89         }
  90
  91         return -EINVAL;
  92 }
  93
  94 static DEVICE_ATTR(port_state, 0644, led_port_state_show,
  95                          led_port_state_store);
  96
  97 static void adm5120_switch_trig_activate(struct led_classdev *led_cdev)
  98 {
  99         struct port_state *state = port_states;
 100         int rc;
 101
 102         led_cdev->trigger_data = state;
 103
 104         rc = device_create_file(led_cdev->dev, &dev_attr_port_state);
 105         if (rc)
 106                 goto err;
 107
 108         led_set_brightness(led_cdev, state->value);
 109
 110         return;
 111 err:
 112         led_cdev->trigger_data = NULL;
 113 }
 114
 115 static void adm5120_switch_trig_deactivate(struct led_classdev *led_cdev)
 116 {
 117         struct port_state *state = led_cdev->trigger_data;
 118
 119         if (!state)
 120                 return;
 121
 122         device_remove_file(led_cdev->dev, &dev_attr_port_state);
 123
 124 }
 125
 126 static struct led_trigger adm5120_switch_led_trigger = {
 127         .name           = DRV_NAME,
 128         .activate       = adm5120_switch_trig_activate,
 129         .deactivate     = adm5120_switch_trig_deactivate,
 130 };
 131
 132 static int __init adm5120_switch_trig_init(void)
 133 {
 134         led_trigger_register(&adm5120_switch_led_trigger);
 135         return 0;
 136 }
 137
 138 static void __exit adm5120_switch_trig_exit(void)
 139 {
 140         led_trigger_unregister(&adm5120_switch_led_trigger);
 141 }
 142
 143 module_init(adm5120_switch_trig_init);
 144 module_exit(adm5120_switch_trig_exit);
 145
 146 MODULE_AUTHOR("Bernhard Held <bernhard at bernhardheld.de>, "
 147                 "Gabor Juhos <juhosg at openwrt.org>");
 148 MODULE_DESCRIPTION(DRV_DESC);
 149 MODULE_LICENSE("GPL");