cregit-Linux how code gets into the kernel

Release 4.11 drivers/input/keyboard/cap11xx.c

/*
 * Input driver for Microchip CAP11xx based capacitive touch sensors
 *
 * (c) 2014 Daniel Mack <linux@zonque.org>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/kernel.h>
#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>
#include <linux/gpio/consumer.h>


#define CAP11XX_REG_MAIN_CONTROL	0x00

#define CAP11XX_REG_MAIN_CONTROL_GAIN_SHIFT	(6)

#define CAP11XX_REG_MAIN_CONTROL_GAIN_MASK	(0xc0)

#define CAP11XX_REG_MAIN_CONTROL_DLSEEP		BIT(4)

#define CAP11XX_REG_GENERAL_STATUS	0x02

#define CAP11XX_REG_SENSOR_INPUT	0x03

#define CAP11XX_REG_NOISE_FLAG_STATUS	0x0a

#define CAP11XX_REG_SENOR_DELTA(X)	(0x10 + (X))

#define CAP11XX_REG_SENSITIVITY_CONTROL	0x1f

#define CAP11XX_REG_CONFIG		0x20

#define CAP11XX_REG_SENSOR_ENABLE	0x21

#define CAP11XX_REG_SENSOR_CONFIG	0x22

#define CAP11XX_REG_SENSOR_CONFIG2	0x23

#define CAP11XX_REG_SAMPLING_CONFIG	0x24

#define CAP11XX_REG_CALIBRATION		0x26

#define CAP11XX_REG_INT_ENABLE		0x27

#define CAP11XX_REG_REPEAT_RATE		0x28

#define CAP11XX_REG_MT_CONFIG		0x2a

#define CAP11XX_REG_MT_PATTERN_CONFIG	0x2b

#define CAP11XX_REG_MT_PATTERN		0x2d

#define CAP11XX_REG_RECALIB_CONFIG	0x2f

#define CAP11XX_REG_SENSOR_THRESH(X)	(0x30 + (X))

#define CAP11XX_REG_SENSOR_NOISE_THRESH	0x38

#define CAP11XX_REG_STANDBY_CHANNEL	0x40

#define CAP11XX_REG_STANDBY_CONFIG	0x41

#define CAP11XX_REG_STANDBY_SENSITIVITY	0x42

#define CAP11XX_REG_STANDBY_THRESH	0x43

#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

#define CAP11XX_REG_PRODUCT_ID		0xfd

#define CAP11XX_REG_MANUFACTURER_ID	0xfe

#define CAP11XX_REG_REVISION		0xff


#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[];
};


struct cap11xx_hw_model {
	
u8 product_id;
	
unsigned int num_channels;
	
unsigned int num_leds;
};

enum {
	
CAP1106,
	
CAP1126,
	
CAP1188,
};


static const struct cap11xx_hw_model cap11xx_devices[] = {
	[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[] = {
	{ CAP11XX_REG_MAIN_CONTROL,		0x00 },
	{ CAP11XX_REG_GENERAL_STATUS,		0x00 },
	{ CAP11XX_REG_SENSOR_INPUT,		0x00 },
	{ CAP11XX_REG_NOISE_FLAG_STATUS,	0x00 },
	{ CAP11XX_REG_SENSITIVITY_CONTROL,	0x2f },
	{ CAP11XX_REG_CONFIG,			0x20 },
	{ CAP11XX_REG_SENSOR_ENABLE,		0x3f },
	{ CAP11XX_REG_SENSOR_CONFIG,		0xa4 },
	{ CAP11XX_REG_SENSOR_CONFIG2,		0x07 },
	{ CAP11XX_REG_SAMPLING_CONFIG,		0x39 },
	{ CAP11XX_REG_CALIBRATION,		0x00 },
	{ CAP11XX_REG_INT_ENABLE,		0x3f },
	{ CAP11XX_REG_REPEAT_RATE,		0x3f },
	{ CAP11XX_REG_MT_CONFIG,		0x80 },
	{ CAP11XX_REG_MT_PATTERN_CONFIG,	0x00 },
	{ CAP11XX_REG_MT_PATTERN,		0x3f },
	{ CAP11XX_REG_RECALIB_CONFIG,		0x8a },
	{ CAP11XX_REG_SENSOR_THRESH(0),		0x40 },
	{ CAP11XX_REG_SENSOR_THRESH(1),		0x40 },
	{ CAP11XX_REG_SENSOR_THRESH(2),		0x40 },
	{ CAP11XX_REG_SENSOR_THRESH(3),		0x40 },
	{ CAP11XX_REG_SENSOR_THRESH(4),		0x40 },
	{ CAP11XX_REG_SENSOR_THRESH(5),		0x40 },
	{ CAP11XX_REG_SENSOR_NOISE_THRESH,	0x01 },
	{ CAP11XX_REG_STANDBY_CHANNEL,		0x00 },
	{ CAP11XX_REG_STANDBY_CONFIG,		0x39 },
	{ 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 },
};


static bool cap11xx_volatile_reg(struct device *dev, unsigned int reg) { switch (reg) { case CAP11XX_REG_MAIN_CONTROL: case CAP11XX_REG_SENSOR_INPUT: case CAP11XX_REG_SENOR_DELTA(0): case CAP11XX_REG_SENOR_DELTA(1): case CAP11XX_REG_SENOR_DELTA(2): case CAP11XX_REG_SENOR_DELTA(3): case CAP11XX_REG_SENOR_DELTA(4): case CAP11XX_REG_SENOR_DELTA(5): case CAP11XX_REG_PRODUCT_ID: case CAP11XX_REG_MANUFACTURER_ID: case CAP11XX_REG_REVISION: return true; } return false; }

Contributors

PersonTokensPropCommitsCommitProp
Daniel Mack6684.62%150.00%
Matthew Ranostay1215.38%150.00%
Total78100.00%2100.00%

static const struct regmap_config cap11xx_regmap_config = { .reg_bits = 8, .val_bits = 8, .max_register = CAP11XX_REG_REVISION, .reg_defaults = cap11xx_reg_defaults, .num_reg_defaults = ARRAY_SIZE(cap11xx_reg_defaults), .cache_type = REGCACHE_RBTREE, .volatile_reg = cap11xx_volatile_reg, };
static irqreturn_t cap11xx_thread_func(int irq_num, void *data) { struct cap11xx_priv *priv = data; unsigned int status; int ret, i; /* * Deassert interrupt. This needs to be done before reading the status * registers, which will not carry valid values otherwise. */ ret = regmap_update_bits(priv->regmap, CAP11XX_REG_MAIN_CONTROL, 1, 0); if (ret < 0) goto out; ret = regmap_read(priv->regmap, CAP11XX_REG_SENSOR_INPUT, &status); if (ret < 0) goto out; for (i = 0; i < priv->idev->keycodemax; i++) input_report_key(priv->idev, priv->keycodes[i], status & (1 << i)); input_sync(priv->idev); out: return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Daniel Mack11992.97%133.33%
Matthew Ranostay97.03%266.67%
Total128100.00%3100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Daniel Mack2757.45%133.33%
Matthew Ranostay2042.55%266.67%
Total47100.00%3100.00%


static int cap11xx_input_open(struct input_dev *idev) { struct cap11xx_priv *priv = input_get_drvdata(idev); return cap11xx_set_sleep(priv, false); }

Contributors

PersonTokensPropCommitsCommitProp
Daniel Mack2689.66%150.00%
Matthew Ranostay310.34%150.00%
Total29100.00%2100.00%


static void cap11xx_input_close(struct input_dev *idev) { struct cap11xx_priv *priv = input_get_drvdata(idev); cap11xx_set_sleep(priv, true); }

Contributors

PersonTokensPropCommitsCommitProp
Daniel Mack2589.29%150.00%
Matthew Ranostay310.71%150.00%
Total28100.00%2100.00%

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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Ranostay70100.00%1100.00%
Total70100.00%1100.00%


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

Contributors

PersonTokensPropCommitsCommitProp
Matthew Ranostay53100.00%1100.00%
Total53100.00%1100.00%


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) { of_node_put(child); 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) { of_node_put(child); return error; } priv->num_leds++; led++; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Ranostay30295.57%150.00%
Amitoj Kaur Chawla144.43%150.00%
Total316100.00%2100.00%

#else
static int cap11xx_init_leds(struct device *dev, struct cap11xx_priv *priv, int num_leds) { return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Matthew Ranostay22100.00%1100.00%
Total22100.00%1100.00%

#endif
static int cap11xx_i2c_probe(struct i2c_client *i2c_client, const struct i2c_device_id *id) { struct device *dev = &i2c_client->dev; struct cap11xx_priv *priv; struct device_node *node; const struct cap11xx_hw_model *cap; int i, error, irq, gain = 0; unsigned int val, rev; u32 gain32; if (id->driver_data >= ARRAY_SIZE(cap11xx_devices)) { dev_err(dev, "Invalid device ID %lu\n", id->driver_data); return -EINVAL; } cap = &cap11xx_devices[id->driver_data]; if (!cap || !cap->num_channels) { dev_err(dev, "Invalid device configuration\n"); return -EINVAL; } priv = devm_kzalloc(dev, sizeof(*priv) + cap->num_channels * sizeof(priv->keycodes[0]), GFP_KERNEL); if (!priv) return -ENOMEM; priv->regmap = devm_regmap_init_i2c(i2c_client, &cap11xx_regmap_config); if (IS_ERR(priv->regmap)) return PTR_ERR(priv->regmap); error = regmap_read(priv->regmap, CAP11XX_REG_PRODUCT_ID, &val); if (error) return error; if (val != cap->product_id) { dev_err(dev, "Product ID: Got 0x%02x, expected 0x%02x\n", val, cap->product_id); return -ENXIO; } error = regmap_read(priv->regmap, CAP11XX_REG_MANUFACTURER_ID, &val); if (error) return error; if (val != CAP11XX_MANUFACTURER_ID) { dev_err(dev, "Manufacturer ID: Got 0x%02x, expected 0x%02x\n", val, CAP11XX_MANUFACTURER_ID); return -ENXIO; } error = regmap_read(priv->regmap, CAP11XX_REG_REVISION, &rev); if (error < 0) return error; dev_info(dev, "CAP11XX detected, revision 0x%02x\n", rev); node = dev->of_node; if (!of_property_read_u32(node, "microchip,sensor-gain", &gain32)) { if (is_power_of_2(gain32) && gain32 <= 8) gain = ilog2(gain32); else dev_err(dev, "Invalid sensor-gain value %d\n", gain32); } if (of_property_read_bool(node, "microchip,irq-active-high")) { error = regmap_update_bits(priv->regmap, CAP11XX_REG_CONFIG2, CAP11XX_REG_CONFIG2_ALT_POL, 0); if (error) return error; } /* Provide some useful defaults */ for (i = 0; i < cap->num_channels; i++) priv->keycodes[i] = KEY_A + i; of_property_read_u32_array(node, "linux,keycodes", priv->keycodes, cap->num_channels); error = regmap_update_bits(priv->regmap, CAP11XX_REG_MAIN_CONTROL, CAP11XX_REG_MAIN_CONTROL_GAIN_MASK, gain << CAP11XX_REG_MAIN_CONTROL_GAIN_SHIFT); if (error) return error; /* Disable autorepeat. The Linux input system has its own handling. */ error = regmap_write(priv->regmap, CAP11XX_REG_REPEAT_RATE, 0); if (error) return error; priv->idev = devm_input_allocate_device(dev); if (!priv->idev) return -ENOMEM; priv->idev->name = "CAP11XX capacitive touch sensor"; priv->idev->id.bustype = BUS_I2C; priv->idev->evbit[0] = BIT_MASK(EV_KEY); if (of_property_read_bool(node, "autorepeat")) __set_bit(EV_REP, priv->idev->evbit); for (i = 0; i < cap->num_channels; i++) __set_bit(priv->keycodes[i], priv->idev->keybit); __clear_bit(KEY_RESERVED, priv->idev->keybit); priv->idev->keycode = priv->keycodes; priv->idev->keycodesize = sizeof(priv->keycodes[0]); priv->idev->keycodemax = cap->num_channels; priv->idev->id.vendor = CAP11XX_MANUFACTURER_ID; priv->idev->id.product = cap->product_id; priv->idev->id.version = rev; 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); /* * Put the device in deep sleep mode for now. * ->open() will bring it back once the it is actually needed. */ cap11xx_set_sleep(priv, true); error = input_register_device(priv->idev); if (error) return error; irq = irq_of_parse_and_map(node, 0); if (!irq) { dev_err(dev, "Unable to parse or map IRQ\n"); return -ENXIO; } error = devm_request_threaded_irq(dev, irq, NULL, cap11xx_thread_func, IRQF_ONESHOT, dev_name(dev), priv); if (error) return error; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Daniel Mack57171.91%116.67%
Matthew Ranostay17822.42%466.67%
Dmitry Torokhov455.67%116.67%
Total794100.00%6100.00%

static const struct of_device_id cap11xx_dt_ids[] = { { .compatible = "microchip,cap1106", }, { .compatible = "microchip,cap1126", }, { .compatible = "microchip,cap1188", }, {} }; MODULE_DEVICE_TABLE(of, cap11xx_dt_ids); static const struct i2c_device_id cap11xx_i2c_ids[] = { { "cap1106", CAP1106 }, { "cap1126", CAP1126 }, { "cap1188", CAP1188 }, {} }; MODULE_DEVICE_TABLE(i2c, cap11xx_i2c_ids); static struct i2c_driver cap11xx_i2c_driver = { .driver = { .name = "cap11xx", .of_match_table = cap11xx_dt_ids, }, .id_table = cap11xx_i2c_ids, .probe = cap11xx_i2c_probe, }; module_i2c_driver(cap11xx_i2c_driver); MODULE_DESCRIPTION("Microchip CAP11XX driver"); MODULE_AUTHOR("Daniel Mack <linux@zonque.org>"); MODULE_LICENSE("GPL v2");

Overall Contributors

PersonTokensPropCommitsCommitProp
Daniel Mack130155.41%112.50%
Matthew Ranostay98641.99%450.00%
Dmitry Torokhov451.92%112.50%
Amitoj Kaur Chawla140.60%112.50%
Klaus Goger20.09%112.50%
Total2348100.00%8100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.