Commit 4723f2b8 authored by Fabio Baltieri's avatar Fabio Baltieri Committed by Marc Kleine-Budde

can: at91_can: add LED trigger support

Add support for canbus activity led indicators on at91_can devices by
calling appropriate can_led functions.

These are only enabled when CONFIG_CAN_LEDS is Y, becomes no-op
otherwise.

Cc: Wolfgang Grandegger <wg@grandegger.com>
Cc: Marc Kleine-Budde <mkl@pengutronix.de>
Signed-off-by: default avatarFabio Baltieri <fabio.baltieri@gmail.com>
Signed-off-by: default avatarMarc Kleine-Budde <mkl@pengutronix.de>
parent adccadb9
...@@ -37,6 +37,7 @@ ...@@ -37,6 +37,7 @@
#include <linux/can/dev.h> #include <linux/can/dev.h>
#include <linux/can/error.h> #include <linux/can/error.h>
#include <linux/can/led.h>
#define AT91_MB_MASK(i) ((1 << (i)) - 1) #define AT91_MB_MASK(i) ((1 << (i)) - 1)
...@@ -641,6 +642,8 @@ static void at91_read_msg(struct net_device *dev, unsigned int mb) ...@@ -641,6 +642,8 @@ static void at91_read_msg(struct net_device *dev, unsigned int mb)
stats->rx_packets++; stats->rx_packets++;
stats->rx_bytes += cf->can_dlc; stats->rx_bytes += cf->can_dlc;
can_led_event(dev, CAN_LED_EVENT_RX);
} }
/** /**
...@@ -875,6 +878,7 @@ static void at91_irq_tx(struct net_device *dev, u32 reg_sr) ...@@ -875,6 +878,7 @@ static void at91_irq_tx(struct net_device *dev, u32 reg_sr)
/* _NOTE_: subtract AT91_MB_TX_FIRST offset from mb! */ /* _NOTE_: subtract AT91_MB_TX_FIRST offset from mb! */
can_get_echo_skb(dev, mb - get_mb_tx_first(priv)); can_get_echo_skb(dev, mb - get_mb_tx_first(priv));
dev->stats.tx_packets++; dev->stats.tx_packets++;
can_led_event(dev, CAN_LED_EVENT_TX);
} }
} }
...@@ -1128,6 +1132,8 @@ static int at91_open(struct net_device *dev) ...@@ -1128,6 +1132,8 @@ static int at91_open(struct net_device *dev)
goto out_close; goto out_close;
} }
can_led_event(dev, CAN_LED_EVENT_OPEN);
/* start chip and queuing */ /* start chip and queuing */
at91_chip_start(dev); at91_chip_start(dev);
napi_enable(&priv->napi); napi_enable(&priv->napi);
...@@ -1159,6 +1165,8 @@ static int at91_close(struct net_device *dev) ...@@ -1159,6 +1165,8 @@ static int at91_close(struct net_device *dev)
close_candev(dev); close_candev(dev);
can_led_event(dev, CAN_LED_EVENT_STOP);
return 0; return 0;
} }
...@@ -1321,6 +1329,8 @@ static int at91_can_probe(struct platform_device *pdev) ...@@ -1321,6 +1329,8 @@ static int at91_can_probe(struct platform_device *pdev)
goto exit_free; goto exit_free;
} }
devm_can_led_init(dev);
dev_info(&pdev->dev, "device registered (reg_base=%p, irq=%d)\n", dev_info(&pdev->dev, "device registered (reg_base=%p, irq=%d)\n",
priv->reg_base, dev->irq); priv->reg_base, dev->irq);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment