@@ -18,6 +18,7 @@
#include <linux/property.h>
#include <linux/spi/spi.h>
#include <linux/types.h>
+#include <linux/workqueue.h>
#define TLC5925_SHIFT_REGISTER_LENGTH 16
@@ -29,10 +30,25 @@ struct single_led_priv {
struct tlc5925_leds_priv {
int max_num_leds;
unsigned long *state;
+ struct spi_device *spi;
+ struct work_struct xmit_work;
struct single_led_priv leds[];
};
-static int tlc5925_brightness_set_blocking(struct led_classdev *cdev,
+static int xmit(struct tlc5925_leds_priv *priv)
+{
+ return spi_write(priv->spi, priv->state, BITS_TO_BYTES(priv->max_num_leds));
+}
+
+static void xmit_work(struct work_struct *ws)
+{
+ struct tlc5925_leds_priv *priv =
+ container_of(ws, struct tlc5925_leds_priv, xmit_work);
+
+ xmit(priv);
+};
+
+static void tlc5925_brightness_set(struct led_classdev *cdev,
enum led_brightness brightness)
{
struct spi_device *spi = to_spi_device(cdev->dev->parent);
@@ -43,9 +59,23 @@ static int tlc5925_brightness_set_blocking(struct led_classdev *cdev,
assign_bit(index, priv->state, !!brightness);
- return spi_write(spi, priv->state, BITS_TO_BYTES(priv->max_num_leds));
+ schedule_work(&priv->xmit_work);
}
+static int tlc5925_brightness_set_blocking(struct led_classdev *cdev,
+ enum led_brightness brightness)
+{
+ struct spi_device *spi = to_spi_device(cdev->dev->parent);
+ struct tlc5925_leds_priv *priv = spi_get_drvdata(spi);
+ struct single_led_priv *led =
+ container_of(cdev, struct single_led_priv, cdev);
+ int index = led->idx;
+
+ assign_bit(index, priv->state, !!brightness);
+
+ cancel_work_sync(&priv->xmit_work);
+ return xmit(priv);
+}
static int tlc5925_probe(struct spi_device *spi)
{
struct device *dev = &spi->dev;
@@ -83,6 +113,9 @@ static int tlc5925_probe(struct spi_device *spi)
if (!priv->state)
return -ENOMEM;
+ priv->spi = spi;
+ INIT_WORK(&priv->xmit_work, xmit_work);
+
priv->max_num_leds = max_num_leds;
device_for_each_child_node(dev, child) {
@@ -104,6 +137,7 @@ static int tlc5925_probe(struct spi_device *spi)
cdev = &(priv->leds[count].cdev);
cdev->brightness = LED_OFF;
cdev->max_brightness = 1;
+ cdev->brightness_set = tlc5925_brightness_set;
cdev->brightness_set_blocking = tlc5925_brightness_set_blocking;
ret = devm_led_classdev_register_ext(dev, cdev, &init_data);