input: twl4030: Keypad scan and input

This allows scanning the twl4030 keypad, storing the result in a 64-byte long matrix with the twl4030_keypad_scan function. Detecting a key at a given column and row is made easier with the twl4030_keypad_key function. Signed-off-by: Paul Kocialkowski <contact@paulk.fr> Reviewed-by: Tom Rini <trini@konsulko.com>

input: twl4030: Keypad scan and input
This allows scanning the twl4030 keypad, storing the result in a 64-byte long matrix with the twl4030_keypad_scan function. Detecting a key at a given column and row is made easier with the twl4030_keypad_key function. Signed-off-by: Paul Kocialkowski <contact@paulk.fr> Reviewed-by: Tom Rini <trini@konsulko.com>
Paul Kocialkowski · Tom Rini
1 parent 7d5ac91832
Showing 2 changed files with 42 additions and 0 deletions Side-by-side Diff
drivers/input/twl4030.c
include/twl4030.h
@@ -47,4 +47,43 @@
  
 	return 0;
 }
+
+int twl4030_keypad_scan(unsigned char *matrix)
+{
+	u8 data;
+	u8 c, r;
+
+	twl4030_i2c_read_u8(TWL4030_CHIP_KEYPAD,
+			    TWL4030_KEYPAD_KEYP_CTRL_REG, &data);
+
+	data |= TWL4030_KEYPAD_CTRL_SOFT_NRST | TWL4030_KEYPAD_CTRL_KBD_ON;
+	data &= ~TWL4030_KEYPAD_CTRL_SOFTMODEN;
+
+	twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
+			     TWL4030_KEYPAD_KEYP_CTRL_REG, data);
+
+	for (c = 0; c < 8; c++) {
+		data = 0xff & ~(1 << c);
+		twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
+				     TWL4030_KEYPAD_KBC_REG, data);
+
+		data = 0xff;
+		twl4030_i2c_read_u8(TWL4030_CHIP_KEYPAD,
+				    TWL4030_KEYPAD_KBR_REG, &data);
+
+		for (r = 0; r < 8; r++)
+			matrix[c * 8 + r] = !(data & (1 << r));
+	}
+
+	data = 0xff & ~(TWL4030_KEYPAD_CTRL_SOFT_NRST);
+	twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
+			     TWL4030_KEYPAD_KEYP_CTRL_REG, data);
+
+	return 0;
+}
+
+int twl4030_keypad_key(unsigned char *matrix, u8 c, u8 r)
+{
+	return matrix[c * 8 + r];
+}
@@ -683,6 +683,9 @@
 int twl4030_input_charger(void);
 int twl4030_input_usb(void);
  
+int twl4030_keypad_scan(unsigned char *matrix);
+int twl4030_keypad_key(unsigned char *matrix, u8 c, u8 r);
+
 /*
  * LED
  */
...	...	@@ -47,4 +47,43 @@
47	47
48	48	return 0;
49	49	}
	50	+
	51	+int twl4030_keypad_scan(unsigned char *matrix)
	52	+{
	53	+ u8 data;
	54	+ u8 c, r;
	55	+
	56	+ twl4030_i2c_read_u8(TWL4030_CHIP_KEYPAD,
	57	+ TWL4030_KEYPAD_KEYP_CTRL_REG, &data);
	58	+
	59	+ data \|= TWL4030_KEYPAD_CTRL_SOFT_NRST \| TWL4030_KEYPAD_CTRL_KBD_ON;
	60	+ data &= ~TWL4030_KEYPAD_CTRL_SOFTMODEN;
	61	+
	62	+ twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
	63	+ TWL4030_KEYPAD_KEYP_CTRL_REG, data);
	64	+
	65	+ for (c = 0; c < 8; c++) {
	66	+ data = 0xff & ~(1 << c);
	67	+ twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
	68	+ TWL4030_KEYPAD_KBC_REG, data);
	69	+
	70	+ data = 0xff;
	71	+ twl4030_i2c_read_u8(TWL4030_CHIP_KEYPAD,
	72	+ TWL4030_KEYPAD_KBR_REG, &data);
	73	+
	74	+ for (r = 0; r < 8; r++)
	75	+ matrix[c * 8 + r] = !(data & (1 << r));
	76	+ }
	77	+
	78	+ data = 0xff & ~(TWL4030_KEYPAD_CTRL_SOFT_NRST);
	79	+ twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
	80	+ TWL4030_KEYPAD_KEYP_CTRL_REG, data);
	81	+
	82	+ return 0;
	83	+}
	84	+
	85	+int twl4030_keypad_key(unsigned char *matrix, u8 c, u8 r)
	86	+{
	87	+ return matrix[c * 8 + r];
	88	+}
...	...	@@ -683,6 +683,9 @@
683	683	int twl4030_input_charger(void);
684	684	int twl4030_input_usb(void);
685	685
	686	+int twl4030_keypad_scan(unsigned char *matrix);
	687	+int twl4030_keypad_key(unsigned char *matrix, u8 c, u8 r);
	688	+
686	689	/*
687	690	* LED
688	691	*/