Commit efe3b616 authored by Matt Ranostay's avatar Matt Ranostay Committed by Dmitry Torokhov
Browse files

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: default avatarMatt Ranostay <mranostay@gmail.com>
Signed-off-by: default avatarDmitry Torokhov <dmitry.torokhov@gmail.com>
parent 7229b87b

Documentation/devicetree/bindings/input/cap11xx.txt

+19 −0
Original line number Diff line number Diff line
@@ -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";

		};

	};

}

drivers/input/keyboard/cap11xx.c

+141 −3
Original line number Diff line number Diff line
@@ -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 @@ static irqreturn_t cap11xx_thread_func(int irq_num, void *data) 


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);



	/*