Input: matrix-keypad - add function to build device keymap
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
This commit is contained in:
parent
8fbac18e8e
commit
77a53fd218
@ -319,7 +319,6 @@ static int __devinit matrix_keypad_probe(struct platform_device *pdev)
|
|||||||
struct input_dev *input_dev;
|
struct input_dev *input_dev;
|
||||||
unsigned short *keycodes;
|
unsigned short *keycodes;
|
||||||
unsigned int row_shift;
|
unsigned int row_shift;
|
||||||
int i;
|
|
||||||
int err;
|
int err;
|
||||||
|
|
||||||
pdata = pdev->dev.platform_data;
|
pdata = pdev->dev.platform_data;
|
||||||
@ -363,18 +362,10 @@ static int __devinit matrix_keypad_probe(struct platform_device *pdev)
|
|||||||
|
|
||||||
input_dev->keycode = keycodes;
|
input_dev->keycode = keycodes;
|
||||||
input_dev->keycodesize = sizeof(*keycodes);
|
input_dev->keycodesize = sizeof(*keycodes);
|
||||||
input_dev->keycodemax = pdata->num_row_gpios << keypad->row_shift;
|
input_dev->keycodemax = pdata->num_row_gpios << row_shift;
|
||||||
|
|
||||||
for (i = 0; i < keymap_data->keymap_size; i++) {
|
matrix_keypad_build_keymap(keymap_data, row_shift,
|
||||||
unsigned int key = keymap_data->keymap[i];
|
input_dev->keycode, input_dev->keybit);
|
||||||
unsigned int row = KEY_ROW(key);
|
|
||||||
unsigned int col = KEY_COL(key);
|
|
||||||
unsigned short code = KEY_VAL(key);
|
|
||||||
|
|
||||||
keycodes[MATRIX_SCAN_CODE(row, col, row_shift)] = code;
|
|
||||||
__set_bit(code, input_dev->keybit);
|
|
||||||
}
|
|
||||||
__clear_bit(KEY_RESERVED, input_dev->keybit);
|
|
||||||
|
|
||||||
input_set_capability(input_dev, EV_MSC, MSC_SCAN);
|
input_set_capability(input_dev, EV_MSC, MSC_SCAN);
|
||||||
input_set_drvdata(input_dev, keypad);
|
input_set_drvdata(input_dev, keypad);
|
||||||
|
@ -126,7 +126,6 @@ static int __devinit w90p910_keypad_probe(struct platform_device *pdev)
|
|||||||
struct resource *res;
|
struct resource *res;
|
||||||
int irq;
|
int irq;
|
||||||
int error;
|
int error;
|
||||||
int i;
|
|
||||||
|
|
||||||
if (!pdata) {
|
if (!pdata) {
|
||||||
dev_err(&pdev->dev, "no platform data defined\n");
|
dev_err(&pdev->dev, "no platform data defined\n");
|
||||||
@ -197,19 +196,8 @@ static int __devinit w90p910_keypad_probe(struct platform_device *pdev)
|
|||||||
input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
|
input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP);
|
||||||
input_set_capability(input_dev, EV_MSC, MSC_SCAN);
|
input_set_capability(input_dev, EV_MSC, MSC_SCAN);
|
||||||
|
|
||||||
for (i = 0; i < keymap_data->keymap_size; i++) {
|
matrix_keypad_build_keymap(keymap_data, W90P910_ROW_SHIFT,
|
||||||
unsigned int key = keymap_data->keymap[i];
|
input_dev->keycode, input_dev->keybit);
|
||||||
unsigned int row = KEY_ROW(key);
|
|
||||||
unsigned int col = KEY_COL(key);
|
|
||||||
unsigned short keycode = KEY_VAL(key);
|
|
||||||
unsigned int scancode = MATRIX_SCAN_CODE(row, col,
|
|
||||||
W90P910_ROW_SHIFT);
|
|
||||||
|
|
||||||
keypad->keymap[scancode] = keycode;
|
|
||||||
__set_bit(keycode, input_dev->keybit);
|
|
||||||
}
|
|
||||||
__clear_bit(KEY_RESERVED, input_dev->keybit);
|
|
||||||
|
|
||||||
|
|
||||||
error = request_irq(keypad->irq, w90p910_keypad_irq_handler,
|
error = request_irq(keypad->irq, w90p910_keypad_irq_handler,
|
||||||
IRQF_DISABLED, pdev->name, keypad);
|
IRQF_DISABLED, pdev->name, keypad);
|
||||||
|
@ -63,4 +63,36 @@ struct matrix_keypad_platform_data {
|
|||||||
bool wakeup;
|
bool wakeup;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* matrix_keypad_build_keymap - convert platform keymap into matrix keymap
|
||||||
|
* @keymap_data: keymap supplied by the platform code
|
||||||
|
* @row_shift: number of bits to shift row value by to advance to the next
|
||||||
|
* line in the keymap
|
||||||
|
* @keymap: expanded version of keymap that is suitable for use by
|
||||||
|
* matrix keyboad driver
|
||||||
|
* @keybit: pointer to bitmap of keys supported by input device
|
||||||
|
*
|
||||||
|
* This function converts platform keymap (encoded with KEY() macro) into
|
||||||
|
* an array of keycodes that is suitable for using in a standard matrix
|
||||||
|
* keyboard driver that uses row and col as indices.
|
||||||
|
*/
|
||||||
|
static inline void
|
||||||
|
matrix_keypad_build_keymap(const struct matrix_keymap_data *keymap_data,
|
||||||
|
unsigned int row_shift,
|
||||||
|
unsigned short *keymap, unsigned long *keybit)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
|
||||||
|
for (i = 0; i < keymap_data->keymap_size; i++) {
|
||||||
|
unsigned int key = keymap_data->keymap[i];
|
||||||
|
unsigned int row = KEY_ROW(key);
|
||||||
|
unsigned int col = KEY_COL(key);
|
||||||
|
unsigned short code = KEY_VAL(key);
|
||||||
|
|
||||||
|
keymap[MATRIX_SCAN_CODE(row, col, row_shift)] = code;
|
||||||
|
__set_bit(code, keybit);
|
||||||
|
}
|
||||||
|
__clear_bit(KEY_RESERVED, keybit);
|
||||||
|
}
|
||||||
|
|
||||||
#endif /* _MATRIX_KEYPAD_H */
|
#endif /* _MATRIX_KEYPAD_H */
|
||||||
|
Loading…
Reference in New Issue
Block a user