[OpenWrt-Devel] [PATCH 2/4] switch: allow Ethernet port LEDs to show specific link speeds only
John Crispin
blogic at openwrt.org
Fri Feb 12 07:59:00 EST 2016
Hi,
small nitpick at the end of the patch ...
On 12/02/2016 00:45, Michal wrote:
> From: Michal Cieslakiewicz <michal.cieslakiewicz at wp.pl>
> Subject: [PATCH 2/4] switch: allow Ethernet port LEDs to show specific link speeds only
>
> This patch adds speed_mask special file to LEDs connected to switch ports
> via 'switch' trigger. It allows to choose which speeds to signal when link
> is up. If router has more than one LED per port, they may light up differently
> depending on how fast connection is. Default setting is 'all speeds' so
> backward compatibilty with system scripts (for example uci) is maintained.
>
> Signed-off-by: Michal Cieslakiewicz <michal.cieslakiewicz at wp.pl>
> ---
> Link speed to speed_mask bit mapping:
> bit 0 (0x01) - unknown port speed, may indicate cabling problem
> bit 1 (0x02) - 10 Mbps
> bit 2 (0x04) - 100 Mbps
> bit 3 (0x08) - 1000 Mbps aka 1 Gbps
> bits 4-7 - reserved for future use, always 0, ignored for now
>
> .../generic/files/drivers/net/phy/swconfig_leds.c | 106 ++++++++++++++++++++-
> 1 file changed, 102 insertions(+), 4 deletions(-)
>
> diff --git a/target/linux/generic/files/drivers/net/phy/swconfig_leds.c b/target/linux/generic/files/drivers/net/phy/swconfig_leds.c
> index 7d122d2..433a472 100644
> --- a/target/linux/generic/files/drivers/net/phy/swconfig_leds.c
> +++ b/target/linux/generic/files/drivers/net/phy/swconfig_leds.c
> @@ -20,6 +20,15 @@
> #define SWCONFIG_LED_TIMER_INTERVAL (HZ / 10)
> #define SWCONFIG_LED_NUM_PORTS 32
>
> +#define SWCONFIG_LED_PORT_SPEED_NA 0x01 /* unknown speed */
> +#define SWCONFIG_LED_PORT_SPEED_10 0x02 /* 10 Mbps */
> +#define SWCONFIG_LED_PORT_SPEED_100 0x04 /* 100 Mbps */
> +#define SWCONFIG_LED_PORT_SPEED_1000 0x08 /* 1000 Mbps */
> +#define SWCONFIG_LED_PORT_SPEED_ALL ( SWCONFIG_LED_PORT_SPEED_NA | \
> + SWCONFIG_LED_PORT_SPEED_10 | \
> + SWCONFIG_LED_PORT_SPEED_100 | \
> + SWCONFIG_LED_PORT_SPEED_1000 )
> +
> struct switch_led_trigger {
> struct led_trigger trig;
> struct switch_dev *swdev;
> @@ -28,6 +37,7 @@ struct switch_led_trigger {
> u32 port_mask;
> u32 port_link;
> unsigned long port_traffic[SWCONFIG_LED_NUM_PORTS];
> + u8 link_speed[SWCONFIG_LED_NUM_PORTS];
> };
>
> struct swconfig_trig_data {
> @@ -40,6 +50,7 @@ struct swconfig_trig_data {
> bool prev_link;
> unsigned long prev_traffic;
> enum led_brightness prev_brightness;
> + u8 speed_mask;
> };
>
> static void
> @@ -135,6 +146,46 @@ swconfig_trig_port_mask_show(struct device *dev, struct device_attribute *attr,
> static DEVICE_ATTR(port_mask, 0644, swconfig_trig_port_mask_show,
> swconfig_trig_port_mask_store);
>
> +/* speed_mask file handler - display value */
> +static ssize_t swconfig_trig_speed_mask_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + struct led_classdev *led_cdev = dev_get_drvdata(dev);
> + struct swconfig_trig_data *trig_data = led_cdev->trigger_data;
> +
> + read_lock(&trig_data->lock);
> + sprintf(buf, "%#x\n", trig_data->speed_mask);
> + read_unlock(&trig_data->lock);
> +
> + return strlen(buf) + 1;
> +}
> +
> +/* speed_mask file handler - store value */
> +static ssize_t swconfig_trig_speed_mask_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t size)
> +{
> + struct led_classdev *led_cdev = dev_get_drvdata(dev);
> + struct swconfig_trig_data *trig_data = led_cdev->trigger_data;
> + u8 speed_mask;
> + int ret;
> +
> + ret = kstrtou8(buf, 0, &speed_mask);
> + if (ret)
> + return ret;
> +
> + write_lock(&trig_data->lock);
> + trig_data->speed_mask = speed_mask & SWCONFIG_LED_PORT_SPEED_ALL;
> + write_unlock(&trig_data->lock);
> +
> + return size;
> +}
> +
> +/* speed_mask special file */
> +static DEVICE_ATTR(speed_mask, 0644, swconfig_trig_speed_mask_show,
> + swconfig_trig_speed_mask_store);
> +
> static void
> swconfig_trig_activate(struct led_classdev *led_cdev)
> {
> @@ -154,14 +205,22 @@ swconfig_trig_activate(struct led_classdev *led_cdev)
> rwlock_init(&trig_data->lock);
> trig_data->led_cdev = led_cdev;
> trig_data->swdev = sw_trig->swdev;
> + trig_data->speed_mask = SWCONFIG_LED_PORT_SPEED_ALL;
> led_cdev->trigger_data = trig_data;
>
> err = device_create_file(led_cdev->dev, &dev_attr_port_mask);
> if (err)
> goto err_free;
>
> + err = device_create_file(led_cdev->dev, &dev_attr_speed_mask);
> + if (err)
> + goto err_dev_free;
> +
> return;
>
> +err_dev_free:
> + device_remove_file(led_cdev->dev, &dev_attr_port_mask);
> +
> err_free:
> led_cdev->trigger_data = NULL;
> kfree(trig_data);
> @@ -177,6 +236,7 @@ swconfig_trig_deactivate(struct led_classdev *led_cdev)
> trig_data = (void *) led_cdev->trigger_data;
> if (trig_data) {
> device_remove_file(led_cdev->dev, &dev_attr_port_mask);
> + device_remove_file(led_cdev->dev, &dev_attr_speed_mask);
> kfree(trig_data);
> }
> }
> @@ -188,6 +248,7 @@ swconfig_trig_led_event(struct switch_led_trigger *sw_trig,
> struct swconfig_trig_data *trig_data;
> u32 port_mask;
> bool link;
> + u8 speed_mask;
>
> trig_data = led_cdev->trigger_data;
> if (!trig_data)
> @@ -195,6 +256,7 @@ swconfig_trig_led_event(struct switch_led_trigger *sw_trig,
>
> read_lock(&trig_data->lock);
> port_mask = trig_data->port_mask;
> + speed_mask = trig_data->speed_mask;
> read_unlock(&trig_data->lock);
>
> link = !!(sw_trig->port_link & port_mask);
> @@ -203,17 +265,30 @@ swconfig_trig_led_event(struct switch_led_trigger *sw_trig,
> swconfig_trig_set_brightness(trig_data, LED_OFF);
> } else {
> unsigned long traffic;
> + bool speedok;
> int i;
>
> traffic = 0;
> + speedok = 0;
> for (i = 0; i < SWCONFIG_LED_NUM_PORTS; i++) {
> if (port_mask & (1 << i))
> - traffic += sw_trig->port_traffic[i];
> + if (sw_trig->link_speed[i] & speed_mask)
> + {
> + traffic += sw_trig->port_traffic[i];
> + speedok = 1;
> + }
> }
>
> - if (trig_data->prev_brightness != LED_FULL)
> - swconfig_trig_set_brightness(trig_data, LED_FULL);
> - else if (traffic != trig_data->prev_traffic)
> + if (speedok)
> + {
> + if (trig_data->prev_brightness != LED_FULL)
> + swconfig_trig_set_brightness(trig_data,
> + LED_FULL);
> + else if (traffic != trig_data->prev_traffic)
> + swconfig_trig_set_brightness(trig_data,
> + LED_OFF);
> + }
> + else if (trig_data->prev_brightness != LED_OFF)
> swconfig_trig_set_brightness(trig_data, LED_OFF);
>
> trig_data->prev_traffic = traffic;
> @@ -258,6 +333,8 @@ swconfig_led_work_func(struct work_struct *work)
> for (i = 0; i < SWCONFIG_LED_NUM_PORTS; i++) {
> u32 port_bit;
>
> + sw_trig->link_speed[i] = 0;
> +
> port_bit = BIT(i);
> if ((port_mask & port_bit) == 0)
> continue;
> @@ -269,7 +346,28 @@ swconfig_led_work_func(struct work_struct *work)
> swdev->ops->get_port_link(swdev, i, &port_link);
>
> if (port_link.link)
> + {
put the bracket on the same line as the if clause
> link |= port_bit;
> + switch(port_link.speed)
> + {
put the bracket on the same line as the switch
> + case SWITCH_PORT_SPEED_UNKNOWN:
case statements should be indented one tab less so that they are aligned
with the switch
John
> + sw_trig->link_speed[i] =
> + SWCONFIG_LED_PORT_SPEED_NA;
> + break;
> + case SWITCH_PORT_SPEED_10:
> + sw_trig->link_speed[i] =
> + SWCONFIG_LED_PORT_SPEED_10;
> + break;
> + case SWITCH_PORT_SPEED_100:
> + sw_trig->link_speed[i] =
> + SWCONFIG_LED_PORT_SPEED_100;
> + break;
> + case SWITCH_PORT_SPEED_1000:
> + sw_trig->link_speed[i] =
> + SWCONFIG_LED_PORT_SPEED_1000;
> + break;
> + }
> + }
> }
>
> if (swdev->ops->get_port_stats) {
>
_______________________________________________
openwrt-devel mailing list
openwrt-devel at lists.openwrt.org
https://lists.openwrt.org/cgi-bin/mailman/listinfo/openwrt-devel
More information about the openwrt-devel
mailing list