Input: cap11xx - add LED support

Several cap11xx variants have LEDs that be can be controlled; let's plug
the driver into the LED subsystem.

Signed-off-by: Matt Ranostay <mranostay@gmail.com>
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>

diff --git a/Documentation/devicetree/bindings/input/cap11xx.txt b/Documentation/devicetree/bindings/input/cap11xx.txt
index 7d0a3009771b92c2e9e43c310d4f6140e78c02f6..8c67a0b5058d82ab875b817eda7d5859fce88c9f 100644 (file)
--- a/Documentation/devicetree/bindings/input/cap11xx.txt
+++ b/Documentation/devicetree/bindings/input/cap11xx.txt
@@ -55,5 +55,24 @@ i2c_controller {
                                 <105>,         /* KEY_LEFT */
                                 <109>,         /* KEY_PAGEDOWN */
                                 <104>;         /* KEY_PAGEUP */
+
+               #address-cells = <1>;
+               #size-cells = <0>;
+
+               usr@0 {
+                       label = "cap11xx:green:usr0";
+                       reg = <0>;
+               };
+
+               usr@1 {
+                       label = "cap11xx:green:usr1";
+                       reg = <1>;
+               };
+
+               alive@2 {
+                       label = "cap11xx:green:alive";
+                       reg = <2>;
+                       linux,default_trigger = "heartbeat";
+               };
        };
 }

diff --git a/drivers/input/keyboard/cap11xx.c b/drivers/input/keyboard/cap11xx.c
index b58fd9d72d9278738a2ac26b2fc2cdafc3fa968d..378db10001df5067adcf4fe5bfc2b38e42098574 100644 (file)
--- a/drivers/input/keyboard/cap11xx.c
+++ b/drivers/input/keyboard/cap11xx.c
@@ -12,6 +12,7 @@
 #include <linux/module.h>
 #include <linux/interrupt.h>
 #include <linux/input.h>
+#include <linux/leds.h>
 #include <linux/of_irq.h>
 #include <linux/regmap.h>
 #include <linux/i2c.h>
@@ -47,6 +48,20 @@
 #define CAP11XX_REG_CONFIG2            0x44
 #define CAP11XX_REG_CONFIG2_ALT_POL    BIT(6)
 #define CAP11XX_REG_SENSOR_BASE_CNT(X) (0x50 + (X))
+#define CAP11XX_REG_LED_POLARITY       0x73
+#define CAP11XX_REG_LED_OUTPUT_CONTROL 0x74
+
+#define CAP11XX_REG_LED_DUTY_CYCLE_1   0x90
+#define CAP11XX_REG_LED_DUTY_CYCLE_2   0x91
+#define CAP11XX_REG_LED_DUTY_CYCLE_3   0x92
+#define CAP11XX_REG_LED_DUTY_CYCLE_4   0x93
+
+#define CAP11XX_REG_LED_DUTY_MIN_MASK  (0x0f)
+#define CAP11XX_REG_LED_DUTY_MIN_MASK_SHIFT    (0)
+#define CAP11XX_REG_LED_DUTY_MAX_MASK  (0xf0)
+#define CAP11XX_REG_LED_DUTY_MAX_MASK_SHIFT    (4)
+#define CAP11XX_REG_LED_DUTY_MAX_VALUE (15)
+
 #define CAP11XX_REG_SENSOR_CALIB       (0xb1 + (X))
 #define CAP11XX_REG_SENSOR_CALIB_LSB1  0xb9
 #define CAP11XX_REG_SENSOR_CALIB_LSB2  0xba
@@ -56,10 +71,23 @@
 
 #define CAP11XX_MANUFACTURER_ID        0x5d
 
+#ifdef CONFIG_LEDS_CLASS
+struct cap11xx_led {
+       struct cap11xx_priv *priv;
+       struct led_classdev cdev;
+       struct work_struct work;
+       u32 reg;
+       enum led_brightness new_brightness;
+};
+#endif
+
 struct cap11xx_priv {
        struct regmap *regmap;
        struct input_dev *idev;
 
+       struct cap11xx_led *leds;
+       int num_leds;
+
        /* config */
        u32 keycodes[];
 };
@@ -67,6 +95,7 @@ struct cap11xx_priv {
 struct cap11xx_hw_model {
        u8 product_id;
        unsigned int num_channels;
+       unsigned int num_leds;
 };
 
 enum {
@@ -76,9 +105,9 @@ enum {
 };
 
 static const struct cap11xx_hw_model cap11xx_devices[] = {
-       [CAP1106] = { .product_id = 0x55, .num_channels = 6 },
-       [CAP1126] = { .product_id = 0x53, .num_channels = 6 },
-       [CAP1188] = { .product_id = 0x50, .num_channels = 8 },
+       [CAP1106] = { .product_id = 0x55, .num_channels = 6, .num_leds = 0 },
+       [CAP1126] = { .product_id = 0x53, .num_channels = 6, .num_leds = 2 },
+       [CAP1188] = { .product_id = 0x50, .num_channels = 8, .num_leds = 8 },
 };
 
 static const struct reg_default cap11xx_reg_defaults[] = {
@@ -111,6 +140,7 @@ static const struct reg_default cap11xx_reg_defaults[] = {
        { CAP11XX_REG_STANDBY_SENSITIVITY,      0x02 },
        { CAP11XX_REG_STANDBY_THRESH,           0x40 },
        { CAP11XX_REG_CONFIG2,                  0x40 },
+       { CAP11XX_REG_LED_POLARITY,             0x00 },
        { CAP11XX_REG_SENSOR_CALIB_LSB1,        0x00 },
        { CAP11XX_REG_SENSOR_CALIB_LSB2,        0x00 },
 };
@@ -177,6 +207,12 @@ out:
 
 static int cap11xx_set_sleep(struct cap11xx_priv *priv, bool sleep)
 {
+       /*
+        * DLSEEP mode will turn off all LEDS, prevent this
+        */
+       if (IS_ENABLED(CONFIG_LEDS_CLASS) && priv->num_leds)
+               return 0;
+
        return regmap_update_bits(priv->regmap, CAP11XX_REG_MAIN_CONTROL,
                                  CAP11XX_REG_MAIN_CONTROL_DLSEEP,
                                  sleep ? CAP11XX_REG_MAIN_CONTROL_DLSEEP : 0);
@@ -196,6 +232,104 @@ static void cap11xx_input_close(struct input_dev *idev)
        cap11xx_set_sleep(priv, true);
 }
 
+#ifdef CONFIG_LEDS_CLASS
+static void cap11xx_led_work(struct work_struct *work)
+{
+       struct cap11xx_led *led = container_of(work, struct cap11xx_led, work);
+       struct cap11xx_priv *priv = led->priv;
+       int value = led->new_brightness;
+
+       /*
+        * All LEDs share the same duty cycle as this is a HW limitation.
+        * Brightness levels per LED are either 0 (OFF) and 1 (ON).
+        */
+       regmap_update_bits(priv->regmap, CAP11XX_REG_LED_OUTPUT_CONTROL,
+                               BIT(led->reg), value ? BIT(led->reg) : 0);
+}
+
+static void cap11xx_led_set(struct led_classdev *cdev,
+                          enum led_brightness value)
+{
+       struct cap11xx_led *led = container_of(cdev, struct cap11xx_led, cdev);
+
+       if (led->new_brightness == value)
+               return;
+
+       led->new_brightness = value;
+       schedule_work(&led->work);
+}
+
+static int cap11xx_init_leds(struct device *dev,
+                            struct cap11xx_priv *priv, int num_leds)
+{
+       struct device_node *node = dev->of_node, *child;
+       struct cap11xx_led *led;
+       int cnt = of_get_child_count(node);
+       int error;
+
+       if (!num_leds || !cnt)
+               return 0;
+
+       if (cnt > num_leds)
+               return -EINVAL;
+
+       led = devm_kcalloc(dev, cnt, sizeof(struct cap11xx_led), GFP_KERNEL);
+       if (!led)
+               return -ENOMEM;
+
+       priv->leds = led;
+
+       error = regmap_update_bits(priv->regmap,
+                               CAP11XX_REG_LED_OUTPUT_CONTROL, 0xff, 0);
+       if (error)
+               return error;
+
+       error = regmap_update_bits(priv->regmap, CAP11XX_REG_LED_DUTY_CYCLE_4,
+                               CAP11XX_REG_LED_DUTY_MAX_MASK,
+                               CAP11XX_REG_LED_DUTY_MAX_VALUE <<
+                               CAP11XX_REG_LED_DUTY_MAX_MASK_SHIFT);
+       if (error)
+               return error;
+
+       for_each_child_of_node(node, child) {
+               u32 reg;
+
+               led->cdev.name =
+                       of_get_property(child, "label", NULL) ? : child->name;
+               led->cdev.default_trigger =
+                       of_get_property(child, "linux,default-trigger", NULL);
+               led->cdev.flags = 0;
+               led->cdev.brightness_set = cap11xx_led_set;
+               led->cdev.max_brightness = 1;
+               led->cdev.brightness = LED_OFF;
+
+               error = of_property_read_u32(child, "reg", &reg);
+               if (error != 0 || reg >= num_leds)
+                       return -EINVAL;
+
+               led->reg = reg;
+               led->priv = priv;
+
+               INIT_WORK(&led->work, cap11xx_led_work);
+
+               error = devm_led_classdev_register(dev, &led->cdev);
+               if (error)
+                       return error;
+
+               priv->num_leds++;
+               led++;
+       }
+
+       return 0;
+}
+#else
+static int cap11xx_init_leds(struct device *dev,
+                            struct cap11xx_priv *priv, int num_leds)
+{
+       return 0;
+}
+#endif
+
 static int cap11xx_i2c_probe(struct i2c_client *i2c_client,
                             const struct i2c_device_id *id)
 {
@@ -316,6 +450,10 @@ static int cap11xx_i2c_probe(struct i2c_client *i2c_client,
        priv->idev->open = cap11xx_input_open;
        priv->idev->close = cap11xx_input_close;
 
+       error = cap11xx_init_leds(dev, priv, cap->num_leds);
+       if (error)
+               return error;
+
        input_set_drvdata(priv->idev, priv);
 
        /*