forked from Minki/linux
fbae3fb154
I2C drivers can use the clientdata-pointer to point to private data. As I2C
devices are not really unregistered, but merely detached from their driver, it
used to be the drivers obligation to clear this pointer during remove() or a
failed probe(). As a couple of drivers forgot to do this, it was agreed that it
was cleaner if the i2c-core does this clearance when appropriate, as there is
no guarantee for the lifetime of the clientdata-pointer after remove() anyhow.
This feature was added to the core with commit
e4a7b9b04d
to fix the faulty drivers.
As there is no need anymore to clear the clientdata-pointer, remove all current
occurrences in the drivers to simplify the code and prevent confusion.
Signed-off-by: Wolfram Sang <w.sang@pengutronix.de>
Acked-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Richard Purdie <rpurdie@linux.intel.com>
Acked-by: Dmitry Torokhov <dtor@mail.ru>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
690 lines
17 KiB
C
690 lines
17 KiB
C
/*
|
|
* Synaptics touchpad with I2C interface
|
|
*
|
|
* Copyright (C) 2009 Compulab, Ltd.
|
|
* Mike Rapoport <mike@compulab.co.il>
|
|
* Igor Grinberg <grinberg@compulab.co.il>
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file COPYING in the main directory of this archive for
|
|
* more details.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/input.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/slab.h>
|
|
|
|
#define DRIVER_NAME "synaptics_i2c"
|
|
/* maximum product id is 15 characters */
|
|
#define PRODUCT_ID_LENGTH 15
|
|
#define REGISTER_LENGTH 8
|
|
|
|
/*
|
|
* after soft reset, we should wait for 1 ms
|
|
* before the device becomes operational
|
|
*/
|
|
#define SOFT_RESET_DELAY_MS 3
|
|
/* and after hard reset, we should wait for max 500ms */
|
|
#define HARD_RESET_DELAY_MS 500
|
|
|
|
/* Registers by SMBus address */
|
|
#define PAGE_SEL_REG 0xff
|
|
#define DEVICE_STATUS_REG 0x09
|
|
|
|
/* Registers by RMI address */
|
|
#define DEV_CONTROL_REG 0x0000
|
|
#define INTERRUPT_EN_REG 0x0001
|
|
#define ERR_STAT_REG 0x0002
|
|
#define INT_REQ_STAT_REG 0x0003
|
|
#define DEV_COMMAND_REG 0x0004
|
|
|
|
#define RMI_PROT_VER_REG 0x0200
|
|
#define MANUFACT_ID_REG 0x0201
|
|
#define PHYS_INT_VER_REG 0x0202
|
|
#define PROD_PROPERTY_REG 0x0203
|
|
#define INFO_QUERY_REG0 0x0204
|
|
#define INFO_QUERY_REG1 (INFO_QUERY_REG0 + 1)
|
|
#define INFO_QUERY_REG2 (INFO_QUERY_REG0 + 2)
|
|
#define INFO_QUERY_REG3 (INFO_QUERY_REG0 + 3)
|
|
|
|
#define PRODUCT_ID_REG0 0x0210
|
|
#define PRODUCT_ID_REG1 (PRODUCT_ID_REG0 + 1)
|
|
#define PRODUCT_ID_REG2 (PRODUCT_ID_REG0 + 2)
|
|
#define PRODUCT_ID_REG3 (PRODUCT_ID_REG0 + 3)
|
|
#define PRODUCT_ID_REG4 (PRODUCT_ID_REG0 + 4)
|
|
#define PRODUCT_ID_REG5 (PRODUCT_ID_REG0 + 5)
|
|
#define PRODUCT_ID_REG6 (PRODUCT_ID_REG0 + 6)
|
|
#define PRODUCT_ID_REG7 (PRODUCT_ID_REG0 + 7)
|
|
#define PRODUCT_ID_REG8 (PRODUCT_ID_REG0 + 8)
|
|
#define PRODUCT_ID_REG9 (PRODUCT_ID_REG0 + 9)
|
|
#define PRODUCT_ID_REG10 (PRODUCT_ID_REG0 + 10)
|
|
#define PRODUCT_ID_REG11 (PRODUCT_ID_REG0 + 11)
|
|
#define PRODUCT_ID_REG12 (PRODUCT_ID_REG0 + 12)
|
|
#define PRODUCT_ID_REG13 (PRODUCT_ID_REG0 + 13)
|
|
#define PRODUCT_ID_REG14 (PRODUCT_ID_REG0 + 14)
|
|
#define PRODUCT_ID_REG15 (PRODUCT_ID_REG0 + 15)
|
|
|
|
#define DATA_REG0 0x0400
|
|
#define ABS_PRESSURE_REG 0x0401
|
|
#define ABS_MSB_X_REG 0x0402
|
|
#define ABS_LSB_X_REG (ABS_MSB_X_REG + 1)
|
|
#define ABS_MSB_Y_REG 0x0404
|
|
#define ABS_LSB_Y_REG (ABS_MSB_Y_REG + 1)
|
|
#define REL_X_REG 0x0406
|
|
#define REL_Y_REG 0x0407
|
|
|
|
#define DEV_QUERY_REG0 0x1000
|
|
#define DEV_QUERY_REG1 (DEV_QUERY_REG0 + 1)
|
|
#define DEV_QUERY_REG2 (DEV_QUERY_REG0 + 2)
|
|
#define DEV_QUERY_REG3 (DEV_QUERY_REG0 + 3)
|
|
#define DEV_QUERY_REG4 (DEV_QUERY_REG0 + 4)
|
|
#define DEV_QUERY_REG5 (DEV_QUERY_REG0 + 5)
|
|
#define DEV_QUERY_REG6 (DEV_QUERY_REG0 + 6)
|
|
#define DEV_QUERY_REG7 (DEV_QUERY_REG0 + 7)
|
|
#define DEV_QUERY_REG8 (DEV_QUERY_REG0 + 8)
|
|
|
|
#define GENERAL_2D_CONTROL_REG 0x1041
|
|
#define SENSOR_SENSITIVITY_REG 0x1044
|
|
#define SENS_MAX_POS_MSB_REG 0x1046
|
|
#define SENS_MAX_POS_LSB_REG (SENS_MAX_POS_UPPER_REG + 1)
|
|
|
|
/* Register bits */
|
|
/* Device Control Register Bits */
|
|
#define REPORT_RATE_1ST_BIT 6
|
|
|
|
/* Interrupt Enable Register Bits (INTERRUPT_EN_REG) */
|
|
#define F10_ABS_INT_ENA 0
|
|
#define F10_REL_INT_ENA 1
|
|
#define F20_INT_ENA 2
|
|
|
|
/* Interrupt Request Register Bits (INT_REQ_STAT_REG | DEVICE_STATUS_REG) */
|
|
#define F10_ABS_INT_REQ 0
|
|
#define F10_REL_INT_REQ 1
|
|
#define F20_INT_REQ 2
|
|
/* Device Status Register Bits (DEVICE_STATUS_REG) */
|
|
#define STAT_CONFIGURED 6
|
|
#define STAT_ERROR 7
|
|
|
|
/* Device Command Register Bits (DEV_COMMAND_REG) */
|
|
#define RESET_COMMAND 0x01
|
|
#define REZERO_COMMAND 0x02
|
|
|
|
/* Data Register 0 Bits (DATA_REG0) */
|
|
#define GESTURE 3
|
|
|
|
/* Device Query Registers Bits */
|
|
/* DEV_QUERY_REG3 */
|
|
#define HAS_PALM_DETECT 1
|
|
#define HAS_MULTI_FING 2
|
|
#define HAS_SCROLLER 4
|
|
#define HAS_2D_SCROLL 5
|
|
|
|
/* General 2D Control Register Bits (GENERAL_2D_CONTROL_REG) */
|
|
#define NO_DECELERATION 1
|
|
#define REDUCE_REPORTING 3
|
|
#define NO_FILTER 5
|
|
|
|
/* Function Masks */
|
|
/* Device Control Register Masks (DEV_CONTROL_REG) */
|
|
#define REPORT_RATE_MSK 0xc0
|
|
#define SLEEP_MODE_MSK 0x07
|
|
|
|
/* Device Sleep Modes */
|
|
#define FULL_AWAKE 0x0
|
|
#define NORMAL_OP 0x1
|
|
#define LOW_PWR_OP 0x2
|
|
#define VERY_LOW_PWR_OP 0x3
|
|
#define SENS_SLEEP 0x4
|
|
#define SLEEP_MOD 0x5
|
|
#define DEEP_SLEEP 0x6
|
|
#define HIBERNATE 0x7
|
|
|
|
/* Interrupt Register Mask */
|
|
/* (INT_REQ_STAT_REG | DEVICE_STATUS_REG | INTERRUPT_EN_REG) */
|
|
#define INT_ENA_REQ_MSK 0x07
|
|
#define INT_ENA_ABS_MSK 0x01
|
|
#define INT_ENA_REL_MSK 0x02
|
|
#define INT_ENA_F20_MSK 0x04
|
|
|
|
/* Device Status Register Masks (DEVICE_STATUS_REG) */
|
|
#define CONFIGURED_MSK 0x40
|
|
#define ERROR_MSK 0x80
|
|
|
|
/* Data Register 0 Masks */
|
|
#define FINGER_WIDTH_MSK 0xf0
|
|
#define GESTURE_MSK 0x08
|
|
#define SENSOR_STATUS_MSK 0x07
|
|
|
|
/*
|
|
* MSB Position Register Masks
|
|
* ABS_MSB_X_REG | ABS_MSB_Y_REG | SENS_MAX_POS_MSB_REG |
|
|
* DEV_QUERY_REG3 | DEV_QUERY_REG5
|
|
*/
|
|
#define MSB_POSITION_MSK 0x1f
|
|
|
|
/* Device Query Registers Masks */
|
|
|
|
/* DEV_QUERY_REG2 */
|
|
#define NUM_EXTRA_POS_MSK 0x07
|
|
|
|
/* When in IRQ mode read the device every THREAD_IRQ_SLEEP_SECS */
|
|
#define THREAD_IRQ_SLEEP_SECS 2
|
|
#define THREAD_IRQ_SLEEP_MSECS (THREAD_IRQ_SLEEP_SECS * MSEC_PER_SEC)
|
|
|
|
/*
|
|
* When in Polling mode and no data received for NO_DATA_THRES msecs
|
|
* reduce the polling rate to NO_DATA_SLEEP_MSECS
|
|
*/
|
|
#define NO_DATA_THRES (MSEC_PER_SEC)
|
|
#define NO_DATA_SLEEP_MSECS (MSEC_PER_SEC / 4)
|
|
|
|
/* Control touchpad's No Deceleration option */
|
|
static int no_decel = 1;
|
|
module_param(no_decel, bool, 0644);
|
|
MODULE_PARM_DESC(no_decel, "No Deceleration. Default = 1 (on)");
|
|
|
|
/* Control touchpad's Reduced Reporting option */
|
|
static int reduce_report;
|
|
module_param(reduce_report, bool, 0644);
|
|
MODULE_PARM_DESC(reduce_report, "Reduced Reporting. Default = 0 (off)");
|
|
|
|
/* Control touchpad's No Filter option */
|
|
static int no_filter;
|
|
module_param(no_filter, bool, 0644);
|
|
MODULE_PARM_DESC(no_filter, "No Filter. Default = 0 (off)");
|
|
|
|
/*
|
|
* touchpad Attention line is Active Low and Open Drain,
|
|
* therefore should be connected to pulled up line
|
|
* and the irq configuration should be set to Falling Edge Trigger
|
|
*/
|
|
/* Control IRQ / Polling option */
|
|
static bool polling_req;
|
|
module_param(polling_req, bool, 0444);
|
|
MODULE_PARM_DESC(polling_req, "Request Polling. Default = 0 (use irq)");
|
|
|
|
/* Control Polling Rate */
|
|
static int scan_rate = 80;
|
|
module_param(scan_rate, int, 0644);
|
|
MODULE_PARM_DESC(scan_rate, "Polling rate in times/sec. Default = 80");
|
|
|
|
/* The main device structure */
|
|
struct synaptics_i2c {
|
|
struct i2c_client *client;
|
|
struct input_dev *input;
|
|
struct delayed_work dwork;
|
|
spinlock_t lock;
|
|
int no_data_count;
|
|
int no_decel_param;
|
|
int reduce_report_param;
|
|
int no_filter_param;
|
|
int scan_rate_param;
|
|
int scan_ms;
|
|
};
|
|
|
|
static inline void set_scan_rate(struct synaptics_i2c *touch, int scan_rate)
|
|
{
|
|
touch->scan_ms = MSEC_PER_SEC / scan_rate;
|
|
touch->scan_rate_param = scan_rate;
|
|
}
|
|
|
|
/*
|
|
* Driver's initial design makes no race condition possible on i2c bus,
|
|
* so there is no need in any locking.
|
|
* Keep it in mind, while playing with the code.
|
|
*/
|
|
static s32 synaptics_i2c_reg_get(struct i2c_client *client, u16 reg)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_write_byte_data(client, PAGE_SEL_REG, reg >> 8);
|
|
if (ret == 0)
|
|
ret = i2c_smbus_read_byte_data(client, reg & 0xff);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static s32 synaptics_i2c_reg_set(struct i2c_client *client, u16 reg, u8 val)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_write_byte_data(client, PAGE_SEL_REG, reg >> 8);
|
|
if (ret == 0)
|
|
ret = i2c_smbus_write_byte_data(client, reg & 0xff, val);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static s32 synaptics_i2c_word_get(struct i2c_client *client, u16 reg)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_write_byte_data(client, PAGE_SEL_REG, reg >> 8);
|
|
if (ret == 0)
|
|
ret = i2c_smbus_read_word_data(client, reg & 0xff);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int synaptics_i2c_config(struct i2c_client *client)
|
|
{
|
|
int ret, control;
|
|
u8 int_en;
|
|
|
|
/* set Report Rate to Device Highest (>=80) and Sleep to normal */
|
|
ret = synaptics_i2c_reg_set(client, DEV_CONTROL_REG, 0xc1);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* set Interrupt Disable to Func20 / Enable to Func10) */
|
|
int_en = (polling_req) ? 0 : INT_ENA_ABS_MSK | INT_ENA_REL_MSK;
|
|
ret = synaptics_i2c_reg_set(client, INTERRUPT_EN_REG, int_en);
|
|
if (ret)
|
|
return ret;
|
|
|
|
control = synaptics_i2c_reg_get(client, GENERAL_2D_CONTROL_REG);
|
|
/* No Deceleration */
|
|
control |= no_decel ? 1 << NO_DECELERATION : 0;
|
|
/* Reduced Reporting */
|
|
control |= reduce_report ? 1 << REDUCE_REPORTING : 0;
|
|
/* No Filter */
|
|
control |= no_filter ? 1 << NO_FILTER : 0;
|
|
ret = synaptics_i2c_reg_set(client, GENERAL_2D_CONTROL_REG, control);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int synaptics_i2c_reset_config(struct i2c_client *client)
|
|
{
|
|
int ret;
|
|
|
|
/* Reset the Touchpad */
|
|
ret = synaptics_i2c_reg_set(client, DEV_COMMAND_REG, RESET_COMMAND);
|
|
if (ret) {
|
|
dev_err(&client->dev, "Unable to reset device\n");
|
|
} else {
|
|
msleep(SOFT_RESET_DELAY_MS);
|
|
ret = synaptics_i2c_config(client);
|
|
if (ret)
|
|
dev_err(&client->dev, "Unable to config device\n");
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int synaptics_i2c_check_error(struct i2c_client *client)
|
|
{
|
|
int status, ret = 0;
|
|
|
|
status = i2c_smbus_read_byte_data(client, DEVICE_STATUS_REG) &
|
|
(CONFIGURED_MSK | ERROR_MSK);
|
|
|
|
if (status != CONFIGURED_MSK)
|
|
ret = synaptics_i2c_reset_config(client);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static bool synaptics_i2c_get_input(struct synaptics_i2c *touch)
|
|
{
|
|
struct input_dev *input = touch->input;
|
|
int xy_delta, gesture;
|
|
s32 data;
|
|
s8 x_delta, y_delta;
|
|
|
|
/* Deal with spontanious resets and errors */
|
|
if (synaptics_i2c_check_error(touch->client))
|
|
return 0;
|
|
|
|
/* Get Gesture Bit */
|
|
data = synaptics_i2c_reg_get(touch->client, DATA_REG0);
|
|
gesture = (data >> GESTURE) & 0x1;
|
|
|
|
/*
|
|
* Get Relative axes. we have to get them in one shot,
|
|
* so we get 2 bytes starting from REL_X_REG.
|
|
*/
|
|
xy_delta = synaptics_i2c_word_get(touch->client, REL_X_REG) & 0xffff;
|
|
|
|
/* Separate X from Y */
|
|
x_delta = xy_delta & 0xff;
|
|
y_delta = (xy_delta >> REGISTER_LENGTH) & 0xff;
|
|
|
|
/* Report the button event */
|
|
input_report_key(input, BTN_LEFT, gesture);
|
|
|
|
/* Report the deltas */
|
|
input_report_rel(input, REL_X, x_delta);
|
|
input_report_rel(input, REL_Y, -y_delta);
|
|
input_sync(input);
|
|
|
|
return xy_delta || gesture;
|
|
}
|
|
|
|
static void synaptics_i2c_reschedule_work(struct synaptics_i2c *touch,
|
|
unsigned long delay)
|
|
{
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&touch->lock, flags);
|
|
|
|
/*
|
|
* If work is already scheduled then subsequent schedules will not
|
|
* change the scheduled time that's why we have to cancel it first.
|
|
*/
|
|
__cancel_delayed_work(&touch->dwork);
|
|
schedule_delayed_work(&touch->dwork, delay);
|
|
|
|
spin_unlock_irqrestore(&touch->lock, flags);
|
|
}
|
|
|
|
static irqreturn_t synaptics_i2c_irq(int irq, void *dev_id)
|
|
{
|
|
struct synaptics_i2c *touch = dev_id;
|
|
|
|
synaptics_i2c_reschedule_work(touch, 0);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static void synaptics_i2c_check_params(struct synaptics_i2c *touch)
|
|
{
|
|
bool reset = false;
|
|
|
|
if (scan_rate != touch->scan_rate_param)
|
|
set_scan_rate(touch, scan_rate);
|
|
|
|
if (no_decel != touch->no_decel_param) {
|
|
touch->no_decel_param = no_decel;
|
|
reset = true;
|
|
}
|
|
|
|
if (no_filter != touch->no_filter_param) {
|
|
touch->no_filter_param = no_filter;
|
|
reset = true;
|
|
}
|
|
|
|
if (reduce_report != touch->reduce_report_param) {
|
|
touch->reduce_report_param = reduce_report;
|
|
reset = true;
|
|
}
|
|
|
|
if (reset)
|
|
synaptics_i2c_reset_config(touch->client);
|
|
}
|
|
|
|
/* Control the Device polling rate / Work Handler sleep time */
|
|
static unsigned long synaptics_i2c_adjust_delay(struct synaptics_i2c *touch,
|
|
bool have_data)
|
|
{
|
|
unsigned long delay, nodata_count_thres;
|
|
|
|
if (polling_req) {
|
|
delay = touch->scan_ms;
|
|
if (have_data) {
|
|
touch->no_data_count = 0;
|
|
} else {
|
|
nodata_count_thres = NO_DATA_THRES / touch->scan_ms;
|
|
if (touch->no_data_count < nodata_count_thres)
|
|
touch->no_data_count++;
|
|
else
|
|
delay = NO_DATA_SLEEP_MSECS;
|
|
}
|
|
return msecs_to_jiffies(delay);
|
|
} else {
|
|
delay = msecs_to_jiffies(THREAD_IRQ_SLEEP_MSECS);
|
|
return round_jiffies_relative(delay);
|
|
}
|
|
}
|
|
|
|
/* Work Handler */
|
|
static void synaptics_i2c_work_handler(struct work_struct *work)
|
|
{
|
|
bool have_data;
|
|
struct synaptics_i2c *touch =
|
|
container_of(work, struct synaptics_i2c, dwork.work);
|
|
unsigned long delay;
|
|
|
|
synaptics_i2c_check_params(touch);
|
|
|
|
have_data = synaptics_i2c_get_input(touch);
|
|
delay = synaptics_i2c_adjust_delay(touch, have_data);
|
|
|
|
/*
|
|
* While interrupt driven, there is no real need to poll the device.
|
|
* But touchpads are very sensitive, so there could be errors
|
|
* related to physical environment and the attention line isn't
|
|
* neccesarily asserted. In such case we can lose the touchpad.
|
|
* We poll the device once in THREAD_IRQ_SLEEP_SECS and
|
|
* if error is detected, we try to reset and reconfigure the touchpad.
|
|
*/
|
|
synaptics_i2c_reschedule_work(touch, delay);
|
|
}
|
|
|
|
static int synaptics_i2c_open(struct input_dev *input)
|
|
{
|
|
struct synaptics_i2c *touch = input_get_drvdata(input);
|
|
int ret;
|
|
|
|
ret = synaptics_i2c_reset_config(touch->client);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (polling_req)
|
|
synaptics_i2c_reschedule_work(touch,
|
|
msecs_to_jiffies(NO_DATA_SLEEP_MSECS));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void synaptics_i2c_close(struct input_dev *input)
|
|
{
|
|
struct synaptics_i2c *touch = input_get_drvdata(input);
|
|
|
|
if (!polling_req)
|
|
synaptics_i2c_reg_set(touch->client, INTERRUPT_EN_REG, 0);
|
|
|
|
cancel_delayed_work_sync(&touch->dwork);
|
|
|
|
/* Save some power */
|
|
synaptics_i2c_reg_set(touch->client, DEV_CONTROL_REG, DEEP_SLEEP);
|
|
}
|
|
|
|
static void synaptics_i2c_set_input_params(struct synaptics_i2c *touch)
|
|
{
|
|
struct input_dev *input = touch->input;
|
|
|
|
input->name = touch->client->name;
|
|
input->phys = touch->client->adapter->name;
|
|
input->id.bustype = BUS_I2C;
|
|
input->id.version = synaptics_i2c_word_get(touch->client,
|
|
INFO_QUERY_REG0);
|
|
input->dev.parent = &touch->client->dev;
|
|
input->open = synaptics_i2c_open;
|
|
input->close = synaptics_i2c_close;
|
|
input_set_drvdata(input, touch);
|
|
|
|
/* Register the device as mouse */
|
|
__set_bit(EV_REL, input->evbit);
|
|
__set_bit(REL_X, input->relbit);
|
|
__set_bit(REL_Y, input->relbit);
|
|
|
|
/* Register device's buttons and keys */
|
|
__set_bit(EV_KEY, input->evbit);
|
|
__set_bit(BTN_LEFT, input->keybit);
|
|
}
|
|
|
|
static struct synaptics_i2c *synaptics_i2c_touch_create(struct i2c_client *client)
|
|
{
|
|
struct synaptics_i2c *touch;
|
|
|
|
touch = kzalloc(sizeof(struct synaptics_i2c), GFP_KERNEL);
|
|
if (!touch)
|
|
return NULL;
|
|
|
|
touch->client = client;
|
|
touch->no_decel_param = no_decel;
|
|
touch->scan_rate_param = scan_rate;
|
|
set_scan_rate(touch, scan_rate);
|
|
INIT_DELAYED_WORK(&touch->dwork, synaptics_i2c_work_handler);
|
|
spin_lock_init(&touch->lock);
|
|
|
|
return touch;
|
|
}
|
|
|
|
static int __devinit synaptics_i2c_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *dev_id)
|
|
{
|
|
int ret;
|
|
struct synaptics_i2c *touch;
|
|
|
|
touch = synaptics_i2c_touch_create(client);
|
|
if (!touch)
|
|
return -ENOMEM;
|
|
|
|
ret = synaptics_i2c_reset_config(client);
|
|
if (ret)
|
|
goto err_mem_free;
|
|
|
|
if (client->irq < 1)
|
|
polling_req = true;
|
|
|
|
touch->input = input_allocate_device();
|
|
if (!touch->input) {
|
|
ret = -ENOMEM;
|
|
goto err_mem_free;
|
|
}
|
|
|
|
synaptics_i2c_set_input_params(touch);
|
|
|
|
if (!polling_req) {
|
|
dev_dbg(&touch->client->dev,
|
|
"Requesting IRQ: %d\n", touch->client->irq);
|
|
|
|
ret = request_irq(touch->client->irq, synaptics_i2c_irq,
|
|
IRQF_DISABLED|IRQ_TYPE_EDGE_FALLING,
|
|
DRIVER_NAME, touch);
|
|
if (ret) {
|
|
dev_warn(&touch->client->dev,
|
|
"IRQ request failed: %d, "
|
|
"falling back to polling\n", ret);
|
|
polling_req = true;
|
|
synaptics_i2c_reg_set(touch->client,
|
|
INTERRUPT_EN_REG, 0);
|
|
}
|
|
}
|
|
|
|
if (polling_req)
|
|
dev_dbg(&touch->client->dev,
|
|
"Using polling at rate: %d times/sec\n", scan_rate);
|
|
|
|
/* Register the device in input subsystem */
|
|
ret = input_register_device(touch->input);
|
|
if (ret) {
|
|
dev_err(&client->dev,
|
|
"Input device register failed: %d\n", ret);
|
|
goto err_input_free;
|
|
}
|
|
|
|
i2c_set_clientdata(client, touch);
|
|
|
|
return 0;
|
|
|
|
err_input_free:
|
|
input_free_device(touch->input);
|
|
err_mem_free:
|
|
kfree(touch);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __devexit synaptics_i2c_remove(struct i2c_client *client)
|
|
{
|
|
struct synaptics_i2c *touch = i2c_get_clientdata(client);
|
|
|
|
if (!polling_req)
|
|
free_irq(client->irq, touch);
|
|
|
|
input_unregister_device(touch->input);
|
|
kfree(touch);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int synaptics_i2c_suspend(struct i2c_client *client, pm_message_t mesg)
|
|
{
|
|
struct synaptics_i2c *touch = i2c_get_clientdata(client);
|
|
|
|
cancel_delayed_work_sync(&touch->dwork);
|
|
|
|
/* Save some power */
|
|
synaptics_i2c_reg_set(touch->client, DEV_CONTROL_REG, DEEP_SLEEP);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int synaptics_i2c_resume(struct i2c_client *client)
|
|
{
|
|
int ret;
|
|
struct synaptics_i2c *touch = i2c_get_clientdata(client);
|
|
|
|
ret = synaptics_i2c_reset_config(client);
|
|
if (ret)
|
|
return ret;
|
|
|
|
synaptics_i2c_reschedule_work(touch,
|
|
msecs_to_jiffies(NO_DATA_SLEEP_MSECS));
|
|
|
|
return 0;
|
|
}
|
|
#else
|
|
#define synaptics_i2c_suspend NULL
|
|
#define synaptics_i2c_resume NULL
|
|
#endif
|
|
|
|
static const struct i2c_device_id synaptics_i2c_id_table[] = {
|
|
{ "synaptics_i2c", 0 },
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, synaptics_i2c_id_table);
|
|
|
|
static struct i2c_driver synaptics_i2c_driver = {
|
|
.driver = {
|
|
.name = DRIVER_NAME,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
|
|
.probe = synaptics_i2c_probe,
|
|
.remove = __devexit_p(synaptics_i2c_remove),
|
|
|
|
.suspend = synaptics_i2c_suspend,
|
|
.resume = synaptics_i2c_resume,
|
|
.id_table = synaptics_i2c_id_table,
|
|
};
|
|
|
|
static int __init synaptics_i2c_init(void)
|
|
{
|
|
return i2c_add_driver(&synaptics_i2c_driver);
|
|
}
|
|
|
|
static void __exit synaptics_i2c_exit(void)
|
|
{
|
|
i2c_del_driver(&synaptics_i2c_driver);
|
|
}
|
|
|
|
module_init(synaptics_i2c_init);
|
|
module_exit(synaptics_i2c_exit);
|
|
|
|
MODULE_DESCRIPTION("Synaptics I2C touchpad driver");
|
|
MODULE_AUTHOR("Mike Rapoport, Igor Grinberg, Compulab");
|
|
MODULE_LICENSE("GPL");
|
|
|