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

source code of linux/drivers/input/rmi4/rmi_2d_sensor.c