[linux-2.6-block.git] / drivers / input / rmi4 / rmi_2d_sensor.c

/*
 * Copyright (c) 2011-2016 Synaptics Incorporated
 * Copyright (c) 2011 Unixphere
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 */

#include <linux/kernel.h>
#include <linux/device.h>
#include <linux/of.h>
#include <linux/input.h>
#include <linux/input/mt.h>
#include <linux/rmi.h>
#include "rmi_driver.h"
#include "rmi_2d_sensor.h"

#define RMI_2D_REL_POS_MIN		-128
#define RMI_2D_REL_POS_MAX		127

/* maximum ABS_MT_POSITION displacement (in mm) */
#define DMAX 10

void rmi_2d_sensor_abs_process(struct rmi_2d_sensor *sensor,
				struct rmi_2d_sensor_abs_object *obj,
				int slot)
{
	struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;

	/* we keep the previous values if the finger is released */
	if (obj->type == RMI_2D_OBJECT_NONE)
		return;

	if (axis_align->swap_axes)
		swap(obj->x, obj->y);

	if (axis_align->flip_x)
		obj->x = sensor->max_x - obj->x;

	if (axis_align->flip_y)
		obj->y = sensor->max_y - obj->y;

	/*
	 * Here checking if X offset or y offset are specified is
	 * redundant. We just add the offsets or clip the values.
	 *
	 * Note: offsets need to be applied before clipping occurs,
	 * or we could get funny values that are outside of
	 * clipping boundaries.
	 */
	obj->x += axis_align->offset_x;
	obj->y += axis_align->offset_y;

	obj->x =  max(axis_align->clip_x_low, obj->x);
	obj->y =  max(axis_align->clip_y_low, obj->y);

	if (axis_align->clip_x_high)
		obj->x = min(sensor->max_x, obj->x);

	if (axis_align->clip_y_high)
		obj->y =  min(sensor->max_y, obj->y);

	sensor->tracking_pos[slot].x = obj->x;
	sensor->tracking_pos[slot].y = obj->y;
}
EXPORT_SYMBOL_GPL(rmi_2d_sensor_abs_process);

void rmi_2d_sensor_abs_report(struct rmi_2d_sensor *sensor,
				struct rmi_2d_sensor_abs_object *obj,
				int slot)
{
	struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;
	struct input_dev *input = sensor->input;
	int wide, major, minor;

	if (sensor->kernel_tracking)
		input_mt_slot(input, sensor->tracking_slots[slot]);
	else
		input_mt_slot(input, slot);

	input_mt_report_slot_state(input, obj->mt_tool,
				   obj->type != RMI_2D_OBJECT_NONE);

	if (obj->type != RMI_2D_OBJECT_NONE) {
		obj->x = sensor->tracking_pos[slot].x;
		obj->y = sensor->tracking_pos[slot].y;

		if (axis_align->swap_axes)
			swap(obj->wx, obj->wy);

		wide = (obj->wx > obj->wy);
		major = max(obj->wx, obj->wy);
		minor = min(obj->wx, obj->wy);

		if (obj->type == RMI_2D_OBJECT_STYLUS) {
			major = max(1, major);
			minor = max(1, minor);
		}

		input_event(sensor->input, EV_ABS, ABS_MT_POSITION_X, obj->x);
		input_event(sensor->input, EV_ABS, ABS_MT_POSITION_Y, obj->y);
		input_event(sensor->input, EV_ABS, ABS_MT_ORIENTATION, wide);
		input_event(sensor->input, EV_ABS, ABS_MT_PRESSURE, obj->z);
		input_event(sensor->input, EV_ABS, ABS_MT_TOUCH_MAJOR, major);
		input_event(sensor->input, EV_ABS, ABS_MT_TOUCH_MINOR, minor);

		rmi_dbg(RMI_DEBUG_2D_SENSOR, &sensor->input->dev,
			"%s: obj[%d]: type: 0x%02x X: %d Y: %d Z: %d WX: %d WY: %d\n",
			__func__, slot, obj->type, obj->x, obj->y, obj->z,
			obj->wx, obj->wy);
	}
}
EXPORT_SYMBOL_GPL(rmi_2d_sensor_abs_report);

void rmi_2d_sensor_rel_report(struct rmi_2d_sensor *sensor, int x, int y)
{
	struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;

	x = min(RMI_2D_REL_POS_MAX, max(RMI_2D_REL_POS_MIN, (int)x));
	y = min(RMI_2D_REL_POS_MAX, max(RMI_2D_REL_POS_MIN, (int)y));

	if (axis_align->swap_axes)
		swap(x, y);

	if (axis_align->flip_x)
		x = min(RMI_2D_REL_POS_MAX, -x);

	if (axis_align->flip_y)
		y = min(RMI_2D_REL_POS_MAX, -y);

	if (x || y) {
		input_report_rel(sensor->input, REL_X, x);
		input_report_rel(sensor->input, REL_Y, y);
	}
}
EXPORT_SYMBOL_GPL(rmi_2d_sensor_rel_report);

static void rmi_2d_sensor_set_input_params(struct rmi_2d_sensor *sensor)
{
	struct input_dev *input = sensor->input;
	int res_x;
	int res_y;
	int input_flags = 0;

	if (sensor->report_abs) {
		if (sensor->axis_align.swap_axes)
			swap(sensor->max_x, sensor->max_y);

		sensor->min_x = sensor->axis_align.clip_x_low;
		if (sensor->axis_align.clip_x_high)
			sensor->max_x = min(sensor->max_x,
				sensor->axis_align.clip_x_high);

		sensor->min_y = sensor->axis_align.clip_y_low;
		if (sensor->axis_align.clip_y_high)
			sensor->max_y = min(sensor->max_y,
				sensor->axis_align.clip_y_high);

		set_bit(EV_ABS, input->evbit);
		input_set_abs_params(input, ABS_MT_POSITION_X, 0, sensor->max_x,
					0, 0);
		input_set_abs_params(input, ABS_MT_POSITION_Y, 0, sensor->max_y,
					0, 0);

		if (sensor->x_mm && sensor->y_mm) {
			res_x = (sensor->max_x - sensor->min_x) / sensor->x_mm;
			res_y = (sensor->max_y - sensor->min_y) / sensor->y_mm;

			input_abs_set_res(input, ABS_X, res_x);
			input_abs_set_res(input, ABS_Y, res_y);

			input_abs_set_res(input, ABS_MT_POSITION_X, res_x);
			input_abs_set_res(input, ABS_MT_POSITION_Y, res_y);

			if (!sensor->dmax)
				sensor->dmax = DMAX * res_x;
		}

		input_set_abs_params(input, ABS_MT_PRESSURE, 0, 0xff, 0, 0);
		input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 0x0f, 0, 0);
		input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 0x0f, 0, 0);
		input_set_abs_params(input, ABS_MT_ORIENTATION, 0, 1, 0, 0);
		input_set_abs_params(input, ABS_MT_TOOL_TYPE,
				     0, MT_TOOL_MAX, 0, 0);

		if (sensor->sensor_type == rmi_sensor_touchpad)
			input_flags = INPUT_MT_POINTER;
		else
			input_flags = INPUT_MT_DIRECT;

		if (sensor->kernel_tracking)
			input_flags |= INPUT_MT_TRACK;

		input_mt_init_slots(input, sensor->nbr_fingers, input_flags);
	}

	if (sensor->report_rel) {
		set_bit(EV_REL, input->evbit);
		set_bit(REL_X, input->relbit);
		set_bit(REL_Y, input->relbit);
	}

	if (sensor->topbuttonpad)
		set_bit(INPUT_PROP_TOPBUTTONPAD, input->propbit);
}
EXPORT_SYMBOL_GPL(rmi_2d_sensor_set_input_params);

int rmi_2d_sensor_configure_input(struct rmi_function *fn,
					struct rmi_2d_sensor *sensor)
{
	struct rmi_device *rmi_dev = fn->rmi_dev;
	struct rmi_driver_data *drv_data = dev_get_drvdata(&rmi_dev->dev);

	if (!drv_data->input)
		return -ENODEV;

	sensor->input = drv_data->input;
	rmi_2d_sensor_set_input_params(sensor);

	return 0;
}
EXPORT_SYMBOL_GPL(rmi_2d_sensor_configure_input);

#ifdef CONFIG_OF
int rmi_2d_sensor_of_probe(struct device *dev,
			struct rmi_2d_sensor_platform_data *pdata)
{
	int retval;
	u32 val;

	pdata->axis_align.swap_axes = of_property_read_bool(dev->of_node,
						"touchscreen-swapped-x-y");

	pdata->axis_align.flip_x = of_property_read_bool(dev->of_node,
						"touchscreen-inverted-x");

	pdata->axis_align.flip_y = of_property_read_bool(dev->of_node,
						"touchscreen-inverted-y");

	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-x-low", 1);
	if (retval)
		return retval;

	pdata->axis_align.clip_x_low = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-y-low",	1);
	if (retval)
		return retval;

	pdata->axis_align.clip_y_low = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-x-high", 1);
	if (retval)
		return retval;

	pdata->axis_align.clip_x_high = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-y-high", 1);
	if (retval)
		return retval;

	pdata->axis_align.clip_y_high = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,offset-x", 1);
	if (retval)
		return retval;

	pdata->axis_align.offset_x = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,offset-y", 1);
	if (retval)
		return retval;

	pdata->axis_align.offset_y = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,delta-x-threshold",
						1);
	if (retval)
		return retval;

	pdata->axis_align.delta_x_threshold = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,delta-y-threshold",
						1);
	if (retval)
		return retval;

	pdata->axis_align.delta_y_threshold = val;

	retval = rmi_of_property_read_u32(dev, (u32 *)&pdata->sensor_type,
			"syna,sensor-type", 1);
	if (retval)
		return retval;

	retval = rmi_of_property_read_u32(dev, &val, "touchscreen-x-mm", 1);
	if (retval)
		return retval;

	pdata->x_mm = val;

	retval = rmi_of_property_read_u32(dev, &val, "touchscreen-y-mm", 1);
	if (retval)
		return retval;

	pdata->y_mm = val;

	retval = rmi_of_property_read_u32(dev, &val,
				"syna,disable-report-mask", 1);
	if (retval)
		return retval;

	pdata->disable_report_mask = val;

	retval = rmi_of_property_read_u32(dev, &val, "syna,rezero-wait-ms",
						1);
	if (retval)
		return retval;

	pdata->rezero_wait = val;

	return 0;
}
#else
inline int rmi_2d_sensor_of_probe(struct device *dev,
			struct rmi_2d_sensor_platform_data *pdata)
{
	return -ENODEV;
}
#endif
EXPORT_SYMBOL_GPL(rmi_2d_sensor_of_probe);
Commit	Line	Data
ff8f8370 AD	1	/*
	2	* Copyright (c) 2011-2016 Synaptics Incorporated
	3	* Copyright (c) 2011 Unixphere
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms of the GNU General Public License version 2 as published by
	7	* the Free Software Foundation.
	8	*/
	9
	10	#include <linux/kernel.h>
	11	#include <linux/device.h>
	12	#include <linux/of.h>
	13	#include <linux/input.h>
	14	#include <linux/input/mt.h>
	15	#include <linux/rmi.h>
	16	#include "rmi_driver.h"
	17	#include "rmi_2d_sensor.h"
	18
	19	#define RMI_2D_REL_POS_MIN -128
	20	#define RMI_2D_REL_POS_MAX 127
	21
	22	/* maximum ABS_MT_POSITION displacement (in mm) */
	23	#define DMAX 10
	24
	25	void rmi_2d_sensor_abs_process(struct rmi_2d_sensor *sensor,
	26	struct rmi_2d_sensor_abs_object *obj,
	27	int slot)
	28	{
	29	struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;
	30
	31	/* we keep the previous values if the finger is released */
	32	if (obj->type == RMI_2D_OBJECT_NONE)
	33	return;
	34
	35	if (axis_align->swap_axes)
	36	swap(obj->x, obj->y);
	37
	38	if (axis_align->flip_x)
	39	obj->x = sensor->max_x - obj->x;
	40
	41	if (axis_align->flip_y)
	42	obj->y = sensor->max_y - obj->y;
	43
	44	/*
	45	* Here checking if X offset or y offset are specified is
	46	* redundant. We just add the offsets or clip the values.
	47	*
	48	* Note: offsets need to be applied before clipping occurs,
	49	* or we could get funny values that are outside of
	50	* clipping boundaries.
	51	*/
	52	obj->x += axis_align->offset_x;
	53	obj->y += axis_align->offset_y;
	54
	55	obj->x = max(axis_align->clip_x_low, obj->x);
	56	obj->y = max(axis_align->clip_y_low, obj->y);
	57
	58	if (axis_align->clip_x_high)
	59	obj->x = min(sensor->max_x, obj->x);
	60
	61	if (axis_align->clip_y_high)
	62	obj->y = min(sensor->max_y, obj->y);
	63
	64	sensor->tracking_pos[slot].x = obj->x;
65	sensor->tracking_pos[slot].y = obj->y;
66	}
67	EXPORT_SYMBOL_GPL(rmi_2d_sensor_abs_process);
68
69	void rmi_2d_sensor_abs_report(struct rmi_2d_sensor *sensor,
70	struct rmi_2d_sensor_abs_object *obj,
71	int slot)
72	{
73	struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;
74	struct input_dev *input = sensor->input;
75	int wide, major, minor;
76
77	if (sensor->kernel_tracking)
78	input_mt_slot(input, sensor->tracking_slots[slot]);
79	else
80	input_mt_slot(input, slot);
81
82	input_mt_report_slot_state(input, obj->mt_tool,
83	obj->type != RMI_2D_OBJECT_NONE);
84
85	if (obj->type != RMI_2D_OBJECT_NONE) {
86	obj->x = sensor->tracking_pos[slot].x;
87	obj->y = sensor->tracking_pos[slot].y;
88
89	if (axis_align->swap_axes)
90	swap(obj->wx, obj->wy);
91
92	wide = (obj->wx > obj->wy);
93	major = max(obj->wx, obj->wy);
94	minor = min(obj->wx, obj->wy);
95
96	if (obj->type == RMI_2D_OBJECT_STYLUS) {
97	major = max(1, major);
98	minor = max(1, minor);
99	}
100
101	input_event(sensor->input, EV_ABS, ABS_MT_POSITION_X, obj->x);
102	input_event(sensor->input, EV_ABS, ABS_MT_POSITION_Y, obj->y);
103	input_event(sensor->input, EV_ABS, ABS_MT_ORIENTATION, wide);
104	input_event(sensor->input, EV_ABS, ABS_MT_PRESSURE, obj->z);
105	input_event(sensor->input, EV_ABS, ABS_MT_TOUCH_MAJOR, major);
106	input_event(sensor->input, EV_ABS, ABS_MT_TOUCH_MINOR, minor);
107
108	rmi_dbg(RMI_DEBUG_2D_SENSOR, &sensor->input->dev,
109	"%s: obj[%d]: type: 0x%02x X: %d Y: %d Z: %d WX: %d WY: %d\n",
110	__func__, slot, obj->type, obj->x, obj->y, obj->z,
111	obj->wx, obj->wy);
112	}
113	}
114	EXPORT_SYMBOL_GPL(rmi_2d_sensor_abs_report);
115
116	void rmi_2d_sensor_rel_report(struct rmi_2d_sensor *sensor, int x, int y)
117	{
118	struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;
119
120	x = min(RMI_2D_REL_POS_MAX, max(RMI_2D_REL_POS_MIN, (int)x));
121	y = min(RMI_2D_REL_POS_MAX, max(RMI_2D_REL_POS_MIN, (int)y));
122
123	if (axis_align->swap_axes)
124	swap(x, y);
125
126	if (axis_align->flip_x)
127	x = min(RMI_2D_REL_POS_MAX, -x);
128
129	if (axis_align->flip_y)
130	y = min(RMI_2D_REL_POS_MAX, -y);
131
132	if (x \|\| y) {
133	input_report_rel(sensor->input, REL_X, x);
134	input_report_rel(sensor->input, REL_Y, y);
135	}
136	}
137	EXPORT_SYMBOL_GPL(rmi_2d_sensor_rel_report);
138
139	static void rmi_2d_sensor_set_input_params(struct rmi_2d_sensor *sensor)
140	{
141	struct input_dev *input = sensor->input;
142	int res_x;
143	int res_y;
144	int input_flags = 0;
145
146	if (sensor->report_abs) {
147	if (sensor->axis_align.swap_axes)
148	swap(sensor->max_x, sensor->max_y);
149
150	sensor->min_x = sensor->axis_align.clip_x_low;
151	if (sensor->axis_align.clip_x_high)
152	sensor->max_x = min(sensor->max_x,
153	sensor->axis_align.clip_x_high);
154
155	sensor->min_y = sensor->axis_align.clip_y_low;
156	if (sensor->axis_align.clip_y_high)
157	sensor->max_y = min(sensor->max_y,
158	sensor->axis_align.clip_y_high);
159
160	set_bit(EV_ABS, input->evbit);
161	input_set_abs_params(input, ABS_MT_POSITION_X, 0, sensor->max_x,
162	0, 0);
163	input_set_abs_params(input, ABS_MT_POSITION_Y, 0, sensor->max_y,
164	0, 0);
165
166	if (sensor->x_mm && sensor->y_mm) {
167	res_x = (sensor->max_x - sensor->min_x) / sensor->x_mm;
168	res_y = (sensor->max_y - sensor->min_y) / sensor->y_mm;
169
170	input_abs_set_res(input, ABS_X, res_x);
171	input_abs_set_res(input, ABS_Y, res_y);
172
173	input_abs_set_res(input, ABS_MT_POSITION_X, res_x);
174	input_abs_set_res(input, ABS_MT_POSITION_Y, res_y);
175
176	if (!sensor->dmax)
177	sensor->dmax = DMAX * res_x;
178	}
179
332c3988 AD	180	input_set_abs_params(input, ABS_MT_PRESSURE, 0, 0xff, 0, 0);
	181	input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 0x0f, 0, 0);
	182	input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 0x0f, 0, 0);
	183	input_set_abs_params(input, ABS_MT_ORIENTATION, 0, 1, 0, 0);
	184	input_set_abs_params(input, ABS_MT_TOOL_TYPE,
	185	0, MT_TOOL_MAX, 0, 0);
ff8f8370 AD	186
	187	if (sensor->sensor_type == rmi_sensor_touchpad)
	188	input_flags = INPUT_MT_POINTER;
	189	else
	190	input_flags = INPUT_MT_DIRECT;
	191
	192	if (sensor->kernel_tracking)
	193	input_flags \|= INPUT_MT_TRACK;
	194
	195	input_mt_init_slots(input, sensor->nbr_fingers, input_flags);
	196	}
	197
	198	if (sensor->report_rel) {
	199	set_bit(EV_REL, input->evbit);
	200	set_bit(REL_X, input->relbit);
	201	set_bit(REL_Y, input->relbit);
	202	}
	203
	204	if (sensor->topbuttonpad)
	205	set_bit(INPUT_PROP_TOPBUTTONPAD, input->propbit);
	206	}
	207	EXPORT_SYMBOL_GPL(rmi_2d_sensor_set_input_params);
	208
	209	int rmi_2d_sensor_configure_input(struct rmi_function *fn,
	210	struct rmi_2d_sensor *sensor)
	211	{
	212	struct rmi_device *rmi_dev = fn->rmi_dev;
	213	struct rmi_driver_data *drv_data = dev_get_drvdata(&rmi_dev->dev);
	214
	215	if (!drv_data->input)
	216	return -ENODEV;
	217
	218	sensor->input = drv_data->input;
	219	rmi_2d_sensor_set_input_params(sensor);
	220
	221	return 0;
	222	}
	223	EXPORT_SYMBOL_GPL(rmi_2d_sensor_configure_input);
aaa27982 AD	224
	225	#ifdef CONFIG_OF
	226	int rmi_2d_sensor_of_probe(struct device *dev,
	227	struct rmi_2d_sensor_platform_data *pdata)
	228	{
	229	int retval;
	230	u32 val;
	231
	232	pdata->axis_align.swap_axes = of_property_read_bool(dev->of_node,
	233	"touchscreen-swapped-x-y");
	234
	235	pdata->axis_align.flip_x = of_property_read_bool(dev->of_node,
	236	"touchscreen-inverted-x");
	237
	238	pdata->axis_align.flip_y = of_property_read_bool(dev->of_node,
	239	"touchscreen-inverted-y");
	240
	241	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-x-low", 1);
	242	if (retval)
	243	return retval;
	244
	245	pdata->axis_align.clip_x_low = val;
	246
	247	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-y-low", 1);
	248	if (retval)
	249	return retval;
	250
	251	pdata->axis_align.clip_y_low = val;
	252
	253	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-x-high", 1);
	254	if (retval)
	255	return retval;
	256
	257	pdata->axis_align.clip_x_high = val;
	258
	259	retval = rmi_of_property_read_u32(dev, &val, "syna,clip-y-high", 1);
	260	if (retval)
	261	return retval;
	262
	263	pdata->axis_align.clip_y_high = val;
	264
	265	retval = rmi_of_property_read_u32(dev, &val, "syna,offset-x", 1);
	266	if (retval)
	267	return retval;
	268
	269	pdata->axis_align.offset_x = val;
	270
	271	retval = rmi_of_property_read_u32(dev, &val, "syna,offset-y", 1);
	272	if (retval)
	273	return retval;
	274
	275	pdata->axis_align.offset_y = val;
	276
	277	retval = rmi_of_property_read_u32(dev, &val, "syna,delta-x-threshold",
	278	1);
	279	if (retval)
	280	return retval;
	281
	282	pdata->axis_align.delta_x_threshold = val;
	283
	284	retval = rmi_of_property_read_u32(dev, &val, "syna,delta-y-threshold",
	285	1);
	286	if (retval)
	287	return retval;
288
289	pdata->axis_align.delta_y_threshold = val;
290
291	retval = rmi_of_property_read_u32(dev, (u32 *)&pdata->sensor_type,
292	"syna,sensor-type", 1);
293	if (retval)
294	return retval;
295
296	retval = rmi_of_property_read_u32(dev, &val, "touchscreen-x-mm", 1);
297	if (retval)
298	return retval;
299
300	pdata->x_mm = val;
301
302	retval = rmi_of_property_read_u32(dev, &val, "touchscreen-y-mm", 1);
303	if (retval)
304	return retval;
305
306	pdata->y_mm = val;
307
308	retval = rmi_of_property_read_u32(dev, &val,
309	"syna,disable-report-mask", 1);
310	if (retval)
311	return retval;
312
313	pdata->disable_report_mask = val;
314
315	retval = rmi_of_property_read_u32(dev, &val, "syna,rezero-wait-ms",
316	1);
317	if (retval)
318	return retval;
319
320	pdata->rezero_wait = val;
321
322	return 0;
323	}
324	#else
325	inline int rmi_2d_sensor_of_probe(struct device *dev,
326	struct rmi_2d_sensor_platform_data *pdata)
327	{
328	return -ENODEV;
329	}
330	#endif
331	EXPORT_SYMBOL_GPL(rmi_2d_sensor_of_probe);