1
2
3
4
5
6
7
8#include <twl4030.h>
9
10int twl4030_input_power_button(void)
11{
12 u8 data;
13
14 twl4030_i2c_read_u8(TWL4030_CHIP_PM_MASTER,
15 TWL4030_PM_MASTER_STS_HW_CONDITIONS, &data);
16
17 if (data & TWL4030_PM_MASTER_STS_HW_CONDITIONS_PWON)
18 return 1;
19
20 return 0;
21}
22
23int twl4030_input_charger(void)
24{
25 u8 data;
26
27 twl4030_i2c_read_u8(TWL4030_CHIP_PM_MASTER,
28 TWL4030_PM_MASTER_STS_HW_CONDITIONS, &data);
29
30 if (data & TWL4030_PM_MASTER_STS_HW_CONDITIONS_CHG)
31 return 1;
32
33 return 0;
34}
35
36int twl4030_input_usb(void)
37{
38 u8 data;
39
40 twl4030_i2c_read_u8(TWL4030_CHIP_PM_MASTER,
41 TWL4030_PM_MASTER_STS_HW_CONDITIONS, &data);
42
43 if (data & TWL4030_PM_MASTER_STS_HW_CONDITIONS_USB ||
44 data & TWL4030_PM_MASTER_STS_HW_CONDITIONS_VBUS)
45 return 1;
46
47 return 0;
48}
49
50int twl4030_keypad_scan(unsigned char *matrix)
51{
52 u8 data;
53 u8 c, r;
54
55 twl4030_i2c_read_u8(TWL4030_CHIP_KEYPAD,
56 TWL4030_KEYPAD_KEYP_CTRL_REG, &data);
57
58 data |= TWL4030_KEYPAD_CTRL_SOFT_NRST | TWL4030_KEYPAD_CTRL_KBD_ON;
59 data &= ~TWL4030_KEYPAD_CTRL_SOFTMODEN;
60
61 twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
62 TWL4030_KEYPAD_KEYP_CTRL_REG, data);
63
64 for (c = 0; c < 8; c++) {
65 data = 0xff & ~(1 << c);
66 twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
67 TWL4030_KEYPAD_KBC_REG, data);
68
69 data = 0xff;
70 twl4030_i2c_read_u8(TWL4030_CHIP_KEYPAD,
71 TWL4030_KEYPAD_KBR_REG, &data);
72
73 for (r = 0; r < 8; r++)
74 matrix[c * 8 + r] = !(data & (1 << r));
75 }
76
77 data = 0xff & ~(TWL4030_KEYPAD_CTRL_SOFT_NRST);
78 twl4030_i2c_write_u8(TWL4030_CHIP_KEYPAD,
79 TWL4030_KEYPAD_KEYP_CTRL_REG, data);
80
81 return 0;
82}
83
84int twl4030_keypad_key(unsigned char *matrix, u8 c, u8 r)
85{
86 return matrix[c * 8 + r];
87}
88