1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (c) 2011-2015 Synaptics Incorporated
4 * Copyright (c) 2011 Unixphere
5 */
6
7#include <linux/kernel.h>
8#include <linux/delay.h>
9#include <linux/device.h>
10#include <linux/input.h>
11#include <linux/input/mt.h>
12#include <linux/rmi.h>
13#include <linux/slab.h>
14#include <linux/of.h>
15#include "rmi_driver.h"
16#include "rmi_2d_sensor.h"
17
18#define F11_MAX_NUM_OF_FINGERS 10
19#define F11_MAX_NUM_OF_TOUCH_SHAPES 16
20
21#define FINGER_STATE_MASK 0x03
22
23#define F11_CTRL_SENSOR_MAX_X_POS_OFFSET 6
24#define F11_CTRL_SENSOR_MAX_Y_POS_OFFSET 8
25
26#define DEFAULT_XY_MAX 9999
27#define DEFAULT_MAX_ABS_MT_PRESSURE 255
28#define DEFAULT_MAX_ABS_MT_TOUCH 15
29#define DEFAULT_MAX_ABS_MT_ORIENTATION 1
30#define DEFAULT_MIN_ABS_MT_TRACKING_ID 1
31#define DEFAULT_MAX_ABS_MT_TRACKING_ID 10
32
33/*
34 * A note about RMI4 F11 register structure.
35 *
36 * The properties for a given sensor are described by its query registers. The
37 * number of query registers and the layout of their contents are described by
38 * the F11 device queries as well as the sensor query information.
39 *
40 * Similarly, each sensor has control registers that govern its behavior. The
41 * size and layout of the control registers for a given sensor can be determined
42 * by parsing that sensors query registers.
43 *
44 * And in a likewise fashion, each sensor has data registers where it reports
45 * its touch data and other interesting stuff. The size and layout of a
46 * sensors data registers must be determined by parsing its query registers.
47 *
48 * The short story is that we need to read and parse a lot of query
49 * registers in order to determine the attributes of a sensor. Then
50 * we need to use that data to compute the size of the control and data
51 * registers for sensor.
52 *
53 * The end result is that we have a number of structs that aren't used to
54 * directly generate the input events, but their size, location and contents
55 * are critical to determining where the data we are interested in lives.
56 *
57 * At this time, the driver does not yet comprehend all possible F11
58 * configuration options, but it should be sufficient to cover 99% of RMI4 F11
59 * devices currently in the field.
60 */
61
62/* maximum ABS_MT_POSITION displacement (in mm) */
63#define DMAX 10
64
65/*
66 * Writing this to the F11 command register will cause the sensor to
67 * calibrate to the current capacitive state.
68 */
69#define RMI_F11_REZERO 0x01
70
71#define RMI_F11_HAS_QUERY9 (1 << 3)
72#define RMI_F11_HAS_QUERY11 (1 << 4)
73#define RMI_F11_HAS_QUERY12 (1 << 5)
74#define RMI_F11_HAS_QUERY27 (1 << 6)
75#define RMI_F11_HAS_QUERY28 (1 << 7)
76
77/** Defs for Query 1 */
78
79#define RMI_F11_NR_FINGERS_MASK 0x07
80#define RMI_F11_HAS_REL (1 << 3)
81#define RMI_F11_HAS_ABS (1 << 4)
82#define RMI_F11_HAS_GESTURES (1 << 5)
83#define RMI_F11_HAS_SENSITIVITY_ADJ (1 << 6)
84#define RMI_F11_CONFIGURABLE (1 << 7)
85
86/** Defs for Query 2, 3, and 4. */
87#define RMI_F11_NR_ELECTRODES_MASK 0x7F
88
89/** Defs for Query 5 */
90
91#define RMI_F11_ABS_DATA_SIZE_MASK 0x03
92#define RMI_F11_HAS_ANCHORED_FINGER (1 << 2)
93#define RMI_F11_HAS_ADJ_HYST (1 << 3)
94#define RMI_F11_HAS_DRIBBLE (1 << 4)
95#define RMI_F11_HAS_BENDING_CORRECTION (1 << 5)
96#define RMI_F11_HAS_LARGE_OBJECT_SUPPRESSION (1 << 6)
97#define RMI_F11_HAS_JITTER_FILTER (1 << 7)
98
99/** Defs for Query 7 */
100#define RMI_F11_HAS_SINGLE_TAP (1 << 0)
101#define RMI_F11_HAS_TAP_AND_HOLD (1 << 1)
102#define RMI_F11_HAS_DOUBLE_TAP (1 << 2)
103#define RMI_F11_HAS_EARLY_TAP (1 << 3)
104#define RMI_F11_HAS_FLICK (1 << 4)
105#define RMI_F11_HAS_PRESS (1 << 5)
106#define RMI_F11_HAS_PINCH (1 << 6)
107#define RMI_F11_HAS_CHIRAL (1 << 7)
108
109/** Defs for Query 8 */
110#define RMI_F11_HAS_PALM_DET (1 << 0)
111#define RMI_F11_HAS_ROTATE (1 << 1)
112#define RMI_F11_HAS_TOUCH_SHAPES (1 << 2)
113#define RMI_F11_HAS_SCROLL_ZONES (1 << 3)
114#define RMI_F11_HAS_INDIVIDUAL_SCROLL_ZONES (1 << 4)
115#define RMI_F11_HAS_MF_SCROLL (1 << 5)
116#define RMI_F11_HAS_MF_EDGE_MOTION (1 << 6)
117#define RMI_F11_HAS_MF_SCROLL_INERTIA (1 << 7)
118
119/** Defs for Query 9. */
120#define RMI_F11_HAS_PEN (1 << 0)
121#define RMI_F11_HAS_PROXIMITY (1 << 1)
122#define RMI_F11_HAS_PALM_DET_SENSITIVITY (1 << 2)
123#define RMI_F11_HAS_SUPPRESS_ON_PALM_DETECT (1 << 3)
124#define RMI_F11_HAS_TWO_PEN_THRESHOLDS (1 << 4)
125#define RMI_F11_HAS_CONTACT_GEOMETRY (1 << 5)
126#define RMI_F11_HAS_PEN_HOVER_DISCRIMINATION (1 << 6)
127#define RMI_F11_HAS_PEN_FILTERS (1 << 7)
128
129/** Defs for Query 10. */
130#define RMI_F11_NR_TOUCH_SHAPES_MASK 0x1F
131
132/** Defs for Query 11 */
133
134#define RMI_F11_HAS_Z_TUNING (1 << 0)
135#define RMI_F11_HAS_ALGORITHM_SELECTION (1 << 1)
136#define RMI_F11_HAS_W_TUNING (1 << 2)
137#define RMI_F11_HAS_PITCH_INFO (1 << 3)
138#define RMI_F11_HAS_FINGER_SIZE (1 << 4)
139#define RMI_F11_HAS_SEGMENTATION_AGGRESSIVENESS (1 << 5)
140#define RMI_F11_HAS_XY_CLIP (1 << 6)
141#define RMI_F11_HAS_DRUMMING_FILTER (1 << 7)
142
143/** Defs for Query 12. */
144
145#define RMI_F11_HAS_GAPLESS_FINGER (1 << 0)
146#define RMI_F11_HAS_GAPLESS_FINGER_TUNING (1 << 1)
147#define RMI_F11_HAS_8BIT_W (1 << 2)
148#define RMI_F11_HAS_ADJUSTABLE_MAPPING (1 << 3)
149#define RMI_F11_HAS_INFO2 (1 << 4)
150#define RMI_F11_HAS_PHYSICAL_PROPS (1 << 5)
151#define RMI_F11_HAS_FINGER_LIMIT (1 << 6)
152#define RMI_F11_HAS_LINEAR_COEFF (1 << 7)
153
154/** Defs for Query 13. */
155
156#define RMI_F11_JITTER_WINDOW_MASK 0x1F
157#define RMI_F11_JITTER_FILTER_MASK 0x60
158#define RMI_F11_JITTER_FILTER_SHIFT 5
159
160/** Defs for Query 14. */
161#define RMI_F11_LIGHT_CONTROL_MASK 0x03
162#define RMI_F11_IS_CLEAR (1 << 2)
163#define RMI_F11_CLICKPAD_PROPS_MASK 0x18
164#define RMI_F11_CLICKPAD_PROPS_SHIFT 3
165#define RMI_F11_MOUSE_BUTTONS_MASK 0x60
166#define RMI_F11_MOUSE_BUTTONS_SHIFT 5
167#define RMI_F11_HAS_ADVANCED_GESTURES (1 << 7)
168
169#define RMI_F11_QUERY_SIZE 4
170#define RMI_F11_QUERY_GESTURE_SIZE 2
171
172#define F11_LIGHT_CTL_NONE 0x00
173#define F11_LUXPAD 0x01
174#define F11_DUAL_MODE 0x02
175
176#define F11_NOT_CLICKPAD 0x00
177#define F11_HINGED_CLICKPAD 0x01
178#define F11_UNIFORM_CLICKPAD 0x02
179
180/**
181 * struct f11_2d_sensor_queries - describes sensor capabilities
182 *
183 * Query registers 1 through 4 are always present.
184 *
185 * @nr_fingers: describes the maximum number of fingers the 2-D sensor
186 * supports.
187 * @has_rel: the sensor supports relative motion reporting.
188 * @has_abs: the sensor supports absolute poition reporting.
189 * @has_gestures: the sensor supports gesture reporting.
190 * @has_sensitivity_adjust: the sensor supports a global sensitivity
191 * adjustment.
192 * @configurable: the sensor supports various configuration options.
193 * @nr_x_electrodes: the maximum number of electrodes the 2-D sensor
194 * supports on the X axis.
195 * @nr_y_electrodes: the maximum number of electrodes the 2-D sensor
196 * supports on the Y axis.
197 * @max_electrodes: the total number of X and Y electrodes that may be
198 * configured.
199 *
200 * Query 5 is present if the has_abs bit is set.
201 *
202 * @abs_data_size: describes the format of data reported by the absolute
203 * data source. Only one format (the kind used here) is supported at this
204 * time.
205 * @has_anchored_finger: then the sensor supports the high-precision second
206 * finger tracking provided by the manual tracking and motion sensitivity
207 * options.
208 * @has_adj_hyst: the difference between the finger release threshold and
209 * the touch threshold.
210 * @has_dribble: the sensor supports the generation of dribble interrupts,
211 * which may be enabled or disabled with the dribble control bit.
212 * @has_bending_correction: Bending related data registers 28 and 36, and
213 * control register 52..57 are present.
214 * @has_large_object_suppression: control register 58 and data register 28
215 * exist.
216 * @has_jitter_filter: query 13 and control 73..76 exist.
217 *
218 * Query 6 is present if the has_rel it is set.
219 *
220 * @f11_2d_query6: this register is reserved.
221 *
222 * Gesture information queries 7 and 8 are present if has_gestures bit is set.
223 *
224 * @has_single_tap: a basic single-tap gesture is supported.
225 * @has_tap_n_hold: tap-and-hold gesture is supported.
226 * @has_double_tap: double-tap gesture is supported.
227 * @has_early_tap: early tap is supported and reported as soon as the finger
228 * lifts for any tap event that could be interpreted as either a single
229 * tap or as the first tap of a double-tap or tap-and-hold gesture.
230 * @has_flick: flick detection is supported.
231 * @has_press: press gesture reporting is supported.
232 * @has_pinch: pinch gesture detection is supported.
233 * @has_chiral: chiral (circular) scrolling gesture detection is supported.
234 * @has_palm_det: the 2-D sensor notifies the host whenever a large conductive
235 * object such as a palm or a cheek touches the 2-D sensor.
236 * @has_rotate: rotation gesture detection is supported.
237 * @has_touch_shapes: TouchShapes are supported. A TouchShape is a fixed
238 * rectangular area on the sensor that behaves like a capacitive button.
239 * @has_scroll_zones: scrolling areas near the sensor edges are supported.
240 * @has_individual_scroll_zones: if 1, then 4 scroll zones are supported;
241 * if 0, then only two are supported.
242 * @has_mf_scroll: the multifinger_scrolling bit will be set when
243 * more than one finger is involved in a scrolling action.
244 * @has_mf_edge_motion: indicates whether multi-finger edge motion gesture
245 * is supported.
246 * @has_mf_scroll_inertia: indicates whether multi-finger scroll inertia
247 * feature is supported.
248 *
249 * Convenience for checking bytes in the gesture info registers. This is done
250 * often enough that we put it here to declutter the conditionals
251 *
252 * @query7_nonzero: true if none of the query 7 bits are set
253 * @query8_nonzero: true if none of the query 8 bits are set
254 *
255 * Query 9 is present if the has_query9 is set.
256 *
257 * @has_pen: detection of a stylus is supported and registers F11_2D_Ctrl20
258 * and F11_2D_Ctrl21 exist.
259 * @has_proximity: detection of fingers near the sensor is supported and
260 * registers F11_2D_Ctrl22 through F11_2D_Ctrl26 exist.
261 * @has_palm_det_sensitivity: the sensor supports the palm detect sensitivity
262 * feature and register F11_2D_Ctrl27 exists.
263 * @has_suppress_on_palm_detect: the device supports the large object detect
264 * suppression feature and register F11_2D_Ctrl27 exists.
265 * @has_two_pen_thresholds: if has_pen is also set, then F11_2D_Ctrl35 exists.
266 * @has_contact_geometry: the sensor supports the use of contact geometry to
267 * map absolute X and Y target positions and registers F11_2D_Data18
268 * through F11_2D_Data27 exist.
269 * @has_pen_hover_discrimination: if has_pen is also set, then registers
270 * F11_2D_Data29 through F11_2D_Data31, F11_2D_Ctrl68.*, F11_2D_Ctrl69
271 * and F11_2D_Ctrl72 exist.
272 * @has_pen_filters: if has_pen is also set, then registers F11_2D_Ctrl70 and
273 * F11_2D_Ctrl71 exist.
274 *
275 * Touch shape info (query 10) is present if has_touch_shapes is set.
276 *
277 * @nr_touch_shapes: the total number of touch shapes supported.
278 *
279 * Query 11 is present if the has_query11 bit is set in query 0.
280 *
281 * @has_z_tuning: if set, the sensor supports Z tuning and registers
282 * F11_2D_Ctrl29 through F11_2D_Ctrl33 exist.
283 * @has_algorithm_selection: controls choice of noise suppression algorithm
284 * @has_w_tuning: the sensor supports Wx and Wy scaling and registers
285 * F11_2D_Ctrl36 through F11_2D_Ctrl39 exist.
286 * @has_pitch_info: the X and Y pitches of the sensor electrodes can be
287 * configured and registers F11_2D_Ctrl40 and F11_2D_Ctrl41 exist.
288 * @has_finger_size: the default finger width settings for the sensor
289 * can be configured and registers F11_2D_Ctrl42 through F11_2D_Ctrl44
290 * exist.
291 * @has_segmentation_aggressiveness: the sensor’s ability to distinguish
292 * multiple objects close together can be configured and register
293 * F11_2D_Ctrl45 exists.
294 * @has_XY_clip: the inactive outside borders of the sensor can be
295 * configured and registers F11_2D_Ctrl46 through F11_2D_Ctrl49 exist.
296 * @has_drumming_filter: the sensor can be configured to distinguish
297 * between a fast flick and a quick drumming movement and registers
298 * F11_2D_Ctrl50 and F11_2D_Ctrl51 exist.
299 *
300 * Query 12 is present if hasQuery12 bit is set.
301 *
302 * @has_gapless_finger: control registers relating to gapless finger are
303 * present.
304 * @has_gapless_finger_tuning: additional control and data registers relating
305 * to gapless finger are present.
306 * @has_8bit_w: larger W value reporting is supported.
307 * @has_adjustable_mapping: TBD
308 * @has_info2: the general info query14 is present
309 * @has_physical_props: additional queries describing the physical properties
310 * of the sensor are present.
311 * @has_finger_limit: indicates that F11 Ctrl 80 exists.
312 * @has_linear_coeff_2: indicates that F11 Ctrl 81 exists.
313 *
314 * Query 13 is present if Query 5's has_jitter_filter bit is set.
315 *
316 * @jitter_window_size: used by Design Studio 4.
317 * @jitter_filter_type: used by Design Studio 4.
318 *
319 * Query 14 is present if query 12's has_general_info2 flag is set.
320 *
321 * @light_control: Indicates what light/led control features are present,
322 * if any.
323 * @is_clear: if set, this is a clear sensor (indicating direct pointing
324 * application), otherwise it's opaque (indicating indirect pointing).
325 * @clickpad_props: specifies if this is a clickpad, and if so what sort of
326 * mechanism it uses
327 * @mouse_buttons: specifies the number of mouse buttons present (if any).
328 * @has_advanced_gestures: advanced driver gestures are supported.
329 *
330 * @x_sensor_size_mm: size of the sensor in millimeters on the X axis.
331 * @y_sensor_size_mm: size of the sensor in millimeters on the Y axis.
332 */
333struct f11_2d_sensor_queries {
334 /* query1 */
335 u8 nr_fingers;
336 bool has_rel;
337 bool has_abs;
338 bool has_gestures;
339 bool has_sensitivity_adjust;
340 bool configurable;
341
342 /* query2 */
343 u8 nr_x_electrodes;
344
345 /* query3 */
346 u8 nr_y_electrodes;
347
348 /* query4 */
349 u8 max_electrodes;
350
351 /* query5 */
352 u8 abs_data_size;
353 bool has_anchored_finger;
354 bool has_adj_hyst;
355 bool has_dribble;
356 bool has_bending_correction;
357 bool has_large_object_suppression;
358 bool has_jitter_filter;
359
360 u8 f11_2d_query6;
361
362 /* query 7 */
363 bool has_single_tap;
364 bool has_tap_n_hold;
365 bool has_double_tap;
366 bool has_early_tap;
367 bool has_flick;
368 bool has_press;
369 bool has_pinch;
370 bool has_chiral;
371
372 bool query7_nonzero;
373
374 /* query 8 */
375 bool has_palm_det;
376 bool has_rotate;
377 bool has_touch_shapes;
378 bool has_scroll_zones;
379 bool has_individual_scroll_zones;
380 bool has_mf_scroll;
381 bool has_mf_edge_motion;
382 bool has_mf_scroll_inertia;
383
384 bool query8_nonzero;
385
386 /* Query 9 */
387 bool has_pen;
388 bool has_proximity;
389 bool has_palm_det_sensitivity;
390 bool has_suppress_on_palm_detect;
391 bool has_two_pen_thresholds;
392 bool has_contact_geometry;
393 bool has_pen_hover_discrimination;
394 bool has_pen_filters;
395
396 /* Query 10 */
397 u8 nr_touch_shapes;
398
399 /* Query 11. */
400 bool has_z_tuning;
401 bool has_algorithm_selection;
402 bool has_w_tuning;
403 bool has_pitch_info;
404 bool has_finger_size;
405 bool has_segmentation_aggressiveness;
406 bool has_XY_clip;
407 bool has_drumming_filter;
408
409 /* Query 12 */
410 bool has_gapless_finger;
411 bool has_gapless_finger_tuning;
412 bool has_8bit_w;
413 bool has_adjustable_mapping;
414 bool has_info2;
415 bool has_physical_props;
416 bool has_finger_limit;
417 bool has_linear_coeff_2;
418
419 /* Query 13 */
420 u8 jitter_window_size;
421 u8 jitter_filter_type;
422
423 /* Query 14 */
424 u8 light_control;
425 bool is_clear;
426 u8 clickpad_props;
427 u8 mouse_buttons;
428 bool has_advanced_gestures;
429
430 /* Query 15 - 18 */
431 u16 x_sensor_size_mm;
432 u16 y_sensor_size_mm;
433};
434
435/* Defs for Ctrl0. */
436#define RMI_F11_REPORT_MODE_MASK 0x07
437#define RMI_F11_REPORT_MODE_CONTINUOUS (0 << 0)
438#define RMI_F11_REPORT_MODE_REDUCED (1 << 0)
439#define RMI_F11_REPORT_MODE_FS_CHANGE (2 << 0)
440#define RMI_F11_REPORT_MODE_FP_CHANGE (3 << 0)
441#define RMI_F11_ABS_POS_FILT (1 << 3)
442#define RMI_F11_REL_POS_FILT (1 << 4)
443#define RMI_F11_REL_BALLISTICS (1 << 5)
444#define RMI_F11_DRIBBLE (1 << 6)
445#define RMI_F11_REPORT_BEYOND_CLIP (1 << 7)
446
447/* Defs for Ctrl1. */
448#define RMI_F11_PALM_DETECT_THRESH_MASK 0x0F
449#define RMI_F11_MOTION_SENSITIVITY_MASK 0x30
450#define RMI_F11_MANUAL_TRACKING (1 << 6)
451#define RMI_F11_MANUAL_TRACKED_FINGER (1 << 7)
452
453#define RMI_F11_DELTA_X_THRESHOLD 2
454#define RMI_F11_DELTA_Y_THRESHOLD 3
455
456#define RMI_F11_CTRL_REG_COUNT 12
457
458struct f11_2d_ctrl {
459 u8 ctrl0_11[RMI_F11_CTRL_REG_COUNT];
460 u16 ctrl0_11_address;
461};
462
463#define RMI_F11_ABS_BYTES 5
464#define RMI_F11_REL_BYTES 2
465
466/* Defs for Data 8 */
467
468#define RMI_F11_SINGLE_TAP (1 << 0)
469#define RMI_F11_TAP_AND_HOLD (1 << 1)
470#define RMI_F11_DOUBLE_TAP (1 << 2)
471#define RMI_F11_EARLY_TAP (1 << 3)
472#define RMI_F11_FLICK (1 << 4)
473#define RMI_F11_PRESS (1 << 5)
474#define RMI_F11_PINCH (1 << 6)
475
476/* Defs for Data 9 */
477
478#define RMI_F11_PALM_DETECT (1 << 0)
479#define RMI_F11_ROTATE (1 << 1)
480#define RMI_F11_SHAPE (1 << 2)
481#define RMI_F11_SCROLLZONE (1 << 3)
482#define RMI_F11_GESTURE_FINGER_COUNT_MASK 0x70
483
484/** Handy pointers into our data buffer.
485 *
486 * @f_state - start of finger state registers.
487 * @abs_pos - start of absolute position registers (if present).
488 * @rel_pos - start of relative data registers (if present).
489 * @gest_1 - gesture flags (if present).
490 * @gest_2 - gesture flags & finger count (if present).
491 * @pinch - pinch motion register (if present).
492 * @flick - flick distance X & Y, flick time (if present).
493 * @rotate - rotate motion and finger separation.
494 * @multi_scroll - chiral deltas for X and Y (if present).
495 * @scroll_zones - scroll deltas for 4 regions (if present).
496 */
497struct f11_2d_data {
498 u8 *f_state;
499 u8 *abs_pos;
500 s8 *rel_pos;
501 u8 *gest_1;
502 u8 *gest_2;
503 s8 *pinch;
504 u8 *flick;
505 u8 *rotate;
506 u8 *shapes;
507 s8 *multi_scroll;
508 s8 *scroll_zones;
509};
510
511/** Data pertaining to F11 in general. For per-sensor data, see struct
512 * f11_2d_sensor.
513 *
514 * @dev_query - F11 device specific query registers.
515 * @dev_controls - F11 device specific control registers.
516 * @dev_controls_mutex - lock for the control registers.
517 * @rezero_wait_ms - if nonzero, upon resume we will wait this many
518 * milliseconds before rezeroing the sensor(s). This is useful in systems with
519 * poor electrical behavior on resume, where the initial calibration of the
520 * sensor(s) coming out of sleep state may be bogus.
521 * @sensors - per sensor data structures.
522 */
523struct f11_data {
524 bool has_query9;
525 bool has_query11;
526 bool has_query12;
527 bool has_query27;
528 bool has_query28;
529 bool has_acm;
530 struct f11_2d_ctrl dev_controls;
531 struct mutex dev_controls_mutex;
532 u16 rezero_wait_ms;
533 struct rmi_2d_sensor sensor;
534 struct f11_2d_sensor_queries sens_query;
535 struct f11_2d_data data;
536 struct rmi_2d_sensor_platform_data sensor_pdata;
537 unsigned long *abs_mask;
538 unsigned long *rel_mask;
539};
540
541enum f11_finger_state {
542 F11_NO_FINGER = 0x00,
543 F11_PRESENT = 0x01,
544 F11_INACCURATE = 0x02,
545 F11_RESERVED = 0x03
546};
547
548static void rmi_f11_rel_pos_report(struct f11_data *f11, u8 n_finger)
549{
550 struct rmi_2d_sensor *sensor = &f11->sensor;
551 struct f11_2d_data *data = &f11->data;
552 s8 x, y;
553
554 x = data->rel_pos[n_finger * RMI_F11_REL_BYTES];
555 y = data->rel_pos[n_finger * RMI_F11_REL_BYTES + 1];
556
557 rmi_2d_sensor_rel_report(sensor, x, y);
558}
559
560static void rmi_f11_abs_pos_process(struct f11_data *f11,
561 struct rmi_2d_sensor *sensor,
562 struct rmi_2d_sensor_abs_object *obj,
563 enum f11_finger_state finger_state,
564 u8 n_finger)
565{
566 struct f11_2d_data *data = &f11->data;
567 u8 *pos_data = &data->abs_pos[n_finger * RMI_F11_ABS_BYTES];
568 int tool_type = MT_TOOL_FINGER;
569
570 switch (finger_state) {
571 case F11_PRESENT:
572 obj->type = RMI_2D_OBJECT_FINGER;
573 break;
574 default:
575 obj->type = RMI_2D_OBJECT_NONE;
576 }
577
578 obj->mt_tool = tool_type;
579 obj->x = (pos_data[0] << 4) | (pos_data[2] & 0x0F);
580 obj->y = (pos_data[1] << 4) | (pos_data[2] >> 4);
581 obj->z = pos_data[4];
582 obj->wx = pos_data[3] & 0x0f;
583 obj->wy = pos_data[3] >> 4;
584
585 rmi_2d_sensor_abs_process(sensor, obj, slot: n_finger);
586}
587
588static inline u8 rmi_f11_parse_finger_state(const u8 *f_state, u8 n_finger)
589{
590 return (f_state[n_finger / 4] >> (2 * (n_finger % 4))) &
591 FINGER_STATE_MASK;
592}
593
594static void rmi_f11_finger_handler(struct f11_data *f11,
595 struct rmi_2d_sensor *sensor, int size)
596{
597 const u8 *f_state = f11->data.f_state;
598 u8 finger_state;
599 u8 i;
600 int abs_fingers;
601 int rel_fingers;
602 int abs_size = sensor->nbr_fingers * RMI_F11_ABS_BYTES;
603
604 if (sensor->report_abs) {
605 if (abs_size > size)
606 abs_fingers = size / RMI_F11_ABS_BYTES;
607 else
608 abs_fingers = sensor->nbr_fingers;
609
610 for (i = 0; i < abs_fingers; i++) {
611 /* Possible of having 4 fingers per f_state register */
612 finger_state = rmi_f11_parse_finger_state(f_state, n_finger: i);
613 if (finger_state == F11_RESERVED) {
614 pr_err("Invalid finger state[%d]: 0x%02x", i,
615 finger_state);
616 continue;
617 }
618
619 rmi_f11_abs_pos_process(f11, sensor, obj: &sensor->objs[i],
620 finger_state, n_finger: i);
621 }
622
623 /*
624 * the absolute part is made in 2 parts to allow the kernel
625 * tracking to take place.
626 */
627 if (sensor->kernel_tracking)
628 input_mt_assign_slots(dev: sensor->input,
629 slots: sensor->tracking_slots,
630 pos: sensor->tracking_pos,
631 num_pos: sensor->nbr_fingers,
632 dmax: sensor->dmax);
633
634 for (i = 0; i < abs_fingers; i++) {
635 finger_state = rmi_f11_parse_finger_state(f_state, n_finger: i);
636 if (finger_state == F11_RESERVED)
637 /* no need to send twice the error */
638 continue;
639
640 rmi_2d_sensor_abs_report(sensor, obj: &sensor->objs[i], slot: i);
641 }
642
643 input_mt_sync_frame(dev: sensor->input);
644 } else if (sensor->report_rel) {
645 if ((abs_size + sensor->nbr_fingers * RMI_F11_REL_BYTES) > size)
646 rel_fingers = (size - abs_size) / RMI_F11_REL_BYTES;
647 else
648 rel_fingers = sensor->nbr_fingers;
649
650 for (i = 0; i < rel_fingers; i++)
651 rmi_f11_rel_pos_report(f11, n_finger: i);
652 }
653
654}
655
656static int f11_2d_construct_data(struct f11_data *f11)
657{
658 struct rmi_2d_sensor *sensor = &f11->sensor;
659 struct f11_2d_sensor_queries *query = &f11->sens_query;
660 struct f11_2d_data *data = &f11->data;
661 int i;
662
663 sensor->nbr_fingers = (query->nr_fingers == 5 ? 10 :
664 query->nr_fingers + 1);
665
666 sensor->pkt_size = DIV_ROUND_UP(sensor->nbr_fingers, 4);
667
668 if (query->has_abs) {
669 sensor->pkt_size += (sensor->nbr_fingers * 5);
670 sensor->attn_size = sensor->pkt_size;
671 }
672
673 if (query->has_rel)
674 sensor->pkt_size += (sensor->nbr_fingers * 2);
675
676 /* Check if F11_2D_Query7 is non-zero */
677 if (query->query7_nonzero)
678 sensor->pkt_size += sizeof(u8);
679
680 /* Check if F11_2D_Query7 or F11_2D_Query8 is non-zero */
681 if (query->query7_nonzero || query->query8_nonzero)
682 sensor->pkt_size += sizeof(u8);
683
684 if (query->has_pinch || query->has_flick || query->has_rotate) {
685 sensor->pkt_size += 3;
686 if (!query->has_flick)
687 sensor->pkt_size--;
688 if (!query->has_rotate)
689 sensor->pkt_size--;
690 }
691
692 if (query->has_touch_shapes)
693 sensor->pkt_size +=
694 DIV_ROUND_UP(query->nr_touch_shapes + 1, 8);
695
696 sensor->data_pkt = devm_kzalloc(dev: &sensor->fn->dev, size: sensor->pkt_size,
697 GFP_KERNEL);
698 if (!sensor->data_pkt)
699 return -ENOMEM;
700
701 data->f_state = sensor->data_pkt;
702 i = DIV_ROUND_UP(sensor->nbr_fingers, 4);
703
704 if (query->has_abs) {
705 data->abs_pos = &sensor->data_pkt[i];
706 i += (sensor->nbr_fingers * RMI_F11_ABS_BYTES);
707 }
708
709 if (query->has_rel) {
710 data->rel_pos = &sensor->data_pkt[i];
711 i += (sensor->nbr_fingers * RMI_F11_REL_BYTES);
712 }
713
714 if (query->query7_nonzero) {
715 data->gest_1 = &sensor->data_pkt[i];
716 i++;
717 }
718
719 if (query->query7_nonzero || query->query8_nonzero) {
720 data->gest_2 = &sensor->data_pkt[i];
721 i++;
722 }
723
724 if (query->has_pinch) {
725 data->pinch = &sensor->data_pkt[i];
726 i++;
727 }
728
729 if (query->has_flick) {
730 if (query->has_pinch) {
731 data->flick = data->pinch;
732 i += 2;
733 } else {
734 data->flick = &sensor->data_pkt[i];
735 i += 3;
736 }
737 }
738
739 if (query->has_rotate) {
740 if (query->has_flick) {
741 data->rotate = data->flick + 1;
742 } else {
743 data->rotate = &sensor->data_pkt[i];
744 i += 2;
745 }
746 }
747
748 if (query->has_touch_shapes)
749 data->shapes = &sensor->data_pkt[i];
750
751 return 0;
752}
753
754static int f11_read_control_regs(struct rmi_function *fn,
755 struct f11_2d_ctrl *ctrl, u16 ctrl_base_addr) {
756 struct rmi_device *rmi_dev = fn->rmi_dev;
757 int error = 0;
758
759 ctrl->ctrl0_11_address = ctrl_base_addr;
760 error = rmi_read_block(d: rmi_dev, addr: ctrl_base_addr, buf: ctrl->ctrl0_11,
761 RMI_F11_CTRL_REG_COUNT);
762 if (error < 0) {
763 dev_err(&fn->dev, "Failed to read ctrl0, code: %d.\n", error);
764 return error;
765 }
766
767 return 0;
768}
769
770static int f11_write_control_regs(struct rmi_function *fn,
771 struct f11_2d_sensor_queries *query,
772 struct f11_2d_ctrl *ctrl,
773 u16 ctrl_base_addr)
774{
775 struct rmi_device *rmi_dev = fn->rmi_dev;
776 int error;
777
778 error = rmi_write_block(d: rmi_dev, addr: ctrl_base_addr, buf: ctrl->ctrl0_11,
779 RMI_F11_CTRL_REG_COUNT);
780 if (error < 0)
781 return error;
782
783 return 0;
784}
785
786static int rmi_f11_get_query_parameters(struct rmi_device *rmi_dev,
787 struct f11_data *f11,
788 struct f11_2d_sensor_queries *sensor_query,
789 u16 query_base_addr)
790{
791 int query_size;
792 int rc;
793 u8 query_buf[RMI_F11_QUERY_SIZE];
794 bool has_query36 = false;
795
796 rc = rmi_read_block(d: rmi_dev, addr: query_base_addr, buf: query_buf,
797 RMI_F11_QUERY_SIZE);
798 if (rc < 0)
799 return rc;
800
801 sensor_query->nr_fingers = query_buf[0] & RMI_F11_NR_FINGERS_MASK;
802 sensor_query->has_rel = !!(query_buf[0] & RMI_F11_HAS_REL);
803 sensor_query->has_abs = !!(query_buf[0] & RMI_F11_HAS_ABS);
804 sensor_query->has_gestures = !!(query_buf[0] & RMI_F11_HAS_GESTURES);
805 sensor_query->has_sensitivity_adjust =
806 !!(query_buf[0] & RMI_F11_HAS_SENSITIVITY_ADJ);
807 sensor_query->configurable = !!(query_buf[0] & RMI_F11_CONFIGURABLE);
808
809 sensor_query->nr_x_electrodes =
810 query_buf[1] & RMI_F11_NR_ELECTRODES_MASK;
811 sensor_query->nr_y_electrodes =
812 query_buf[2] & RMI_F11_NR_ELECTRODES_MASK;
813 sensor_query->max_electrodes =
814 query_buf[3] & RMI_F11_NR_ELECTRODES_MASK;
815
816 query_size = RMI_F11_QUERY_SIZE;
817
818 if (sensor_query->has_abs) {
819 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size, buf: query_buf);
820 if (rc < 0)
821 return rc;
822
823 sensor_query->abs_data_size =
824 query_buf[0] & RMI_F11_ABS_DATA_SIZE_MASK;
825 sensor_query->has_anchored_finger =
826 !!(query_buf[0] & RMI_F11_HAS_ANCHORED_FINGER);
827 sensor_query->has_adj_hyst =
828 !!(query_buf[0] & RMI_F11_HAS_ADJ_HYST);
829 sensor_query->has_dribble =
830 !!(query_buf[0] & RMI_F11_HAS_DRIBBLE);
831 sensor_query->has_bending_correction =
832 !!(query_buf[0] & RMI_F11_HAS_BENDING_CORRECTION);
833 sensor_query->has_large_object_suppression =
834 !!(query_buf[0] & RMI_F11_HAS_LARGE_OBJECT_SUPPRESSION);
835 sensor_query->has_jitter_filter =
836 !!(query_buf[0] & RMI_F11_HAS_JITTER_FILTER);
837 query_size++;
838 }
839
840 if (sensor_query->has_rel) {
841 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size,
842 buf: &sensor_query->f11_2d_query6);
843 if (rc < 0)
844 return rc;
845 query_size++;
846 }
847
848 if (sensor_query->has_gestures) {
849 rc = rmi_read_block(d: rmi_dev, addr: query_base_addr + query_size,
850 buf: query_buf, RMI_F11_QUERY_GESTURE_SIZE);
851 if (rc < 0)
852 return rc;
853
854 sensor_query->has_single_tap =
855 !!(query_buf[0] & RMI_F11_HAS_SINGLE_TAP);
856 sensor_query->has_tap_n_hold =
857 !!(query_buf[0] & RMI_F11_HAS_TAP_AND_HOLD);
858 sensor_query->has_double_tap =
859 !!(query_buf[0] & RMI_F11_HAS_DOUBLE_TAP);
860 sensor_query->has_early_tap =
861 !!(query_buf[0] & RMI_F11_HAS_EARLY_TAP);
862 sensor_query->has_flick =
863 !!(query_buf[0] & RMI_F11_HAS_FLICK);
864 sensor_query->has_press =
865 !!(query_buf[0] & RMI_F11_HAS_PRESS);
866 sensor_query->has_pinch =
867 !!(query_buf[0] & RMI_F11_HAS_PINCH);
868 sensor_query->has_chiral =
869 !!(query_buf[0] & RMI_F11_HAS_CHIRAL);
870
871 /* query 8 */
872 sensor_query->has_palm_det =
873 !!(query_buf[1] & RMI_F11_HAS_PALM_DET);
874 sensor_query->has_rotate =
875 !!(query_buf[1] & RMI_F11_HAS_ROTATE);
876 sensor_query->has_touch_shapes =
877 !!(query_buf[1] & RMI_F11_HAS_TOUCH_SHAPES);
878 sensor_query->has_scroll_zones =
879 !!(query_buf[1] & RMI_F11_HAS_SCROLL_ZONES);
880 sensor_query->has_individual_scroll_zones =
881 !!(query_buf[1] & RMI_F11_HAS_INDIVIDUAL_SCROLL_ZONES);
882 sensor_query->has_mf_scroll =
883 !!(query_buf[1] & RMI_F11_HAS_MF_SCROLL);
884 sensor_query->has_mf_edge_motion =
885 !!(query_buf[1] & RMI_F11_HAS_MF_EDGE_MOTION);
886 sensor_query->has_mf_scroll_inertia =
887 !!(query_buf[1] & RMI_F11_HAS_MF_SCROLL_INERTIA);
888
889 sensor_query->query7_nonzero = !!(query_buf[0]);
890 sensor_query->query8_nonzero = !!(query_buf[1]);
891
892 query_size += 2;
893 }
894
895 if (f11->has_query9) {
896 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size, buf: query_buf);
897 if (rc < 0)
898 return rc;
899
900 sensor_query->has_pen =
901 !!(query_buf[0] & RMI_F11_HAS_PEN);
902 sensor_query->has_proximity =
903 !!(query_buf[0] & RMI_F11_HAS_PROXIMITY);
904 sensor_query->has_palm_det_sensitivity =
905 !!(query_buf[0] & RMI_F11_HAS_PALM_DET_SENSITIVITY);
906 sensor_query->has_suppress_on_palm_detect =
907 !!(query_buf[0] & RMI_F11_HAS_SUPPRESS_ON_PALM_DETECT);
908 sensor_query->has_two_pen_thresholds =
909 !!(query_buf[0] & RMI_F11_HAS_TWO_PEN_THRESHOLDS);
910 sensor_query->has_contact_geometry =
911 !!(query_buf[0] & RMI_F11_HAS_CONTACT_GEOMETRY);
912 sensor_query->has_pen_hover_discrimination =
913 !!(query_buf[0] & RMI_F11_HAS_PEN_HOVER_DISCRIMINATION);
914 sensor_query->has_pen_filters =
915 !!(query_buf[0] & RMI_F11_HAS_PEN_FILTERS);
916
917 query_size++;
918 }
919
920 if (sensor_query->has_touch_shapes) {
921 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size, buf: query_buf);
922 if (rc < 0)
923 return rc;
924
925 sensor_query->nr_touch_shapes = query_buf[0] &
926 RMI_F11_NR_TOUCH_SHAPES_MASK;
927
928 query_size++;
929 }
930
931 if (f11->has_query11) {
932 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size, buf: query_buf);
933 if (rc < 0)
934 return rc;
935
936 sensor_query->has_z_tuning =
937 !!(query_buf[0] & RMI_F11_HAS_Z_TUNING);
938 sensor_query->has_algorithm_selection =
939 !!(query_buf[0] & RMI_F11_HAS_ALGORITHM_SELECTION);
940 sensor_query->has_w_tuning =
941 !!(query_buf[0] & RMI_F11_HAS_W_TUNING);
942 sensor_query->has_pitch_info =
943 !!(query_buf[0] & RMI_F11_HAS_PITCH_INFO);
944 sensor_query->has_finger_size =
945 !!(query_buf[0] & RMI_F11_HAS_FINGER_SIZE);
946 sensor_query->has_segmentation_aggressiveness =
947 !!(query_buf[0] &
948 RMI_F11_HAS_SEGMENTATION_AGGRESSIVENESS);
949 sensor_query->has_XY_clip =
950 !!(query_buf[0] & RMI_F11_HAS_XY_CLIP);
951 sensor_query->has_drumming_filter =
952 !!(query_buf[0] & RMI_F11_HAS_DRUMMING_FILTER);
953
954 query_size++;
955 }
956
957 if (f11->has_query12) {
958 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size, buf: query_buf);
959 if (rc < 0)
960 return rc;
961
962 sensor_query->has_gapless_finger =
963 !!(query_buf[0] & RMI_F11_HAS_GAPLESS_FINGER);
964 sensor_query->has_gapless_finger_tuning =
965 !!(query_buf[0] & RMI_F11_HAS_GAPLESS_FINGER_TUNING);
966 sensor_query->has_8bit_w =
967 !!(query_buf[0] & RMI_F11_HAS_8BIT_W);
968 sensor_query->has_adjustable_mapping =
969 !!(query_buf[0] & RMI_F11_HAS_ADJUSTABLE_MAPPING);
970 sensor_query->has_info2 =
971 !!(query_buf[0] & RMI_F11_HAS_INFO2);
972 sensor_query->has_physical_props =
973 !!(query_buf[0] & RMI_F11_HAS_PHYSICAL_PROPS);
974 sensor_query->has_finger_limit =
975 !!(query_buf[0] & RMI_F11_HAS_FINGER_LIMIT);
976 sensor_query->has_linear_coeff_2 =
977 !!(query_buf[0] & RMI_F11_HAS_LINEAR_COEFF);
978
979 query_size++;
980 }
981
982 if (sensor_query->has_jitter_filter) {
983 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size, buf: query_buf);
984 if (rc < 0)
985 return rc;
986
987 sensor_query->jitter_window_size = query_buf[0] &
988 RMI_F11_JITTER_WINDOW_MASK;
989 sensor_query->jitter_filter_type = (query_buf[0] &
990 RMI_F11_JITTER_FILTER_MASK) >>
991 RMI_F11_JITTER_FILTER_SHIFT;
992
993 query_size++;
994 }
995
996 if (sensor_query->has_info2) {
997 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size, buf: query_buf);
998 if (rc < 0)
999 return rc;
1000
1001 sensor_query->light_control =
1002 query_buf[0] & RMI_F11_LIGHT_CONTROL_MASK;
1003 sensor_query->is_clear =
1004 !!(query_buf[0] & RMI_F11_IS_CLEAR);
1005 sensor_query->clickpad_props =
1006 (query_buf[0] & RMI_F11_CLICKPAD_PROPS_MASK) >>
1007 RMI_F11_CLICKPAD_PROPS_SHIFT;
1008 sensor_query->mouse_buttons =
1009 (query_buf[0] & RMI_F11_MOUSE_BUTTONS_MASK) >>
1010 RMI_F11_MOUSE_BUTTONS_SHIFT;
1011 sensor_query->has_advanced_gestures =
1012 !!(query_buf[0] & RMI_F11_HAS_ADVANCED_GESTURES);
1013
1014 query_size++;
1015 }
1016
1017 if (sensor_query->has_physical_props) {
1018 rc = rmi_read_block(d: rmi_dev, addr: query_base_addr
1019 + query_size, buf: query_buf, len: 4);
1020 if (rc < 0)
1021 return rc;
1022
1023 sensor_query->x_sensor_size_mm =
1024 (query_buf[0] | (query_buf[1] << 8)) / 10;
1025 sensor_query->y_sensor_size_mm =
1026 (query_buf[2] | (query_buf[3] << 8)) / 10;
1027
1028 /*
1029 * query 15 - 18 contain the size of the sensor
1030 * and query 19 - 26 contain bezel dimensions
1031 */
1032 query_size += 12;
1033 }
1034
1035 if (f11->has_query27)
1036 ++query_size;
1037
1038 if (f11->has_query28) {
1039 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size,
1040 buf: query_buf);
1041 if (rc < 0)
1042 return rc;
1043
1044 has_query36 = !!(query_buf[0] & BIT(6));
1045 }
1046
1047 if (has_query36) {
1048 query_size += 2;
1049 rc = rmi_read(d: rmi_dev, addr: query_base_addr + query_size,
1050 buf: query_buf);
1051 if (rc < 0)
1052 return rc;
1053
1054 if (!!(query_buf[0] & BIT(5)))
1055 f11->has_acm = true;
1056 }
1057
1058 return query_size;
1059}
1060
1061static int rmi_f11_initialize(struct rmi_function *fn)
1062{
1063 struct rmi_device *rmi_dev = fn->rmi_dev;
1064 struct f11_data *f11;
1065 struct f11_2d_ctrl *ctrl;
1066 u8 query_offset;
1067 u16 query_base_addr;
1068 u16 control_base_addr;
1069 u16 max_x_pos, max_y_pos;
1070 int rc;
1071 const struct rmi_device_platform_data *pdata =
1072 rmi_get_platform_data(d: rmi_dev);
1073 struct rmi_driver_data *drvdata = dev_get_drvdata(dev: &rmi_dev->dev);
1074 struct rmi_2d_sensor *sensor;
1075 u8 buf;
1076 int mask_size;
1077
1078 rmi_dbg(RMI_DEBUG_FN, dev: &fn->dev, fmt: "Initializing F11 values.\n");
1079
1080 mask_size = BITS_TO_LONGS(drvdata->irq_count) * sizeof(unsigned long);
1081
1082 /*
1083 ** init instance data, fill in values and create any sysfs files
1084 */
1085 f11 = devm_kzalloc(dev: &fn->dev, size: sizeof(struct f11_data) + mask_size * 2,
1086 GFP_KERNEL);
1087 if (!f11)
1088 return -ENOMEM;
1089
1090 if (fn->dev.of_node) {
1091 rc = rmi_2d_sensor_of_probe(dev: &fn->dev, pdata: &f11->sensor_pdata);
1092 if (rc)
1093 return rc;
1094 } else {
1095 f11->sensor_pdata = pdata->sensor_pdata;
1096 }
1097
1098 f11->rezero_wait_ms = f11->sensor_pdata.rezero_wait;
1099
1100 f11->abs_mask = (unsigned long *)((char *)f11
1101 + sizeof(struct f11_data));
1102 f11->rel_mask = (unsigned long *)((char *)f11
1103 + sizeof(struct f11_data) + mask_size);
1104
1105 set_bit(nr: fn->irq_pos, addr: f11->abs_mask);
1106 set_bit(nr: fn->irq_pos + 1, addr: f11->rel_mask);
1107
1108 query_base_addr = fn->fd.query_base_addr;
1109 control_base_addr = fn->fd.control_base_addr;
1110
1111 rc = rmi_read(d: rmi_dev, addr: query_base_addr, buf: &buf);
1112 if (rc < 0)
1113 return rc;
1114
1115 f11->has_query9 = !!(buf & RMI_F11_HAS_QUERY9);
1116 f11->has_query11 = !!(buf & RMI_F11_HAS_QUERY11);
1117 f11->has_query12 = !!(buf & RMI_F11_HAS_QUERY12);
1118 f11->has_query27 = !!(buf & RMI_F11_HAS_QUERY27);
1119 f11->has_query28 = !!(buf & RMI_F11_HAS_QUERY28);
1120
1121 query_offset = (query_base_addr + 1);
1122 sensor = &f11->sensor;
1123 sensor->fn = fn;
1124
1125 rc = rmi_f11_get_query_parameters(rmi_dev, f11,
1126 sensor_query: &f11->sens_query, query_base_addr: query_offset);
1127 if (rc < 0)
1128 return rc;
1129 query_offset += rc;
1130
1131 rc = f11_read_control_regs(fn, ctrl: &f11->dev_controls,
1132 ctrl_base_addr: control_base_addr);
1133 if (rc < 0) {
1134 dev_err(&fn->dev,
1135 "Failed to read F11 control params.\n");
1136 return rc;
1137 }
1138
1139 if (f11->sens_query.has_info2) {
1140 if (f11->sens_query.is_clear)
1141 f11->sensor.sensor_type = rmi_sensor_touchscreen;
1142 else
1143 f11->sensor.sensor_type = rmi_sensor_touchpad;
1144 }
1145
1146 sensor->report_abs = f11->sens_query.has_abs;
1147
1148 sensor->axis_align =
1149 f11->sensor_pdata.axis_align;
1150
1151 sensor->topbuttonpad = f11->sensor_pdata.topbuttonpad;
1152 sensor->kernel_tracking = f11->sensor_pdata.kernel_tracking;
1153 sensor->dmax = f11->sensor_pdata.dmax;
1154 sensor->dribble = f11->sensor_pdata.dribble;
1155 sensor->palm_detect = f11->sensor_pdata.palm_detect;
1156
1157 if (f11->sens_query.has_physical_props) {
1158 sensor->x_mm = f11->sens_query.x_sensor_size_mm;
1159 sensor->y_mm = f11->sens_query.y_sensor_size_mm;
1160 } else {
1161 sensor->x_mm = f11->sensor_pdata.x_mm;
1162 sensor->y_mm = f11->sensor_pdata.y_mm;
1163 }
1164
1165 if (sensor->sensor_type == rmi_sensor_default)
1166 sensor->sensor_type =
1167 f11->sensor_pdata.sensor_type;
1168
1169 sensor->report_abs = sensor->report_abs
1170 && !(f11->sensor_pdata.disable_report_mask
1171 & RMI_F11_DISABLE_ABS_REPORT);
1172
1173 if (!sensor->report_abs)
1174 /*
1175 * If device doesn't have abs or if it has been disables
1176 * fallback to reporting rel data.
1177 */
1178 sensor->report_rel = f11->sens_query.has_rel;
1179
1180 rc = rmi_read_block(d: rmi_dev,
1181 addr: control_base_addr + F11_CTRL_SENSOR_MAX_X_POS_OFFSET,
1182 buf: (u8 *)&max_x_pos, len: sizeof(max_x_pos));
1183 if (rc < 0)
1184 return rc;
1185
1186 rc = rmi_read_block(d: rmi_dev,
1187 addr: control_base_addr + F11_CTRL_SENSOR_MAX_Y_POS_OFFSET,
1188 buf: (u8 *)&max_y_pos, len: sizeof(max_y_pos));
1189 if (rc < 0)
1190 return rc;
1191
1192 sensor->max_x = max_x_pos;
1193 sensor->max_y = max_y_pos;
1194
1195 rc = f11_2d_construct_data(f11);
1196 if (rc < 0)
1197 return rc;
1198
1199 if (f11->has_acm)
1200 f11->sensor.attn_size += f11->sensor.nbr_fingers * 2;
1201
1202 /* allocate the in-kernel tracking buffers */
1203 sensor->tracking_pos = devm_kcalloc(dev: &fn->dev,
1204 n: sensor->nbr_fingers, size: sizeof(struct input_mt_pos),
1205 GFP_KERNEL);
1206 sensor->tracking_slots = devm_kcalloc(dev: &fn->dev,
1207 n: sensor->nbr_fingers, size: sizeof(int), GFP_KERNEL);
1208 sensor->objs = devm_kcalloc(dev: &fn->dev,
1209 n: sensor->nbr_fingers,
1210 size: sizeof(struct rmi_2d_sensor_abs_object),
1211 GFP_KERNEL);
1212 if (!sensor->tracking_pos || !sensor->tracking_slots || !sensor->objs)
1213 return -ENOMEM;
1214
1215 ctrl = &f11->dev_controls;
1216 if (sensor->axis_align.delta_x_threshold)
1217 ctrl->ctrl0_11[RMI_F11_DELTA_X_THRESHOLD] =
1218 sensor->axis_align.delta_x_threshold;
1219
1220 if (sensor->axis_align.delta_y_threshold)
1221 ctrl->ctrl0_11[RMI_F11_DELTA_Y_THRESHOLD] =
1222 sensor->axis_align.delta_y_threshold;
1223
1224 /*
1225 * If distance threshold values are set, switch to reduced reporting
1226 * mode so they actually get used by the controller.
1227 */
1228 if (sensor->axis_align.delta_x_threshold ||
1229 sensor->axis_align.delta_y_threshold) {
1230 ctrl->ctrl0_11[0] &= ~RMI_F11_REPORT_MODE_MASK;
1231 ctrl->ctrl0_11[0] |= RMI_F11_REPORT_MODE_REDUCED;
1232 }
1233
1234 if (f11->sens_query.has_dribble) {
1235 switch (sensor->dribble) {
1236 case RMI_REG_STATE_OFF:
1237 ctrl->ctrl0_11[0] &= ~BIT(6);
1238 break;
1239 case RMI_REG_STATE_ON:
1240 ctrl->ctrl0_11[0] |= BIT(6);
1241 break;
1242 case RMI_REG_STATE_DEFAULT:
1243 default:
1244 break;
1245 }
1246 }
1247
1248 if (f11->sens_query.has_palm_det) {
1249 switch (sensor->palm_detect) {
1250 case RMI_REG_STATE_OFF:
1251 ctrl->ctrl0_11[11] &= ~BIT(0);
1252 break;
1253 case RMI_REG_STATE_ON:
1254 ctrl->ctrl0_11[11] |= BIT(0);
1255 break;
1256 case RMI_REG_STATE_DEFAULT:
1257 default:
1258 break;
1259 }
1260 }
1261
1262 rc = f11_write_control_regs(fn, query: &f11->sens_query,
1263 ctrl: &f11->dev_controls, ctrl_base_addr: fn->fd.control_base_addr);
1264 if (rc)
1265 dev_warn(&fn->dev, "Failed to write control registers\n");
1266
1267 mutex_init(&f11->dev_controls_mutex);
1268
1269 dev_set_drvdata(dev: &fn->dev, data: f11);
1270
1271 return 0;
1272}
1273
1274static int rmi_f11_config(struct rmi_function *fn)
1275{
1276 struct f11_data *f11 = dev_get_drvdata(dev: &fn->dev);
1277 struct rmi_driver *drv = fn->rmi_dev->driver;
1278 struct rmi_2d_sensor *sensor = &f11->sensor;
1279 int rc;
1280
1281 if (!sensor->report_abs)
1282 drv->clear_irq_bits(fn->rmi_dev, f11->abs_mask);
1283 else
1284 drv->set_irq_bits(fn->rmi_dev, f11->abs_mask);
1285
1286 if (!sensor->report_rel)
1287 drv->clear_irq_bits(fn->rmi_dev, f11->rel_mask);
1288 else
1289 drv->set_irq_bits(fn->rmi_dev, f11->rel_mask);
1290
1291 rc = f11_write_control_regs(fn, query: &f11->sens_query,
1292 ctrl: &f11->dev_controls, ctrl_base_addr: fn->fd.query_base_addr);
1293 if (rc < 0)
1294 return rc;
1295
1296 return 0;
1297}
1298
1299static irqreturn_t rmi_f11_attention(int irq, void *ctx)
1300{
1301 struct rmi_function *fn = ctx;
1302 struct rmi_device *rmi_dev = fn->rmi_dev;
1303 struct rmi_driver_data *drvdata = dev_get_drvdata(dev: &rmi_dev->dev);
1304 struct f11_data *f11 = dev_get_drvdata(dev: &fn->dev);
1305 u16 data_base_addr = fn->fd.data_base_addr;
1306 int error;
1307 int valid_bytes = f11->sensor.pkt_size;
1308
1309 if (drvdata->attn_data.data) {
1310 /*
1311 * The valid data in the attention report is less then
1312 * expected. Only process the complete fingers.
1313 */
1314 if (f11->sensor.attn_size > drvdata->attn_data.size)
1315 valid_bytes = drvdata->attn_data.size;
1316 else
1317 valid_bytes = f11->sensor.attn_size;
1318 memcpy(f11->sensor.data_pkt, drvdata->attn_data.data,
1319 valid_bytes);
1320 drvdata->attn_data.data += valid_bytes;
1321 drvdata->attn_data.size -= valid_bytes;
1322 } else {
1323 error = rmi_read_block(d: rmi_dev,
1324 addr: data_base_addr, buf: f11->sensor.data_pkt,
1325 len: f11->sensor.pkt_size);
1326 if (error < 0)
1327 return IRQ_RETVAL(error);
1328 }
1329
1330 rmi_f11_finger_handler(f11, sensor: &f11->sensor, size: valid_bytes);
1331
1332 return IRQ_HANDLED;
1333}
1334
1335static int rmi_f11_resume(struct rmi_function *fn)
1336{
1337 struct f11_data *f11 = dev_get_drvdata(dev: &fn->dev);
1338 int error;
1339
1340 rmi_dbg(RMI_DEBUG_FN, dev: &fn->dev, fmt: "Resuming...\n");
1341 if (!f11->rezero_wait_ms)
1342 return 0;
1343
1344 mdelay(f11->rezero_wait_ms);
1345
1346 error = rmi_write(d: fn->rmi_dev, addr: fn->fd.command_base_addr,
1347 RMI_F11_REZERO);
1348 if (error) {
1349 dev_err(&fn->dev,
1350 "%s: failed to issue rezero command, error = %d.",
1351 __func__, error);
1352 return error;
1353 }
1354
1355 return 0;
1356}
1357
1358static int rmi_f11_probe(struct rmi_function *fn)
1359{
1360 int error;
1361 struct f11_data *f11;
1362
1363 error = rmi_f11_initialize(fn);
1364 if (error)
1365 return error;
1366
1367 f11 = dev_get_drvdata(dev: &fn->dev);
1368 error = rmi_2d_sensor_configure_input(fn, sensor: &f11->sensor);
1369 if (error)
1370 return error;
1371
1372 return 0;
1373}
1374
1375struct rmi_function_handler rmi_f11_handler = {
1376 .driver = {
1377 .name = "rmi4_f11",
1378 },
1379 .func = 0x11,
1380 .probe = rmi_f11_probe,
1381 .config = rmi_f11_config,
1382 .attention = rmi_f11_attention,
1383 .resume = rmi_f11_resume,
1384};
1385

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