|  | /* | 
|  | * Description:  keypad driver for ADP5589 | 
|  | *		 I2C QWERTY Keypad and IO Expander | 
|  | * Bugs: Enter bugs at http://blackfin.uclinux.org/ | 
|  | * | 
|  | * Copyright (C) 2010-2011 Analog Devices Inc. | 
|  | * Licensed under the GPL-2. | 
|  | */ | 
|  |  | 
|  | #include <linux/module.h> | 
|  | #include <linux/init.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/irq.h> | 
|  | #include <linux/workqueue.h> | 
|  | #include <linux/errno.h> | 
|  | #include <linux/pm.h> | 
|  | #include <linux/platform_device.h> | 
|  | #include <linux/input.h> | 
|  | #include <linux/i2c.h> | 
|  | #include <linux/gpio.h> | 
|  | #include <linux/slab.h> | 
|  |  | 
|  | #include <linux/input/adp5589.h> | 
|  |  | 
|  | /* GENERAL_CFG Register */ | 
|  | #define OSC_EN		(1 << 7) | 
|  | #define CORE_CLK(x)	(((x) & 0x3) << 5) | 
|  | #define LCK_TRK_LOGIC	(1 << 4) | 
|  | #define LCK_TRK_GPI	(1 << 3) | 
|  | #define INT_CFG		(1 << 1) | 
|  | #define RST_CFG		(1 << 0) | 
|  |  | 
|  | /* INT_EN Register */ | 
|  | #define LOGIC2_IEN	(1 << 5) | 
|  | #define LOGIC1_IEN	(1 << 4) | 
|  | #define LOCK_IEN	(1 << 3) | 
|  | #define OVRFLOW_IEN	(1 << 2) | 
|  | #define GPI_IEN		(1 << 1) | 
|  | #define EVENT_IEN	(1 << 0) | 
|  |  | 
|  | /* Interrupt Status Register */ | 
|  | #define LOGIC2_INT	(1 << 5) | 
|  | #define LOGIC1_INT	(1 << 4) | 
|  | #define LOCK_INT	(1 << 3) | 
|  | #define OVRFLOW_INT	(1 << 2) | 
|  | #define GPI_INT		(1 << 1) | 
|  | #define EVENT_INT	(1 << 0) | 
|  |  | 
|  | /* STATUS Register */ | 
|  |  | 
|  | #define LOGIC2_STAT	(1 << 7) | 
|  | #define LOGIC1_STAT	(1 << 6) | 
|  | #define LOCK_STAT	(1 << 5) | 
|  | #define KEC		0xF | 
|  |  | 
|  | /* PIN_CONFIG_D Register */ | 
|  | #define C4_EXTEND_CFG	(1 << 6)	/* RESET2 */ | 
|  | #define R4_EXTEND_CFG	(1 << 5)	/* RESET1 */ | 
|  |  | 
|  | /* LOCK_CFG */ | 
|  | #define LOCK_EN		(1 << 0) | 
|  |  | 
|  | #define PTIME_MASK	0x3 | 
|  | #define LTIME_MASK	0x3 | 
|  |  | 
|  | /* Key Event Register xy */ | 
|  | #define KEY_EV_PRESSED		(1 << 7) | 
|  | #define KEY_EV_MASK		(0x7F) | 
|  |  | 
|  | #define KEYP_MAX_EVENT		16 | 
|  |  | 
|  | #define MAXGPIO			19 | 
|  | #define ADP_BANK(offs)		((offs) >> 3) | 
|  | #define ADP_BIT(offs)		(1u << ((offs) & 0x7)) | 
|  |  | 
|  | struct adp5589_kpad { | 
|  | struct i2c_client *client; | 
|  | struct input_dev *input; | 
|  | unsigned short keycode[ADP5589_KEYMAPSIZE]; | 
|  | const struct adp5589_gpi_map *gpimap; | 
|  | unsigned short gpimapsize; | 
|  | unsigned extend_cfg; | 
|  | #ifdef CONFIG_GPIOLIB | 
|  | unsigned char gpiomap[MAXGPIO]; | 
|  | bool export_gpio; | 
|  | struct gpio_chip gc; | 
|  | struct mutex gpio_lock;	/* Protect cached dir, dat_out */ | 
|  | u8 dat_out[3]; | 
|  | u8 dir[3]; | 
|  | #endif | 
|  | }; | 
|  |  | 
|  | static int adp5589_read(struct i2c_client *client, u8 reg) | 
|  | { | 
|  | int ret = i2c_smbus_read_byte_data(client, reg); | 
|  |  | 
|  | if (ret < 0) | 
|  | dev_err(&client->dev, "Read Error\n"); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int adp5589_write(struct i2c_client *client, u8 reg, u8 val) | 
|  | { | 
|  | return i2c_smbus_write_byte_data(client, reg, val); | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_GPIOLIB | 
|  | static int adp5589_gpio_get_value(struct gpio_chip *chip, unsigned off) | 
|  | { | 
|  | struct adp5589_kpad *kpad = container_of(chip, struct adp5589_kpad, gc); | 
|  | unsigned int bank = ADP_BANK(kpad->gpiomap[off]); | 
|  | unsigned int bit = ADP_BIT(kpad->gpiomap[off]); | 
|  |  | 
|  | return !!(adp5589_read(kpad->client, ADP5589_GPI_STATUS_A + bank) & | 
|  | bit); | 
|  | } | 
|  |  | 
|  | static void adp5589_gpio_set_value(struct gpio_chip *chip, | 
|  | unsigned off, int val) | 
|  | { | 
|  | struct adp5589_kpad *kpad = container_of(chip, struct adp5589_kpad, gc); | 
|  | unsigned int bank = ADP_BANK(kpad->gpiomap[off]); | 
|  | unsigned int bit = ADP_BIT(kpad->gpiomap[off]); | 
|  |  | 
|  | mutex_lock(&kpad->gpio_lock); | 
|  |  | 
|  | if (val) | 
|  | kpad->dat_out[bank] |= bit; | 
|  | else | 
|  | kpad->dat_out[bank] &= ~bit; | 
|  |  | 
|  | adp5589_write(kpad->client, ADP5589_GPO_DATA_OUT_A + bank, | 
|  | kpad->dat_out[bank]); | 
|  |  | 
|  | mutex_unlock(&kpad->gpio_lock); | 
|  | } | 
|  |  | 
|  | static int adp5589_gpio_direction_input(struct gpio_chip *chip, unsigned off) | 
|  | { | 
|  | struct adp5589_kpad *kpad = container_of(chip, struct adp5589_kpad, gc); | 
|  | unsigned int bank = ADP_BANK(kpad->gpiomap[off]); | 
|  | unsigned int bit = ADP_BIT(kpad->gpiomap[off]); | 
|  | int ret; | 
|  |  | 
|  | mutex_lock(&kpad->gpio_lock); | 
|  |  | 
|  | kpad->dir[bank] &= ~bit; | 
|  | ret = adp5589_write(kpad->client, ADP5589_GPIO_DIRECTION_A + bank, | 
|  | kpad->dir[bank]); | 
|  |  | 
|  | mutex_unlock(&kpad->gpio_lock); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int adp5589_gpio_direction_output(struct gpio_chip *chip, | 
|  | unsigned off, int val) | 
|  | { | 
|  | struct adp5589_kpad *kpad = container_of(chip, struct adp5589_kpad, gc); | 
|  | unsigned int bank = ADP_BANK(kpad->gpiomap[off]); | 
|  | unsigned int bit = ADP_BIT(kpad->gpiomap[off]); | 
|  | int ret; | 
|  |  | 
|  | mutex_lock(&kpad->gpio_lock); | 
|  |  | 
|  | kpad->dir[bank] |= bit; | 
|  |  | 
|  | if (val) | 
|  | kpad->dat_out[bank] |= bit; | 
|  | else | 
|  | kpad->dat_out[bank] &= ~bit; | 
|  |  | 
|  | ret = adp5589_write(kpad->client, ADP5589_GPO_DATA_OUT_A + bank, | 
|  | kpad->dat_out[bank]); | 
|  | ret |= adp5589_write(kpad->client, ADP5589_GPIO_DIRECTION_A + bank, | 
|  | kpad->dir[bank]); | 
|  |  | 
|  | mutex_unlock(&kpad->gpio_lock); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int __devinit adp5589_build_gpiomap(struct adp5589_kpad *kpad, | 
|  | const struct adp5589_kpad_platform_data *pdata) | 
|  | { | 
|  | bool pin_used[MAXGPIO]; | 
|  | int n_unused = 0; | 
|  | int i; | 
|  |  | 
|  | memset(pin_used, false, sizeof(pin_used)); | 
|  |  | 
|  | for (i = 0; i < MAXGPIO; i++) | 
|  | if (pdata->keypad_en_mask & (1 << i)) | 
|  | pin_used[i] = true; | 
|  |  | 
|  | for (i = 0; i < kpad->gpimapsize; i++) | 
|  | pin_used[kpad->gpimap[i].pin - ADP5589_GPI_PIN_BASE] = true; | 
|  |  | 
|  | if (kpad->extend_cfg & R4_EXTEND_CFG) | 
|  | pin_used[4] = true; | 
|  |  | 
|  | if (kpad->extend_cfg & C4_EXTEND_CFG) | 
|  | pin_used[12] = true; | 
|  |  | 
|  | for (i = 0; i < MAXGPIO; i++) | 
|  | if (!pin_used[i]) | 
|  | kpad->gpiomap[n_unused++] = i; | 
|  |  | 
|  | return n_unused; | 
|  | } | 
|  |  | 
|  | static int __devinit adp5589_gpio_add(struct adp5589_kpad *kpad) | 
|  | { | 
|  | struct device *dev = &kpad->client->dev; | 
|  | const struct adp5589_kpad_platform_data *pdata = dev->platform_data; | 
|  | const struct adp5589_gpio_platform_data *gpio_data = pdata->gpio_data; | 
|  | int i, error; | 
|  |  | 
|  | if (!gpio_data) | 
|  | return 0; | 
|  |  | 
|  | kpad->gc.ngpio = adp5589_build_gpiomap(kpad, pdata); | 
|  | if (kpad->gc.ngpio == 0) { | 
|  | dev_info(dev, "No unused gpios left to export\n"); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | kpad->export_gpio = true; | 
|  |  | 
|  | kpad->gc.direction_input = adp5589_gpio_direction_input; | 
|  | kpad->gc.direction_output = adp5589_gpio_direction_output; | 
|  | kpad->gc.get = adp5589_gpio_get_value; | 
|  | kpad->gc.set = adp5589_gpio_set_value; | 
|  | kpad->gc.can_sleep = 1; | 
|  |  | 
|  | kpad->gc.base = gpio_data->gpio_start; | 
|  | kpad->gc.label = kpad->client->name; | 
|  | kpad->gc.owner = THIS_MODULE; | 
|  |  | 
|  | mutex_init(&kpad->gpio_lock); | 
|  |  | 
|  | error = gpiochip_add(&kpad->gc); | 
|  | if (error) { | 
|  | dev_err(dev, "gpiochip_add failed, err: %d\n", error); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | for (i = 0; i <= ADP_BANK(MAXGPIO); i++) { | 
|  | kpad->dat_out[i] = adp5589_read(kpad->client, | 
|  | ADP5589_GPO_DATA_OUT_A + i); | 
|  | kpad->dir[i] = adp5589_read(kpad->client, | 
|  | ADP5589_GPIO_DIRECTION_A + i); | 
|  | } | 
|  |  | 
|  | if (gpio_data->setup) { | 
|  | error = gpio_data->setup(kpad->client, | 
|  | kpad->gc.base, kpad->gc.ngpio, | 
|  | gpio_data->context); | 
|  | if (error) | 
|  | dev_warn(dev, "setup failed, %d\n", error); | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void __devexit adp5589_gpio_remove(struct adp5589_kpad *kpad) | 
|  | { | 
|  | struct device *dev = &kpad->client->dev; | 
|  | const struct adp5589_kpad_platform_data *pdata = dev->platform_data; | 
|  | const struct adp5589_gpio_platform_data *gpio_data = pdata->gpio_data; | 
|  | int error; | 
|  |  | 
|  | if (!kpad->export_gpio) | 
|  | return; | 
|  |  | 
|  | if (gpio_data->teardown) { | 
|  | error = gpio_data->teardown(kpad->client, | 
|  | kpad->gc.base, kpad->gc.ngpio, | 
|  | gpio_data->context); | 
|  | if (error) | 
|  | dev_warn(dev, "teardown failed %d\n", error); | 
|  | } | 
|  |  | 
|  | error = gpiochip_remove(&kpad->gc); | 
|  | if (error) | 
|  | dev_warn(dev, "gpiochip_remove failed %d\n", error); | 
|  | } | 
|  | #else | 
|  | static inline int adp5589_gpio_add(struct adp5589_kpad *kpad) | 
|  | { | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static inline void adp5589_gpio_remove(struct adp5589_kpad *kpad) | 
|  | { | 
|  | } | 
|  | #endif | 
|  |  | 
|  | static void adp5589_report_switches(struct adp5589_kpad *kpad, | 
|  | int key, int key_val) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < kpad->gpimapsize; i++) { | 
|  | if (key_val == kpad->gpimap[i].pin) { | 
|  | input_report_switch(kpad->input, | 
|  | kpad->gpimap[i].sw_evt, | 
|  | key & KEY_EV_PRESSED); | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static void adp5589_report_events(struct adp5589_kpad *kpad, int ev_cnt) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < ev_cnt; i++) { | 
|  | int key = adp5589_read(kpad->client, ADP5589_FIFO_1 + i); | 
|  | int key_val = key & KEY_EV_MASK; | 
|  |  | 
|  | if (key_val >= ADP5589_GPI_PIN_BASE && | 
|  | key_val <= ADP5589_GPI_PIN_END) { | 
|  | adp5589_report_switches(kpad, key, key_val); | 
|  | } else { | 
|  | input_report_key(kpad->input, | 
|  | kpad->keycode[key_val - 1], | 
|  | key & KEY_EV_PRESSED); | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static irqreturn_t adp5589_irq(int irq, void *handle) | 
|  | { | 
|  | struct adp5589_kpad *kpad = handle; | 
|  | struct i2c_client *client = kpad->client; | 
|  | int status, ev_cnt; | 
|  |  | 
|  | status = adp5589_read(client, ADP5589_INT_STATUS); | 
|  |  | 
|  | if (status & OVRFLOW_INT)	/* Unlikely and should never happen */ | 
|  | dev_err(&client->dev, "Event Overflow Error\n"); | 
|  |  | 
|  | if (status & EVENT_INT) { | 
|  | ev_cnt = adp5589_read(client, ADP5589_STATUS) & KEC; | 
|  | if (ev_cnt) { | 
|  | adp5589_report_events(kpad, ev_cnt); | 
|  | input_sync(kpad->input); | 
|  | } | 
|  | } | 
|  |  | 
|  | adp5589_write(client, ADP5589_INT_STATUS, status);	/* Status is W1C */ | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static int __devinit adp5589_get_evcode(struct adp5589_kpad *kpad, unsigned short key) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < ADP5589_KEYMAPSIZE; i++) | 
|  | if (key == kpad->keycode[i]) | 
|  | return (i + 1) | KEY_EV_PRESSED; | 
|  |  | 
|  | dev_err(&kpad->client->dev, "RESET/UNLOCK key not in keycode map\n"); | 
|  |  | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | static int __devinit adp5589_setup(struct adp5589_kpad *kpad) | 
|  | { | 
|  | struct i2c_client *client = kpad->client; | 
|  | const struct adp5589_kpad_platform_data *pdata = | 
|  | client->dev.platform_data; | 
|  | int i, ret; | 
|  | unsigned char evt_mode1 = 0, evt_mode2 = 0, evt_mode3 = 0; | 
|  | unsigned char pull_mask = 0; | 
|  |  | 
|  | ret = adp5589_write(client, ADP5589_PIN_CONFIG_A, | 
|  | pdata->keypad_en_mask & 0xFF); | 
|  | ret |= adp5589_write(client, ADP5589_PIN_CONFIG_B, | 
|  | (pdata->keypad_en_mask >> 8) & 0xFF); | 
|  | ret |= adp5589_write(client, ADP5589_PIN_CONFIG_C, | 
|  | (pdata->keypad_en_mask >> 16) & 0xFF); | 
|  |  | 
|  | if (pdata->en_keylock) { | 
|  | ret |= adp5589_write(client, ADP5589_UNLOCK1, | 
|  | pdata->unlock_key1); | 
|  | ret |= adp5589_write(client, ADP5589_UNLOCK2, | 
|  | pdata->unlock_key2); | 
|  | ret |= adp5589_write(client, ADP5589_UNLOCK_TIMERS, | 
|  | pdata->unlock_timer & LTIME_MASK); | 
|  | ret |= adp5589_write(client, ADP5589_LOCK_CFG, LOCK_EN); | 
|  | } | 
|  |  | 
|  | for (i = 0; i < KEYP_MAX_EVENT; i++) | 
|  | ret |= adp5589_read(client, ADP5589_FIFO_1 + i); | 
|  |  | 
|  | for (i = 0; i < pdata->gpimapsize; i++) { | 
|  | unsigned short pin = pdata->gpimap[i].pin; | 
|  |  | 
|  | if (pin <= ADP5589_GPI_PIN_ROW_END) { | 
|  | evt_mode1 |= (1 << (pin - ADP5589_GPI_PIN_ROW_BASE)); | 
|  | } else { | 
|  | evt_mode2 |= | 
|  | ((1 << (pin - ADP5589_GPI_PIN_COL_BASE)) & 0xFF); | 
|  | evt_mode3 |= | 
|  | ((1 << (pin - ADP5589_GPI_PIN_COL_BASE)) >> 8); | 
|  | } | 
|  | } | 
|  |  | 
|  | if (pdata->gpimapsize) { | 
|  | ret |= adp5589_write(client, ADP5589_GPI_EVENT_EN_A, evt_mode1); | 
|  | ret |= adp5589_write(client, ADP5589_GPI_EVENT_EN_B, evt_mode2); | 
|  | ret |= adp5589_write(client, ADP5589_GPI_EVENT_EN_C, evt_mode3); | 
|  | } | 
|  |  | 
|  | if (pdata->pull_dis_mask & pdata->pullup_en_100k & | 
|  | pdata->pullup_en_300k & pdata->pulldown_en_300k) | 
|  | dev_warn(&client->dev, "Conflicting pull resistor config\n"); | 
|  |  | 
|  | for (i = 0; i < MAXGPIO; i++) { | 
|  | unsigned val = 0; | 
|  |  | 
|  | if (pdata->pullup_en_300k & (1 << i)) | 
|  | val = 0; | 
|  | else if (pdata->pulldown_en_300k & (1 << i)) | 
|  | val = 1; | 
|  | else if (pdata->pullup_en_100k & (1 << i)) | 
|  | val = 2; | 
|  | else if (pdata->pull_dis_mask & (1 << i)) | 
|  | val = 3; | 
|  |  | 
|  | pull_mask |= val << (2 * (i & 0x3)); | 
|  |  | 
|  | if ((i & 0x3) == 0x3 || i == MAXGPIO - 1) { | 
|  | ret |= adp5589_write(client, | 
|  | ADP5589_RPULL_CONFIG_A + (i >> 2), | 
|  | pull_mask); | 
|  | pull_mask = 0; | 
|  | } | 
|  | } | 
|  |  | 
|  | if (pdata->reset1_key_1 && pdata->reset1_key_2 && pdata->reset1_key_3) { | 
|  | ret |= adp5589_write(client, ADP5589_RESET1_EVENT_A, | 
|  | adp5589_get_evcode(kpad, | 
|  | pdata->reset1_key_1)); | 
|  | ret |= adp5589_write(client, ADP5589_RESET1_EVENT_B, | 
|  | adp5589_get_evcode(kpad, | 
|  | pdata->reset1_key_2)); | 
|  | ret |= adp5589_write(client, ADP5589_RESET1_EVENT_C, | 
|  | adp5589_get_evcode(kpad, | 
|  | pdata->reset1_key_3)); | 
|  | kpad->extend_cfg |= R4_EXTEND_CFG; | 
|  | } | 
|  |  | 
|  | if (pdata->reset2_key_1 && pdata->reset2_key_2) { | 
|  | ret |= adp5589_write(client, ADP5589_RESET2_EVENT_A, | 
|  | adp5589_get_evcode(kpad, | 
|  | pdata->reset2_key_1)); | 
|  | ret |= adp5589_write(client, ADP5589_RESET2_EVENT_B, | 
|  | adp5589_get_evcode(kpad, | 
|  | pdata->reset2_key_2)); | 
|  | kpad->extend_cfg |= C4_EXTEND_CFG; | 
|  | } | 
|  |  | 
|  | if (kpad->extend_cfg) { | 
|  | ret |= adp5589_write(client, ADP5589_RESET_CFG, | 
|  | pdata->reset_cfg); | 
|  | ret |= adp5589_write(client, ADP5589_PIN_CONFIG_D, | 
|  | kpad->extend_cfg); | 
|  | } | 
|  |  | 
|  | for (i = 0; i <= ADP_BANK(MAXGPIO); i++) | 
|  | ret |= adp5589_write(client, ADP5589_DEBOUNCE_DIS_A + i, | 
|  | pdata->debounce_dis_mask >> (i * 8)); | 
|  |  | 
|  | ret |= adp5589_write(client, ADP5589_POLL_PTIME_CFG, | 
|  | pdata->scan_cycle_time & PTIME_MASK); | 
|  | ret |= adp5589_write(client, ADP5589_INT_STATUS, LOGIC2_INT | | 
|  | LOGIC1_INT | OVRFLOW_INT | LOCK_INT | | 
|  | GPI_INT | EVENT_INT);	/* Status is W1C */ | 
|  |  | 
|  | ret |= adp5589_write(client, ADP5589_GENERAL_CFG, | 
|  | INT_CFG | OSC_EN | CORE_CLK(3)); | 
|  | ret |= adp5589_write(client, ADP5589_INT_EN, | 
|  | OVRFLOW_IEN | GPI_IEN | EVENT_IEN); | 
|  |  | 
|  | if (ret < 0) { | 
|  | dev_err(&client->dev, "Write Error\n"); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void __devinit adp5589_report_switch_state(struct adp5589_kpad *kpad) | 
|  | { | 
|  | int gpi_stat1 = adp5589_read(kpad->client, ADP5589_GPI_STATUS_A); | 
|  | int gpi_stat2 = adp5589_read(kpad->client, ADP5589_GPI_STATUS_B); | 
|  | int gpi_stat3 = adp5589_read(kpad->client, ADP5589_GPI_STATUS_C); | 
|  | int gpi_stat_tmp, pin_loc; | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < kpad->gpimapsize; i++) { | 
|  | unsigned short pin = kpad->gpimap[i].pin; | 
|  |  | 
|  | if (pin <= ADP5589_GPI_PIN_ROW_END) { | 
|  | gpi_stat_tmp = gpi_stat1; | 
|  | pin_loc = pin - ADP5589_GPI_PIN_ROW_BASE; | 
|  | } else if ((pin - ADP5589_GPI_PIN_COL_BASE) < 8) { | 
|  | gpi_stat_tmp = gpi_stat2; | 
|  | pin_loc = pin - ADP5589_GPI_PIN_COL_BASE; | 
|  | } else { | 
|  | gpi_stat_tmp = gpi_stat3; | 
|  | pin_loc = pin - ADP5589_GPI_PIN_COL_BASE - 8; | 
|  | } | 
|  |  | 
|  | if (gpi_stat_tmp < 0) { | 
|  | dev_err(&kpad->client->dev, | 
|  | "Can't read GPIO_DAT_STAT switch" | 
|  | " %d default to OFF\n", pin); | 
|  | gpi_stat_tmp = 0; | 
|  | } | 
|  |  | 
|  | input_report_switch(kpad->input, | 
|  | kpad->gpimap[i].sw_evt, | 
|  | !(gpi_stat_tmp & (1 << pin_loc))); | 
|  | } | 
|  |  | 
|  | input_sync(kpad->input); | 
|  | } | 
|  |  | 
|  | static int __devinit adp5589_probe(struct i2c_client *client, | 
|  | const struct i2c_device_id *id) | 
|  | { | 
|  | struct adp5589_kpad *kpad; | 
|  | const struct adp5589_kpad_platform_data *pdata; | 
|  | struct input_dev *input; | 
|  | unsigned int revid; | 
|  | int ret, i; | 
|  | int error; | 
|  |  | 
|  | if (!i2c_check_functionality(client->adapter, | 
|  | I2C_FUNC_SMBUS_BYTE_DATA)) { | 
|  | dev_err(&client->dev, "SMBUS Byte Data not Supported\n"); | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | pdata = client->dev.platform_data; | 
|  | if (!pdata) { | 
|  | dev_err(&client->dev, "no platform data?\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | if (!((pdata->keypad_en_mask & 0xFF) && | 
|  | (pdata->keypad_en_mask >> 8)) || !pdata->keymap) { | 
|  | dev_err(&client->dev, "no rows, cols or keymap from pdata\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | if (pdata->keymapsize != ADP5589_KEYMAPSIZE) { | 
|  | dev_err(&client->dev, "invalid keymapsize\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | if (!pdata->gpimap && pdata->gpimapsize) { | 
|  | dev_err(&client->dev, "invalid gpimap from pdata\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | if (pdata->gpimapsize > ADP5589_GPIMAPSIZE_MAX) { | 
|  | dev_err(&client->dev, "invalid gpimapsize\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | for (i = 0; i < pdata->gpimapsize; i++) { | 
|  | unsigned short pin = pdata->gpimap[i].pin; | 
|  |  | 
|  | if (pin < ADP5589_GPI_PIN_BASE || pin > ADP5589_GPI_PIN_END) { | 
|  | dev_err(&client->dev, "invalid gpi pin data\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | if ((1 << (pin - ADP5589_GPI_PIN_ROW_BASE)) & | 
|  | pdata->keypad_en_mask) { | 
|  | dev_err(&client->dev, "invalid gpi row/col data\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | } | 
|  |  | 
|  | if (!client->irq) { | 
|  | dev_err(&client->dev, "no IRQ?\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | kpad = kzalloc(sizeof(*kpad), GFP_KERNEL); | 
|  | input = input_allocate_device(); | 
|  | if (!kpad || !input) { | 
|  | error = -ENOMEM; | 
|  | goto err_free_mem; | 
|  | } | 
|  |  | 
|  | kpad->client = client; | 
|  | kpad->input = input; | 
|  |  | 
|  | ret = adp5589_read(client, ADP5589_ID); | 
|  | if (ret < 0) { | 
|  | error = ret; | 
|  | goto err_free_mem; | 
|  | } | 
|  |  | 
|  | revid = (u8) ret & ADP5589_DEVICE_ID_MASK; | 
|  |  | 
|  | input->name = client->name; | 
|  | input->phys = "adp5589-keys/input0"; | 
|  | input->dev.parent = &client->dev; | 
|  |  | 
|  | input_set_drvdata(input, kpad); | 
|  |  | 
|  | input->id.bustype = BUS_I2C; | 
|  | input->id.vendor = 0x0001; | 
|  | input->id.product = 0x0001; | 
|  | input->id.version = revid; | 
|  |  | 
|  | input->keycodesize = sizeof(kpad->keycode[0]); | 
|  | input->keycodemax = pdata->keymapsize; | 
|  | input->keycode = kpad->keycode; | 
|  |  | 
|  | memcpy(kpad->keycode, pdata->keymap, | 
|  | pdata->keymapsize * input->keycodesize); | 
|  |  | 
|  | kpad->gpimap = pdata->gpimap; | 
|  | kpad->gpimapsize = pdata->gpimapsize; | 
|  |  | 
|  | /* setup input device */ | 
|  | __set_bit(EV_KEY, input->evbit); | 
|  |  | 
|  | if (pdata->repeat) | 
|  | __set_bit(EV_REP, input->evbit); | 
|  |  | 
|  | for (i = 0; i < input->keycodemax; i++) | 
|  | __set_bit(kpad->keycode[i] & KEY_MAX, input->keybit); | 
|  | __clear_bit(KEY_RESERVED, input->keybit); | 
|  |  | 
|  | if (kpad->gpimapsize) | 
|  | __set_bit(EV_SW, input->evbit); | 
|  | for (i = 0; i < kpad->gpimapsize; i++) | 
|  | __set_bit(kpad->gpimap[i].sw_evt, input->swbit); | 
|  |  | 
|  | error = input_register_device(input); | 
|  | if (error) { | 
|  | dev_err(&client->dev, "unable to register input device\n"); | 
|  | goto err_free_mem; | 
|  | } | 
|  |  | 
|  | error = request_threaded_irq(client->irq, NULL, adp5589_irq, | 
|  | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, | 
|  | client->dev.driver->name, kpad); | 
|  | if (error) { | 
|  | dev_err(&client->dev, "irq %d busy?\n", client->irq); | 
|  | goto err_unreg_dev; | 
|  | } | 
|  |  | 
|  | error = adp5589_setup(kpad); | 
|  | if (error) | 
|  | goto err_free_irq; | 
|  |  | 
|  | if (kpad->gpimapsize) | 
|  | adp5589_report_switch_state(kpad); | 
|  |  | 
|  | error = adp5589_gpio_add(kpad); | 
|  | if (error) | 
|  | goto err_free_irq; | 
|  |  | 
|  | device_init_wakeup(&client->dev, 1); | 
|  | i2c_set_clientdata(client, kpad); | 
|  |  | 
|  | dev_info(&client->dev, "Rev.%d keypad, irq %d\n", revid, client->irq); | 
|  | return 0; | 
|  |  | 
|  | err_free_irq: | 
|  | free_irq(client->irq, kpad); | 
|  | err_unreg_dev: | 
|  | input_unregister_device(input); | 
|  | input = NULL; | 
|  | err_free_mem: | 
|  | input_free_device(input); | 
|  | kfree(kpad); | 
|  |  | 
|  | return error; | 
|  | } | 
|  |  | 
|  | static int __devexit adp5589_remove(struct i2c_client *client) | 
|  | { | 
|  | struct adp5589_kpad *kpad = i2c_get_clientdata(client); | 
|  |  | 
|  | adp5589_write(client, ADP5589_GENERAL_CFG, 0); | 
|  | free_irq(client->irq, kpad); | 
|  | input_unregister_device(kpad->input); | 
|  | adp5589_gpio_remove(kpad); | 
|  | kfree(kpad); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_PM_SLEEP | 
|  | static int adp5589_suspend(struct device *dev) | 
|  | { | 
|  | struct adp5589_kpad *kpad = dev_get_drvdata(dev); | 
|  | struct i2c_client *client = kpad->client; | 
|  |  | 
|  | disable_irq(client->irq); | 
|  |  | 
|  | if (device_may_wakeup(&client->dev)) | 
|  | enable_irq_wake(client->irq); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int adp5589_resume(struct device *dev) | 
|  | { | 
|  | struct adp5589_kpad *kpad = dev_get_drvdata(dev); | 
|  | struct i2c_client *client = kpad->client; | 
|  |  | 
|  | if (device_may_wakeup(&client->dev)) | 
|  | disable_irq_wake(client->irq); | 
|  |  | 
|  | enable_irq(client->irq); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | static SIMPLE_DEV_PM_OPS(adp5589_dev_pm_ops, adp5589_suspend, adp5589_resume); | 
|  |  | 
|  | static const struct i2c_device_id adp5589_id[] = { | 
|  | {"adp5589-keys", 0}, | 
|  | {} | 
|  | }; | 
|  |  | 
|  | MODULE_DEVICE_TABLE(i2c, adp5589_id); | 
|  |  | 
|  | static struct i2c_driver adp5589_driver = { | 
|  | .driver = { | 
|  | .name = KBUILD_MODNAME, | 
|  | .owner = THIS_MODULE, | 
|  | .pm = &adp5589_dev_pm_ops, | 
|  | }, | 
|  | .probe = adp5589_probe, | 
|  | .remove = __devexit_p(adp5589_remove), | 
|  | .id_table = adp5589_id, | 
|  | }; | 
|  |  | 
|  | static int __init adp5589_init(void) | 
|  | { | 
|  | return i2c_add_driver(&adp5589_driver); | 
|  | } | 
|  | module_init(adp5589_init); | 
|  |  | 
|  | static void __exit adp5589_exit(void) | 
|  | { | 
|  | i2c_del_driver(&adp5589_driver); | 
|  | } | 
|  | module_exit(adp5589_exit); | 
|  |  | 
|  | MODULE_LICENSE("GPL"); | 
|  | MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); | 
|  | MODULE_DESCRIPTION("ADP5589 Keypad driver"); |