Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 5cc0bff8 authored by Mao Li's avatar Mao Li Committed by Gerrit - the friendly Code Review server
Browse files

input: ft5x06_ts: add gesture feature support 



Focaltech touch controller FT6436 support new feature Screen-off-Gesture.
It is able to turn on the screen by drawing gestures on the touch screen
when the screen is during off status. Enable the FT CTP driver to support
the screen off gesture recognization.

This patch is propagated from msm-3.10 kernel.
(commit: c5150a8b762c54b76c5a27e904620dd5dee40ee7
input: ft5x06_ts: add gesture feature support)
Also cleared checkpatch warnings on 3.18 kernel.
WARNING: Missing a blank line after declarations
+       int err;
+       ft5x06_ts_start(dev);

WARNING: Missing a blank line after declarations
+       int i;
+       for (i = 0; i < 2; i++) {

Change-Id: I77d111d3ef800b636a337221d7e605f746a113dd
Signed-off-by: default avatarMao Li <maol@codeaurora.org>
Signed-off-by: default avatarSudhakar Manapati <smanap@codeaurora.org>
parent 8726963b

Documentation/devicetree/bindings/input/touchscreen/ft5x06-ts.txt

+2 −0
Original line number Diff line number Diff line
@@ -70,6 +70,7 @@ Optional properties: 
				min y, max x and max y values

 - focaltech,fw-name	: specify the firmware file name

 - focaltech,psensor-support	: specify whether support the proximity sensor

 - focaltech,gesture-support	: specify whether support gesture feature



Example:

	i2c@f9923000{
@@ -106,5 +107,6 @@ Example: 
			focaltech,fw-delay-era-flsh-ms = <2000>;

			focaltech,fw-auto-cal;

			focaltech,psensor-support;

			focaltech,gesture-support;

		};

	};

drivers/input/touchscreen/Kconfig

+9 −0
Original line number Diff line number Diff line
@@ -985,6 +985,15 @@ config TOUCHSCREEN_FT5X06_PSENSOR 


         If unsure, say N.



config TOUCHSCREEN_FT5X06_GESTURE

       tristate "FocalTech gesture feature support"

       depends on TOUCHSCREEN_FT5X06

       help

         Say Y here if you want to support ft5x06's gesture

         feature.



         If unsure, say N.



config TOUCHSCREEN_MSTAR21XX

	tristate "mstar touchscreens"

	depends on I2C

drivers/input/touchscreen/ft5x06_ts.c

+462 −77
Original line number Diff line number Diff line
@@ -85,7 +85,28 @@ 
#define FT_PSENSOR_FAR_TO_NEAR	0

#define FT_PSENSOR_NEAR_TO_FAR	1

#define FT_PSENSOR_ORIGINAL_STATE_FAR	1

#define FT_PSENSOR_WAKEUP_TIMEOUT	100

#define FT_PSENSOR_WAKEUP_TIMEOUT	500



/* gesture register address*/

#define FT_REG_GESTURE_ENABLE	0xD0

#define FT_REG_GESTURE_OUTPUT	0xD3



/* gesture register bits*/

#define FT_GESTURE_DOUBLECLICK_COORD_X		100

#define FT_GESTURE_DOUBLECLICK_COORD_Y		100

#define FT_GESTURE_WAKEUP_TIMEOUT		500

#define FT_GESTURE_DEFAULT_TRACKING_ID		0x0A

#define FT_GESTURE_DOUBLECLICK_ID		0x24

#define FT_GESTURE_POINTER_NUM_MAX		128

#define FT_GESTURE_POINTER_SIZEOF		4

#define FT_GESTURE_ID_FLAG_SIZE			1

#define FT_GESTURE_POINTER_NUM_FLAG_SIZE	1

/* 6 bytes are taken to mark which gesture is supported in firmware */

#define FT_GESTURE_SET_FLAG_SIZE		6

#define I2C_TRANSFER_MAX_BYTE			255

#define FT_GESTURE_DATA_HEADER	(FT_GESTURE_ID_FLAG_SIZE + \

				FT_GESTURE_POINTER_NUM_FLAG_SIZE + \

				FT_GESTURE_SET_FLAG_SIZE)



/* power register bits*/

#define FT_PMODE_ACTIVE		0x00
@@ -222,6 +243,7 @@ struct ft5x06_ts_data { 
	struct input_dev *input_dev;

	const struct ft5x06_ts_platform_data *pdata;

	struct ft5x06_psensor_platform_data *psensor_pdata;

	struct ft5x06_gesture_platform_data *gesture_pdata;

	struct regulator *vdd;

	struct regulator *vcc_i2c;

	char fw_name[FT_FW_NAME_MAX_LEN];
@@ -246,6 +268,9 @@ struct ft5x06_ts_data { 
	struct pinctrl_state *pinctrl_state_release;

};



static int ft5x06_ts_start(struct device *dev);

static int ft5x06_ts_stop(struct device *dev);



static struct sensors_classdev __maybe_unused sensors_proximity_cdev = {

	.name = "ft5x06-proximity",

	.vendor = "FocalTech",
@@ -269,6 +294,11 @@ static inline bool ft5x06_psensor_support_enabled(void) 
	return config_enabled(CONFIG_TOUCHSCREEN_FT5X06_PSENSOR);

}



static inline bool ft5x06_gesture_support_enabled(void)

{

	return config_enabled(CONFIG_TOUCHSCREEN_FT5X06_GESTURE);

}



static int ft5x06_i2c_read(struct i2c_client *client, char *writebuf,

			   int writelen, char *readbuf, int readlen)

{
@@ -389,7 +419,7 @@ static int ft5x06_read_tp_psensor_data(struct ft5x06_ts_data *data) 
{

	u8 psensor_status;

	char tmp;

	int ret = 0;

	int ret = 1;



	ft5x0x_read_reg(data->client,

			FT_REG_PSENSOR_STATUS, &psensor_status);
@@ -403,9 +433,9 @@ static int ft5x06_read_tp_psensor_data(struct ft5x06_ts_data *data) 
						FT_PSENSOR_NEAR_TO_FAR;



	if (tmp != data->psensor_pdata->tp_psensor_data) {

		dev_info(&data->client->dev,

		dev_debug(&data->client->dev,

				"%s sensor data changed\n", __func__);

		ret = 1;

		ret = 0;

	}

	return ret;

}
@@ -422,6 +452,203 @@ static int ft5x06_read_tp_psensor_data(struct ft5x06_ts_data *data) 
}

#endif



#ifdef CONFIG_TOUCHSCREEN_FT5X06_GESTURE

static ssize_t ft5x06_gesture_enable_to_set_show(struct device *dev,

				struct device_attribute *attr, char *buf)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);



	return scnprintf(buf, PAGE_SIZE, "%d\n",

			data->gesture_pdata->gesture_enable_to_set);

}



static ssize_t ft5x06_gesture_enable_to_set_store(struct device *dev,

				struct device_attribute *attr,

				const char *buf, size_t size)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);

	unsigned long value = 0;

	int ret;



	if (data->suspended)

		return -EINVAL;



	ret = kstrtoul(buf, 16, &value);

	if (ret < 0) {

		dev_err(dev, "%s:kstrtoul failed, ret=0x%x\n",

			__func__, ret);

		return ret;

	}



	if (1 == value)

		data->gesture_pdata->gesture_enable_to_set = 1;

	else

		data->gesture_pdata->gesture_enable_to_set = 0;

	return size;

}



static DEVICE_ATTR(enable, 0664,

		ft5x06_gesture_enable_to_set_show,

		ft5x06_gesture_enable_to_set_store);



static int ft5x06_entry_pocket(struct device *dev)

{

	return ft5x06_ts_stop(dev);

}



static int ft5x06_leave_pocket(struct device *dev)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);

	int err;



	ft5x06_ts_start(dev);



	if (ft5x06_gesture_support_enabled() && device_may_wakeup(dev) &&

		data->pdata->gesture_support &&

		data->gesture_pdata->gesture_enable_to_set) {

		ft5x0x_write_reg(data->client, FT_REG_GESTURE_ENABLE, 1);

		err = enable_irq_wake(data->client->irq);

		if (err)

			dev_err(&data->client->dev,

				"%s: set_irq_wake failed\n", __func__);

	}

	return err;

}



static ssize_t gesture_in_pocket_mode_show(struct device *dev,

				struct device_attribute *attr, char *buf)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);



	return scnprintf(buf, PAGE_SIZE, "%d\n",

			data->gesture_pdata->in_pocket);

}



static ssize_t gesture_in_pocket_mode_store(struct device *dev,

				struct device_attribute *attr,

				const char *buf, size_t size)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);

	unsigned long value = 0;

	int ret;



	ret = kstrtoul(buf, 16, &value);

	if (ret < 0) {

		dev_err(dev, "%s:kstrtoul failed, ret=0x%x\n",

			__func__, ret);

		return ret;

	}

	if (1 == value) {

		data->gesture_pdata->in_pocket = 1;

		ft5x06_entry_pocket(dev);

	} else if (0 == value) {

		ft5x06_leave_pocket(dev);

		data->gesture_pdata->in_pocket = 0;

	}

	return size;

}



static DEVICE_ATTR(pocket, 0664,

		gesture_in_pocket_mode_show,

		gesture_in_pocket_mode_store);



static int ft5x06_report_gesture_doubleclick(struct input_dev *ip_dev)

{

	int i;



	for (i = 0; i < 2; i++) {

		input_mt_slot(ip_dev, FT_GESTURE_DEFAULT_TRACKING_ID);

		input_mt_report_slot_state(ip_dev, MT_TOOL_FINGER, 1);

		input_report_abs(ip_dev, ABS_MT_POSITION_X,

					FT_GESTURE_DOUBLECLICK_COORD_X);

		input_report_abs(ip_dev, ABS_MT_POSITION_Y,

					FT_GESTURE_DOUBLECLICK_COORD_Y);

		input_mt_report_pointer_emulation(ip_dev, false);

		input_sync(ip_dev);

		input_mt_slot(ip_dev, FT_GESTURE_DEFAULT_TRACKING_ID);

		input_mt_report_slot_state(ip_dev, MT_TOOL_FINGER, 0);

		input_mt_report_pointer_emulation(ip_dev, false);

		input_sync(ip_dev);

	}

	return 0;

}



static int ft5x06_report_gesture(struct i2c_client *i2c_client,

		struct input_dev *ip_dev)

{

	int i, temp, gesture_data_size;

	int gesture_coord_x, gesture_coord_y;

	int ret = -1;

	short pointnum = 0;

	unsigned char buf[FT_GESTURE_POINTER_NUM_MAX *

			FT_GESTURE_POINTER_SIZEOF + FT_GESTURE_DATA_HEADER];



	buf[0] = FT_REG_GESTURE_OUTPUT;

	ret = ft5x06_i2c_read(i2c_client, buf, 1,

				buf, FT_GESTURE_DATA_HEADER);

	if (ret < 0) {

		dev_err(&i2c_client->dev, "%s read touchdata failed.\n",

			__func__);

		return ret;

	}



	/* FW support doubleclick */

	if (FT_GESTURE_DOUBLECLICK_ID == buf[0]) {

		ft5x06_report_gesture_doubleclick(ip_dev);

		return 0;

	}



	pointnum = (short)(buf[1]) & 0xff;

	gesture_data_size = pointnum * FT_GESTURE_POINTER_SIZEOF +

			FT_GESTURE_DATA_HEADER;

	buf[0] = FT_REG_GESTURE_OUTPUT;

	temp = gesture_data_size / I2C_TRANSFER_MAX_BYTE;

	for (i = 0; i < temp; i++)

		ret = ft5x06_i2c_read(i2c_client, buf, ((i == 0) ? 1 : 0),

			buf + I2C_TRANSFER_MAX_BYTE * i, I2C_TRANSFER_MAX_BYTE);

	ret = ft5x06_i2c_read(i2c_client, buf, ((temp == 0) ? 1 : 0),

			buf + I2C_TRANSFER_MAX_BYTE * temp,

			gesture_data_size - I2C_TRANSFER_MAX_BYTE * temp);

	if (ret < 0) {

		dev_err(&i2c_client->dev, "%s read touchdata failed.\n",

			__func__);

		return ret;

	}



	for (i = 0; i < pointnum; i++) {

		gesture_coord_x = (((s16) buf[FT_GESTURE_DATA_HEADER +

				(FT_GESTURE_POINTER_SIZEOF * i)]) & 0x0F) << 8 |

				(((s16) buf[FT_GESTURE_DATA_HEADER + 1 +

				(FT_GESTURE_POINTER_SIZEOF * i)]) & 0xFF);

		gesture_coord_y = (((s16) buf[FT_GESTURE_DATA_HEADER + 2 +

				(FT_GESTURE_POINTER_SIZEOF * i)]) & 0x0F) << 8 |

				(((s16) buf[FT_GESTURE_DATA_HEADER + 3 +

				(FT_GESTURE_POINTER_SIZEOF * i)]) & 0xFF);

		input_mt_slot(ip_dev, FT_GESTURE_DEFAULT_TRACKING_ID);

		input_mt_report_slot_state(ip_dev, MT_TOOL_FINGER, 1);

		input_report_abs(ip_dev, ABS_MT_POSITION_X, gesture_coord_x);

		input_report_abs(ip_dev, ABS_MT_POSITION_Y, gesture_coord_y);

		input_mt_report_pointer_emulation(ip_dev, false);

		input_sync(ip_dev);

	}

	input_mt_slot(ip_dev, FT_GESTURE_DEFAULT_TRACKING_ID);

	input_mt_report_slot_state(ip_dev, MT_TOOL_FINGER, 0);

	input_mt_report_pointer_emulation(ip_dev, false);

	input_sync(ip_dev);



	return 0;

}

#else

static DEVICE_ATTR(pocket, 0664, NULL, NULL);

static DEVICE_ATTR(enable, 0664, NULL, NULL);



static int ft5x06_report_gesture(struct i2c_client *i2c_client,

		struct input_dev *ip_dev)

{

	return 0;

}

#endif



static void ft5x06_update_fw_vendor_id(struct ft5x06_ts_data *data)

{

	struct i2c_client *client = data->client;
@@ -465,7 +692,7 @@ static irqreturn_t ft5x06_ts_interrupt(int irq, void *dev_id) 
	struct input_dev *ip_dev;

	int rc, i;

	u32 id, x, y, status, num_touches;

	u8 reg, *buf;

	u8 reg, *buf, gesture_is_active;

	bool update_input = false;



	if (!data) {
@@ -479,7 +706,7 @@ static irqreturn_t ft5x06_ts_interrupt(int irq, void *dev_id) 
	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support &&

		data->psensor_pdata->tp_psensor_opened) {

		rc = ft5x06_read_tp_psensor_data(data);

		if (rc) {

		if (!rc) {

			if (data->suspended)

				pm_wakeup_event(&data->client->dev,

					FT_PSENSOR_WAKEUP_TIMEOUT);
@@ -494,7 +721,18 @@ static irqreturn_t ft5x06_ts_interrupt(int irq, void *dev_id) 
			return IRQ_HANDLED;

	}



	/**

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support) {

		ft5x0x_read_reg(data->client, FT_REG_GESTURE_ENABLE,

					&gesture_is_active);

		if (gesture_is_active) {

			pm_wakeup_event(&(data->client->dev),

					FT_GESTURE_WAKEUP_TIMEOUT);

			ft5x06_report_gesture(data->client, ip_dev);

			return IRQ_HANDLED;

		}

	}



	/*

	 * Read touch data start from register FT_REG_DEV_MODE.

	 * The touch x/y value start from FT_TOUCH_X_H/L_POS and

	 * FT_TOUCH_Y_H/L_POS in buf.
@@ -784,32 +1022,77 @@ err_pinctrl_get: 
}



#ifdef CONFIG_PM

static int ft5x06_ts_suspend(struct device *dev)

static int ft5x06_ts_start(struct device *dev)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);

	char txbuf[2], i;

	int err;



	if (data->loading_fw) {

		dev_info(dev, "Firmware loading in process...\n");

		return 0;

	if (data->pdata->power_on) {

		err = data->pdata->power_on(true);

		if (err) {

			dev_err(dev, "power on failed");

			return err;

		}

	} else {

		err = ft5x06_power_on(data, true);

		if (err) {

			dev_err(dev, "power on failed");

			return err;

		}

	}



	if (data->suspended) {

		dev_info(dev, "Already in suspend state\n");

		return 0;

	if (data->ts_pinctrl) {

		err = pinctrl_select_state(data->ts_pinctrl,

				data->pinctrl_state_active);

		if (err < 0)

			dev_err(dev, "Cannot get active pinctrl state\n");

	}



	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support &&

		device_may_wakeup(dev) &&

		data->psensor_pdata->tp_psensor_opened) {

		err = enable_irq_wake(data->client->irq);

		if (err)

	err = ft5x06_gpio_configure(data, true);

	if (err < 0) {

		dev_err(&data->client->dev,

				"%s: set_irq_wake failed\n", __func__);

		data->suspended = true;

			"failed to put gpios in resue state\n");

		goto err_gpio_configuration;

	}



	if (gpio_is_valid(data->pdata->reset_gpio)) {

		gpio_set_value_cansleep(data->pdata->reset_gpio, 0);

		msleep(data->pdata->hard_rst_dly);

		gpio_set_value_cansleep(data->pdata->reset_gpio, 1);

	}



	msleep(data->pdata->soft_rst_dly);



	enable_irq(data->client->irq);

	data->suspended = false;



	return 0;



err_gpio_configuration:

	if (data->ts_pinctrl) {

		err = pinctrl_select_state(data->ts_pinctrl,

					data->pinctrl_state_suspend);

		if (err < 0)

			dev_err(dev, "Cannot get suspend pinctrl state\n");

	}

	if (data->pdata->power_on) {

		err = data->pdata->power_on(false);

		if (err)

			dev_err(dev, "power off failed");

	} else {

		err = ft5x06_power_on(data, false);

		if (err)

			dev_err(dev, "power off failed");

	}

	return err;

}



static int ft5x06_ts_stop(struct device *dev)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);

	char txbuf[2];

	int i, err;



	disable_irq(data->client->irq);



	/* release all touches */
@@ -884,87 +1167,103 @@ pwr_off_fail: 
	return err;

}



static int ft5x06_ts_resume(struct device *dev)

static int ft5x06_ts_suspend(struct device *dev)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);

	int err;



	if (!data->suspended) {

		dev_dbg(dev, "Already in awake state\n");

	if (data->loading_fw) {

		dev_info(dev, "Firmware loading in process...\n");

		return 0;

	}



	if (data->suspended) {

		dev_info(dev, "Already in suspend state\n");

		return 0;

	}



	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support &&

		device_may_wakeup(dev) &&

		data->psensor_pdata->tp_psensor_opened) {

		err = disable_irq_wake(data->client->irq);



		err = enable_irq_wake(data->client->irq);

		if (err)

			dev_err(&data->client->dev,

				"%s: disable_irq_wake failed\n",

				__func__);

		data->suspended = false;

				"%s: set_irq_wake failed\n", __func__);

		data->suspended = true;

		return err;

	}



	if (data->pdata->power_on) {

		err = data->pdata->power_on(true);

		if (err) {

			dev_err(dev, "power on failed");

			return err;

		}

	} else {

		err = ft5x06_power_on(data, true);

		if (err) {

			dev_err(dev, "power on failed");

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support &&

		device_may_wakeup(dev) &&

		data->gesture_pdata->gesture_enable_to_set) {



		ft5x0x_write_reg(data->client, FT_REG_GESTURE_ENABLE, 1);

		err = enable_irq_wake(data->client->irq);

		if (err)

			dev_err(&data->client->dev,

				"%s: set_irq_wake failed\n", __func__);

		data->suspended = true;

		return err;

	}

	}



	if (data->ts_pinctrl) {

		err = pinctrl_select_state(data->ts_pinctrl,

				data->pinctrl_state_active);

		if (err < 0)

			dev_err(dev, "Cannot get active pinctrl state\n");

	return ft5x06_ts_stop(dev);

}



	err = ft5x06_gpio_configure(data, true);

	if (err < 0) {

		dev_err(&data->client->dev,

			"failed to put gpios in resue state\n");

		goto err_gpio_configuration;

	}

static int ft5x06_ts_resume(struct device *dev)

{

	struct ft5x06_ts_data *data = dev_get_drvdata(dev);

	int err;



	if (gpio_is_valid(data->pdata->reset_gpio)) {

		gpio_set_value_cansleep(data->pdata->reset_gpio, 0);

		msleep(data->pdata->hard_rst_dly);

		gpio_set_value_cansleep(data->pdata->reset_gpio, 1);

	if (!data->suspended) {

		dev_dbg(dev, "Already in awake state\n");

		return 0;

	}



	msleep(data->pdata->soft_rst_dly);

	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support &&

		device_may_wakeup(dev) &&

		data->psensor_pdata->tp_psensor_opened) {

		err = disable_irq_wake(data->client->irq);

		if (err)

			dev_err(&data->client->dev,

				"%s: disable_irq_wake failed\n",

				__func__);

		data->suspended = false;

		return err;

	}



	enable_irq(data->client->irq);

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support &&

		device_may_wakeup(dev) &&

		!(data->gesture_pdata->in_pocket) &&

		data->gesture_pdata->gesture_enable_to_set) {



		ft5x0x_write_reg(data->client, FT_REG_GESTURE_ENABLE, 0);

		err = disable_irq_wake(data->client->irq);

		if (err)

			dev_err(dev, "%s: disable_irq_wake failed\n",

				__func__);

		data->suspended = false;

		return err;

	}



	return 0;



err_gpio_configuration:

	if (data->ts_pinctrl) {

		err = pinctrl_select_state(data->ts_pinctrl,

					data->pinctrl_state_suspend);

	err = ft5x06_ts_start(dev);

	if (err < 0)

			dev_err(dev, "Cannot get suspend pinctrl state\n");

	}

	if (data->pdata->power_on) {

		err = data->pdata->power_on(false);

		if (err)

			dev_err(dev, "power off failed");

	} else {

		err = ft5x06_power_on(data, false);

		return err;



	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support &&

		device_may_wakeup(dev) &&

		data->gesture_pdata->in_pocket &&

		data->gesture_pdata->gesture_enable_to_set) {



		ft5x0x_write_reg(data->client, FT_REG_GESTURE_ENABLE, 0);

		err = disable_irq_wake(data->client->irq);

		if (err)

			dev_err(dev, "power off failed");

			dev_err(dev, "%s: disable_irq_wake failed\n",

				__func__);

		data->suspended = false;

		data->gesture_pdata->in_pocket = 0;

	}

	return err;

	return 0;

}



static const struct dev_pm_ops ft5x06_ts_pm_ops = {
@@ -1751,6 +2050,10 @@ static int ft5x06_parse_dt(struct device *dev, 


	pdata->psensor_support = of_property_read_bool(np,

						"focaltech,psensor-support");



	pdata->gesture_support = of_property_read_bool(np,

						"focaltech,gesture-support");



	rc = of_property_read_u32(np, "focaltech,family-id", &temp_val);

	if (!rc)

		pdata->family_id = temp_val;
@@ -1787,6 +2090,7 @@ static int ft5x06_ts_probe(struct i2c_client *client, 
{

	struct ft5x06_ts_platform_data *pdata;

	struct ft5x06_psensor_platform_data *psensor_pdata;

	struct ft5x06_gesture_platform_data *gesture_pdata;

	struct ft5x06_ts_data *data;

	struct input_dev *input_dev;

	struct input_dev *psensor_input_dev;
@@ -1957,6 +2261,11 @@ static int ft5x06_ts_probe(struct i2c_client *client, 
		goto free_gpio;

	}



	if (data->pdata->psensor_support && data->pdata->gesture_support) {

		dev_err(&client->dev,

			"Unsupport psensor & gesture at the same time\n");

		goto irq_free;

	}

	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support) {

		device_init_wakeup(&client->dev, 1);

		psensor_pdata = devm_kzalloc(&client->dev,
@@ -2001,10 +2310,55 @@ static int ft5x06_ts_probe(struct i2c_client *client, 
			goto unregister_psensor_input_device;

	}



	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support) {

		device_init_wakeup(&client->dev, 1);

		gesture_pdata = devm_kzalloc(&client->dev,

				sizeof(struct ft5x06_gesture_platform_data),

				GFP_KERNEL);

		if (!gesture_pdata) {

			dev_err(&client->dev, "Failed to allocate memory\n");

			goto free_psensor_class_sysfs;

		}

		data->gesture_pdata = gesture_pdata;

		gesture_pdata->data = data;



		gesture_pdata->gesture_class =

					class_create(THIS_MODULE, "gesture");

		if (IS_ERR(gesture_pdata->gesture_class)) {

			err = PTR_ERR(gesture_pdata->gesture_class);

			dev_err(&client->dev, "Failed to create class.\n");

			goto free_gesture_pdata;

		}



		gesture_pdata->dev = device_create(gesture_pdata->gesture_class,

				NULL, 0, NULL, "gesture_ft5x06");

		if (IS_ERR(gesture_pdata->dev)) {

			err = PTR_ERR(gesture_pdata->dev);

			dev_err(&client->dev, "Failed to create device.\n");

			goto free_gesture_class;

		}



		dev_set_drvdata(gesture_pdata->dev, data);

		err = device_create_file(gesture_pdata->dev,

					&dev_attr_enable);

		if (err) {

			dev_err(gesture_pdata->dev,

					"sys file creation failed\n");

			goto free_gesture_dev;

		}

		err = device_create_file(gesture_pdata->dev,

					&dev_attr_pocket);

		if (err) {

			dev_err(gesture_pdata->dev,

					"sys file creation failed\n");

			goto free_enable_sys;

		}

	}



	err = device_create_file(&client->dev, &dev_attr_fw_name);

	if (err) {

		dev_err(&client->dev, "sys file creation failed\n");

		goto free_psensor_class_sysfs;

		goto free_pocket_sys;

	}



	err = device_create_file(&client->dev, &dev_attr_update_fw);
@@ -2113,6 +2467,23 @@ free_update_fw_sys: 
	device_remove_file(&client->dev, &dev_attr_update_fw);

free_fw_name_sys:

	device_remove_file(&client->dev, &dev_attr_fw_name);

free_pocket_sys:

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support)

		device_remove_file(&client->dev, &dev_attr_pocket);

free_enable_sys:

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support)

		device_remove_file(&client->dev, &dev_attr_enable);

free_gesture_dev:

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support)

		device_destroy(gesture_pdata->gesture_class, 0);

free_gesture_class:

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support)

		class_destroy(gesture_pdata->gesture_class);

free_gesture_pdata:

	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support) {

		devm_kfree(&client->dev, gesture_pdata);

		data->gesture_pdata = NULL;

	}

free_psensor_class_sysfs:

	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support)

		sensors_classdev_unregister(&psensor_pdata->ps_cdev);
@@ -2128,7 +2499,11 @@ free_psensor_pdata: 
		data->psensor_pdata = NULL;

	}

irq_free:

	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support)

	if ((ft5x06_psensor_support_enabled() &&

		data->pdata->psensor_support) ||

		(ft5x06_gesture_support_enabled() &&

		data->pdata->gesture_support))



		device_init_wakeup(&client->dev, 0);

	free_irq(client->irq, data);

free_gpio:
@@ -2170,6 +2545,16 @@ static int ft5x06_ts_remove(struct i2c_client *client) 
	struct ft5x06_ts_data *data = i2c_get_clientdata(client);

	int retval;



	if (ft5x06_gesture_support_enabled() && data->pdata->gesture_support) {

		device_init_wakeup(&client->dev, 0);

		device_remove_file(&client->dev, &dev_attr_pocket);

		device_remove_file(&client->dev, &dev_attr_enable);

		device_destroy(data->gesture_pdata->gesture_class, 0);

		class_destroy(data->gesture_pdata->gesture_class);

		devm_kfree(&client->dev, data->gesture_pdata);

		data->gesture_pdata = NULL;

	}



	if (ft5x06_psensor_support_enabled() && data->pdata->psensor_support) {



		device_init_wakeup(&client->dev, 0);

include/linux/input/ft5x06_ts.h

+9 −0
Original line number Diff line number Diff line
@@ -42,6 +42,14 @@ struct ft5x06_psensor_platform_data { 
	struct ft5x06_ts_data *data;

};



struct ft5x06_gesture_platform_data {

	int gesture_enable_to_set;	/* enable/disable gesture */

	int in_pocket;	/* whether in pocket mode or not */

	struct device *dev;

	struct class *gesture_class;

	struct ft5x06_ts_data *data;

};



struct ft5x06_ts_platform_data {

	struct fw_upgrade_info info;

	const char *name;
@@ -69,6 +77,7 @@ struct ft5x06_ts_platform_data { 
	bool i2c_pull_up;

	bool ignore_id_check;

	bool psensor_support;

	bool gesture_support;

	int (*power_init)(bool);

	int (*power_on)(bool);

};