This source file includes following definitions.
- ad714x_use_com_int
- ad714x_use_thr_int
- ad714x_cal_highest_stage
- ad714x_cal_abs_pos
- ad714x_button_state_machine
- ad714x_slider_cal_sensor_val
- ad714x_slider_cal_highest_stage
- ad714x_slider_cal_abs_pos
- ad714x_slider_cal_flt_pos
- ad714x_slider_use_com_int
- ad714x_slider_use_thr_int
- ad714x_slider_state_machine
- ad714x_wheel_cal_highest_stage
- ad714x_wheel_cal_sensor_val
- ad714x_wheel_cal_abs_pos
- ad714x_wheel_cal_flt_pos
- ad714x_wheel_use_com_int
- ad714x_wheel_use_thr_int
- ad714x_wheel_state_machine
- touchpad_cal_sensor_val
- touchpad_cal_highest_stage
- touchpad_check_second_peak
- touchpad_cal_abs_pos
- touchpad_cal_flt_pos
- touchpad_check_endpoint
- touchpad_use_com_int
- touchpad_use_thr_int
- ad714x_touchpad_state_machine
- ad714x_hw_detect
- ad714x_hw_init
- ad714x_interrupt_thread
- ad714x_probe
- ad714x_disable
- ad714x_enable
1
2
3
4
5
6
7
8 #include <linux/device.h>
9 #include <linux/input.h>
10 #include <linux/interrupt.h>
11 #include <linux/slab.h>
12 #include <linux/input/ad714x.h>
13 #include <linux/module.h>
14 #include "ad714x.h"
15
16 #define AD714X_PWR_CTRL 0x0
17 #define AD714X_STG_CAL_EN_REG 0x1
18 #define AD714X_AMB_COMP_CTRL0_REG 0x2
19 #define AD714X_PARTID_REG 0x17
20 #define AD7142_PARTID 0xE620
21 #define AD7143_PARTID 0xE630
22 #define AD7147_PARTID 0x1470
23 #define AD7148_PARTID 0x1480
24 #define AD714X_STAGECFG_REG 0x80
25 #define AD714X_SYSCFG_REG 0x0
26
27 #define STG_LOW_INT_EN_REG 0x5
28 #define STG_HIGH_INT_EN_REG 0x6
29 #define STG_COM_INT_EN_REG 0x7
30 #define STG_LOW_INT_STA_REG 0x8
31 #define STG_HIGH_INT_STA_REG 0x9
32 #define STG_COM_INT_STA_REG 0xA
33
34 #define CDC_RESULT_S0 0xB
35 #define CDC_RESULT_S1 0xC
36 #define CDC_RESULT_S2 0xD
37 #define CDC_RESULT_S3 0xE
38 #define CDC_RESULT_S4 0xF
39 #define CDC_RESULT_S5 0x10
40 #define CDC_RESULT_S6 0x11
41 #define CDC_RESULT_S7 0x12
42 #define CDC_RESULT_S8 0x13
43 #define CDC_RESULT_S9 0x14
44 #define CDC_RESULT_S10 0x15
45 #define CDC_RESULT_S11 0x16
46
47 #define STAGE0_AMBIENT 0xF1
48 #define STAGE1_AMBIENT 0x115
49 #define STAGE2_AMBIENT 0x139
50 #define STAGE3_AMBIENT 0x15D
51 #define STAGE4_AMBIENT 0x181
52 #define STAGE5_AMBIENT 0x1A5
53 #define STAGE6_AMBIENT 0x1C9
54 #define STAGE7_AMBIENT 0x1ED
55 #define STAGE8_AMBIENT 0x211
56 #define STAGE9_AMBIENT 0x234
57 #define STAGE10_AMBIENT 0x259
58 #define STAGE11_AMBIENT 0x27D
59
60 #define PER_STAGE_REG_NUM 36
61 #define STAGE_CFGREG_NUM 8
62 #define SYS_CFGREG_NUM 8
63
64
65
66
67 enum ad714x_device_state { IDLE, JITTER, ACTIVE, SPACE };
68
69 struct ad714x_slider_drv {
70 int highest_stage;
71 int abs_pos;
72 int flt_pos;
73 enum ad714x_device_state state;
74 struct input_dev *input;
75 };
76
77 struct ad714x_wheel_drv {
78 int abs_pos;
79 int flt_pos;
80 int pre_highest_stage;
81 int highest_stage;
82 enum ad714x_device_state state;
83 struct input_dev *input;
84 };
85
86 struct ad714x_touchpad_drv {
87 int x_highest_stage;
88 int x_flt_pos;
89 int x_abs_pos;
90 int y_highest_stage;
91 int y_flt_pos;
92 int y_abs_pos;
93 int left_ep;
94 int left_ep_val;
95 int right_ep;
96 int right_ep_val;
97 int top_ep;
98 int top_ep_val;
99 int bottom_ep;
100 int bottom_ep_val;
101 enum ad714x_device_state state;
102 struct input_dev *input;
103 };
104
105 struct ad714x_button_drv {
106 enum ad714x_device_state state;
107
108
109
110
111 struct input_dev *input;
112 };
113
114 struct ad714x_driver_data {
115 struct ad714x_slider_drv *slider;
116 struct ad714x_wheel_drv *wheel;
117 struct ad714x_touchpad_drv *touchpad;
118 struct ad714x_button_drv *button;
119 };
120
121
122
123
124
125
126 static void ad714x_use_com_int(struct ad714x_chip *ad714x,
127 int start_stage, int end_stage)
128 {
129 unsigned short data;
130 unsigned short mask;
131
132 mask = ((1 << (end_stage + 1)) - 1) - ((1 << start_stage) - 1);
133
134 ad714x->read(ad714x, STG_COM_INT_EN_REG, &data, 1);
135 data |= 1 << end_stage;
136 ad714x->write(ad714x, STG_COM_INT_EN_REG, data);
137
138 ad714x->read(ad714x, STG_HIGH_INT_EN_REG, &data, 1);
139 data &= ~mask;
140 ad714x->write(ad714x, STG_HIGH_INT_EN_REG, data);
141 }
142
143 static void ad714x_use_thr_int(struct ad714x_chip *ad714x,
144 int start_stage, int end_stage)
145 {
146 unsigned short data;
147 unsigned short mask;
148
149 mask = ((1 << (end_stage + 1)) - 1) - ((1 << start_stage) - 1);
150
151 ad714x->read(ad714x, STG_COM_INT_EN_REG, &data, 1);
152 data &= ~(1 << end_stage);
153 ad714x->write(ad714x, STG_COM_INT_EN_REG, data);
154
155 ad714x->read(ad714x, STG_HIGH_INT_EN_REG, &data, 1);
156 data |= mask;
157 ad714x->write(ad714x, STG_HIGH_INT_EN_REG, data);
158 }
159
160 static int ad714x_cal_highest_stage(struct ad714x_chip *ad714x,
161 int start_stage, int end_stage)
162 {
163 int max_res = 0;
164 int max_idx = 0;
165 int i;
166
167 for (i = start_stage; i <= end_stage; i++) {
168 if (ad714x->sensor_val[i] > max_res) {
169 max_res = ad714x->sensor_val[i];
170 max_idx = i;
171 }
172 }
173
174 return max_idx;
175 }
176
177 static int ad714x_cal_abs_pos(struct ad714x_chip *ad714x,
178 int start_stage, int end_stage,
179 int highest_stage, int max_coord)
180 {
181 int a_param, b_param;
182
183 if (highest_stage == start_stage) {
184 a_param = ad714x->sensor_val[start_stage + 1];
185 b_param = ad714x->sensor_val[start_stage] +
186 ad714x->sensor_val[start_stage + 1];
187 } else if (highest_stage == end_stage) {
188 a_param = ad714x->sensor_val[end_stage] *
189 (end_stage - start_stage) +
190 ad714x->sensor_val[end_stage - 1] *
191 (end_stage - start_stage - 1);
192 b_param = ad714x->sensor_val[end_stage] +
193 ad714x->sensor_val[end_stage - 1];
194 } else {
195 a_param = ad714x->sensor_val[highest_stage] *
196 (highest_stage - start_stage) +
197 ad714x->sensor_val[highest_stage - 1] *
198 (highest_stage - start_stage - 1) +
199 ad714x->sensor_val[highest_stage + 1] *
200 (highest_stage - start_stage + 1);
201 b_param = ad714x->sensor_val[highest_stage] +
202 ad714x->sensor_val[highest_stage - 1] +
203 ad714x->sensor_val[highest_stage + 1];
204 }
205
206 return (max_coord / (end_stage - start_stage)) * a_param / b_param;
207 }
208
209
210
211
212
213 static void ad714x_button_state_machine(struct ad714x_chip *ad714x, int idx)
214 {
215 struct ad714x_button_plat *hw = &ad714x->hw->button[idx];
216 struct ad714x_button_drv *sw = &ad714x->sw->button[idx];
217
218 switch (sw->state) {
219 case IDLE:
220 if (((ad714x->h_state & hw->h_mask) == hw->h_mask) &&
221 ((ad714x->l_state & hw->l_mask) == hw->l_mask)) {
222 dev_dbg(ad714x->dev, "button %d touched\n", idx);
223 input_report_key(sw->input, hw->keycode, 1);
224 input_sync(sw->input);
225 sw->state = ACTIVE;
226 }
227 break;
228
229 case ACTIVE:
230 if (((ad714x->h_state & hw->h_mask) != hw->h_mask) ||
231 ((ad714x->l_state & hw->l_mask) != hw->l_mask)) {
232 dev_dbg(ad714x->dev, "button %d released\n", idx);
233 input_report_key(sw->input, hw->keycode, 0);
234 input_sync(sw->input);
235 sw->state = IDLE;
236 }
237 break;
238
239 default:
240 break;
241 }
242 }
243
244
245
246
247
248 static void ad714x_slider_cal_sensor_val(struct ad714x_chip *ad714x, int idx)
249 {
250 struct ad714x_slider_plat *hw = &ad714x->hw->slider[idx];
251 int i;
252
253 ad714x->read(ad714x, CDC_RESULT_S0 + hw->start_stage,
254 &ad714x->adc_reg[hw->start_stage],
255 hw->end_stage - hw->start_stage + 1);
256
257 for (i = hw->start_stage; i <= hw->end_stage; i++) {
258 ad714x->read(ad714x, STAGE0_AMBIENT + i * PER_STAGE_REG_NUM,
259 &ad714x->amb_reg[i], 1);
260
261 ad714x->sensor_val[i] =
262 abs(ad714x->adc_reg[i] - ad714x->amb_reg[i]);
263 }
264 }
265
266 static void ad714x_slider_cal_highest_stage(struct ad714x_chip *ad714x, int idx)
267 {
268 struct ad714x_slider_plat *hw = &ad714x->hw->slider[idx];
269 struct ad714x_slider_drv *sw = &ad714x->sw->slider[idx];
270
271 sw->highest_stage = ad714x_cal_highest_stage(ad714x, hw->start_stage,
272 hw->end_stage);
273
274 dev_dbg(ad714x->dev, "slider %d highest_stage:%d\n", idx,
275 sw->highest_stage);
276 }
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291 static void ad714x_slider_cal_abs_pos(struct ad714x_chip *ad714x, int idx)
292 {
293 struct ad714x_slider_plat *hw = &ad714x->hw->slider[idx];
294 struct ad714x_slider_drv *sw = &ad714x->sw->slider[idx];
295
296 sw->abs_pos = ad714x_cal_abs_pos(ad714x, hw->start_stage, hw->end_stage,
297 sw->highest_stage, hw->max_coord);
298
299 dev_dbg(ad714x->dev, "slider %d absolute position:%d\n", idx,
300 sw->abs_pos);
301 }
302
303
304
305
306
307
308
309
310
311
312
313 static void ad714x_slider_cal_flt_pos(struct ad714x_chip *ad714x, int idx)
314 {
315 struct ad714x_slider_drv *sw = &ad714x->sw->slider[idx];
316
317 sw->flt_pos = (sw->flt_pos * (10 - 4) +
318 sw->abs_pos * 4)/10;
319
320 dev_dbg(ad714x->dev, "slider %d filter position:%d\n", idx,
321 sw->flt_pos);
322 }
323
324 static void ad714x_slider_use_com_int(struct ad714x_chip *ad714x, int idx)
325 {
326 struct ad714x_slider_plat *hw = &ad714x->hw->slider[idx];
327
328 ad714x_use_com_int(ad714x, hw->start_stage, hw->end_stage);
329 }
330
331 static void ad714x_slider_use_thr_int(struct ad714x_chip *ad714x, int idx)
332 {
333 struct ad714x_slider_plat *hw = &ad714x->hw->slider[idx];
334
335 ad714x_use_thr_int(ad714x, hw->start_stage, hw->end_stage);
336 }
337
338 static void ad714x_slider_state_machine(struct ad714x_chip *ad714x, int idx)
339 {
340 struct ad714x_slider_plat *hw = &ad714x->hw->slider[idx];
341 struct ad714x_slider_drv *sw = &ad714x->sw->slider[idx];
342 unsigned short h_state, c_state;
343 unsigned short mask;
344
345 mask = ((1 << (hw->end_stage + 1)) - 1) - ((1 << hw->start_stage) - 1);
346
347 h_state = ad714x->h_state & mask;
348 c_state = ad714x->c_state & mask;
349
350 switch (sw->state) {
351 case IDLE:
352 if (h_state) {
353 sw->state = JITTER;
354
355
356
357 ad714x_slider_use_com_int(ad714x, idx);
358 dev_dbg(ad714x->dev, "slider %d touched\n", idx);
359 }
360 break;
361
362 case JITTER:
363 if (c_state == mask) {
364 ad714x_slider_cal_sensor_val(ad714x, idx);
365 ad714x_slider_cal_highest_stage(ad714x, idx);
366 ad714x_slider_cal_abs_pos(ad714x, idx);
367 sw->flt_pos = sw->abs_pos;
368 sw->state = ACTIVE;
369 }
370 break;
371
372 case ACTIVE:
373 if (c_state == mask) {
374 if (h_state) {
375 ad714x_slider_cal_sensor_val(ad714x, idx);
376 ad714x_slider_cal_highest_stage(ad714x, idx);
377 ad714x_slider_cal_abs_pos(ad714x, idx);
378 ad714x_slider_cal_flt_pos(ad714x, idx);
379 input_report_abs(sw->input, ABS_X, sw->flt_pos);
380 input_report_key(sw->input, BTN_TOUCH, 1);
381 } else {
382
383
384
385 ad714x_slider_use_thr_int(ad714x, idx);
386 sw->state = IDLE;
387 input_report_key(sw->input, BTN_TOUCH, 0);
388 dev_dbg(ad714x->dev, "slider %d released\n",
389 idx);
390 }
391 input_sync(sw->input);
392 }
393 break;
394
395 default:
396 break;
397 }
398 }
399
400
401
402
403
404
405
406
407 static void ad714x_wheel_cal_highest_stage(struct ad714x_chip *ad714x, int idx)
408 {
409 struct ad714x_wheel_plat *hw = &ad714x->hw->wheel[idx];
410 struct ad714x_wheel_drv *sw = &ad714x->sw->wheel[idx];
411
412 sw->pre_highest_stage = sw->highest_stage;
413 sw->highest_stage = ad714x_cal_highest_stage(ad714x, hw->start_stage,
414 hw->end_stage);
415
416 dev_dbg(ad714x->dev, "wheel %d highest_stage:%d\n", idx,
417 sw->highest_stage);
418 }
419
420 static void ad714x_wheel_cal_sensor_val(struct ad714x_chip *ad714x, int idx)
421 {
422 struct ad714x_wheel_plat *hw = &ad714x->hw->wheel[idx];
423 int i;
424
425 ad714x->read(ad714x, CDC_RESULT_S0 + hw->start_stage,
426 &ad714x->adc_reg[hw->start_stage],
427 hw->end_stage - hw->start_stage + 1);
428
429 for (i = hw->start_stage; i <= hw->end_stage; i++) {
430 ad714x->read(ad714x, STAGE0_AMBIENT + i * PER_STAGE_REG_NUM,
431 &ad714x->amb_reg[i], 1);
432 if (ad714x->adc_reg[i] > ad714x->amb_reg[i])
433 ad714x->sensor_val[i] =
434 ad714x->adc_reg[i] - ad714x->amb_reg[i];
435 else
436 ad714x->sensor_val[i] = 0;
437 }
438 }
439
440
441
442
443
444
445
446
447
448
449 static void ad714x_wheel_cal_abs_pos(struct ad714x_chip *ad714x, int idx)
450 {
451 struct ad714x_wheel_plat *hw = &ad714x->hw->wheel[idx];
452 struct ad714x_wheel_drv *sw = &ad714x->sw->wheel[idx];
453 int stage_num = hw->end_stage - hw->start_stage + 1;
454 int first_before, highest, first_after;
455 int a_param, b_param;
456
457 first_before = (sw->highest_stage + stage_num - 1) % stage_num;
458 highest = sw->highest_stage;
459 first_after = (sw->highest_stage + stage_num + 1) % stage_num;
460
461 a_param = ad714x->sensor_val[highest] *
462 (highest - hw->start_stage) +
463 ad714x->sensor_val[first_before] *
464 (highest - hw->start_stage - 1) +
465 ad714x->sensor_val[first_after] *
466 (highest - hw->start_stage + 1);
467 b_param = ad714x->sensor_val[highest] +
468 ad714x->sensor_val[first_before] +
469 ad714x->sensor_val[first_after];
470
471 sw->abs_pos = ((hw->max_coord / (hw->end_stage - hw->start_stage)) *
472 a_param) / b_param;
473
474 if (sw->abs_pos > hw->max_coord)
475 sw->abs_pos = hw->max_coord;
476 else if (sw->abs_pos < 0)
477 sw->abs_pos = 0;
478 }
479
480 static void ad714x_wheel_cal_flt_pos(struct ad714x_chip *ad714x, int idx)
481 {
482 struct ad714x_wheel_plat *hw = &ad714x->hw->wheel[idx];
483 struct ad714x_wheel_drv *sw = &ad714x->sw->wheel[idx];
484 if (((sw->pre_highest_stage == hw->end_stage) &&
485 (sw->highest_stage == hw->start_stage)) ||
486 ((sw->pre_highest_stage == hw->start_stage) &&
487 (sw->highest_stage == hw->end_stage)))
488 sw->flt_pos = sw->abs_pos;
489 else
490 sw->flt_pos = ((sw->flt_pos * 30) + (sw->abs_pos * 71)) / 100;
491
492 if (sw->flt_pos > hw->max_coord)
493 sw->flt_pos = hw->max_coord;
494 }
495
496 static void ad714x_wheel_use_com_int(struct ad714x_chip *ad714x, int idx)
497 {
498 struct ad714x_wheel_plat *hw = &ad714x->hw->wheel[idx];
499
500 ad714x_use_com_int(ad714x, hw->start_stage, hw->end_stage);
501 }
502
503 static void ad714x_wheel_use_thr_int(struct ad714x_chip *ad714x, int idx)
504 {
505 struct ad714x_wheel_plat *hw = &ad714x->hw->wheel[idx];
506
507 ad714x_use_thr_int(ad714x, hw->start_stage, hw->end_stage);
508 }
509
510 static void ad714x_wheel_state_machine(struct ad714x_chip *ad714x, int idx)
511 {
512 struct ad714x_wheel_plat *hw = &ad714x->hw->wheel[idx];
513 struct ad714x_wheel_drv *sw = &ad714x->sw->wheel[idx];
514 unsigned short h_state, c_state;
515 unsigned short mask;
516
517 mask = ((1 << (hw->end_stage + 1)) - 1) - ((1 << hw->start_stage) - 1);
518
519 h_state = ad714x->h_state & mask;
520 c_state = ad714x->c_state & mask;
521
522 switch (sw->state) {
523 case IDLE:
524 if (h_state) {
525 sw->state = JITTER;
526
527
528
529 ad714x_wheel_use_com_int(ad714x, idx);
530 dev_dbg(ad714x->dev, "wheel %d touched\n", idx);
531 }
532 break;
533
534 case JITTER:
535 if (c_state == mask) {
536 ad714x_wheel_cal_sensor_val(ad714x, idx);
537 ad714x_wheel_cal_highest_stage(ad714x, idx);
538 ad714x_wheel_cal_abs_pos(ad714x, idx);
539 sw->flt_pos = sw->abs_pos;
540 sw->state = ACTIVE;
541 }
542 break;
543
544 case ACTIVE:
545 if (c_state == mask) {
546 if (h_state) {
547 ad714x_wheel_cal_sensor_val(ad714x, idx);
548 ad714x_wheel_cal_highest_stage(ad714x, idx);
549 ad714x_wheel_cal_abs_pos(ad714x, idx);
550 ad714x_wheel_cal_flt_pos(ad714x, idx);
551 input_report_abs(sw->input, ABS_WHEEL,
552 sw->flt_pos);
553 input_report_key(sw->input, BTN_TOUCH, 1);
554 } else {
555
556
557
558 ad714x_wheel_use_thr_int(ad714x, idx);
559 sw->state = IDLE;
560 input_report_key(sw->input, BTN_TOUCH, 0);
561
562 dev_dbg(ad714x->dev, "wheel %d released\n",
563 idx);
564 }
565 input_sync(sw->input);
566 }
567 break;
568
569 default:
570 break;
571 }
572 }
573
574 static void touchpad_cal_sensor_val(struct ad714x_chip *ad714x, int idx)
575 {
576 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
577 int i;
578
579 ad714x->read(ad714x, CDC_RESULT_S0 + hw->x_start_stage,
580 &ad714x->adc_reg[hw->x_start_stage],
581 hw->x_end_stage - hw->x_start_stage + 1);
582
583 for (i = hw->x_start_stage; i <= hw->x_end_stage; i++) {
584 ad714x->read(ad714x, STAGE0_AMBIENT + i * PER_STAGE_REG_NUM,
585 &ad714x->amb_reg[i], 1);
586 if (ad714x->adc_reg[i] > ad714x->amb_reg[i])
587 ad714x->sensor_val[i] =
588 ad714x->adc_reg[i] - ad714x->amb_reg[i];
589 else
590 ad714x->sensor_val[i] = 0;
591 }
592 }
593
594 static void touchpad_cal_highest_stage(struct ad714x_chip *ad714x, int idx)
595 {
596 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
597 struct ad714x_touchpad_drv *sw = &ad714x->sw->touchpad[idx];
598
599 sw->x_highest_stage = ad714x_cal_highest_stage(ad714x,
600 hw->x_start_stage, hw->x_end_stage);
601 sw->y_highest_stage = ad714x_cal_highest_stage(ad714x,
602 hw->y_start_stage, hw->y_end_stage);
603
604 dev_dbg(ad714x->dev,
605 "touchpad %d x_highest_stage:%d, y_highest_stage:%d\n",
606 idx, sw->x_highest_stage, sw->y_highest_stage);
607 }
608
609
610
611
612
613
614
615 static int touchpad_check_second_peak(struct ad714x_chip *ad714x, int idx)
616 {
617 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
618 struct ad714x_touchpad_drv *sw = &ad714x->sw->touchpad[idx];
619 int i;
620
621 for (i = hw->x_start_stage; i < sw->x_highest_stage; i++) {
622 if ((ad714x->sensor_val[i] - ad714x->sensor_val[i + 1])
623 > (ad714x->sensor_val[i + 1] / 10))
624 return 1;
625 }
626
627 for (i = sw->x_highest_stage; i < hw->x_end_stage; i++) {
628 if ((ad714x->sensor_val[i + 1] - ad714x->sensor_val[i])
629 > (ad714x->sensor_val[i] / 10))
630 return 1;
631 }
632
633 for (i = hw->y_start_stage; i < sw->y_highest_stage; i++) {
634 if ((ad714x->sensor_val[i] - ad714x->sensor_val[i + 1])
635 > (ad714x->sensor_val[i + 1] / 10))
636 return 1;
637 }
638
639 for (i = sw->y_highest_stage; i < hw->y_end_stage; i++) {
640 if ((ad714x->sensor_val[i + 1] - ad714x->sensor_val[i])
641 > (ad714x->sensor_val[i] / 10))
642 return 1;
643 }
644
645 return 0;
646 }
647
648
649
650
651
652
653
654 static void touchpad_cal_abs_pos(struct ad714x_chip *ad714x, int idx)
655 {
656 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
657 struct ad714x_touchpad_drv *sw = &ad714x->sw->touchpad[idx];
658
659 sw->x_abs_pos = ad714x_cal_abs_pos(ad714x, hw->x_start_stage,
660 hw->x_end_stage, sw->x_highest_stage, hw->x_max_coord);
661 sw->y_abs_pos = ad714x_cal_abs_pos(ad714x, hw->y_start_stage,
662 hw->y_end_stage, sw->y_highest_stage, hw->y_max_coord);
663
664 dev_dbg(ad714x->dev, "touchpad %d absolute position:(%d, %d)\n", idx,
665 sw->x_abs_pos, sw->y_abs_pos);
666 }
667
668 static void touchpad_cal_flt_pos(struct ad714x_chip *ad714x, int idx)
669 {
670 struct ad714x_touchpad_drv *sw = &ad714x->sw->touchpad[idx];
671
672 sw->x_flt_pos = (sw->x_flt_pos * (10 - 4) +
673 sw->x_abs_pos * 4)/10;
674 sw->y_flt_pos = (sw->y_flt_pos * (10 - 4) +
675 sw->y_abs_pos * 4)/10;
676
677 dev_dbg(ad714x->dev, "touchpad %d filter position:(%d, %d)\n",
678 idx, sw->x_flt_pos, sw->y_flt_pos);
679 }
680
681
682
683
684
685
686
687
688
689
690
691
692
693 #define LEFT_END_POINT_DETECTION_LEVEL 550
694 #define RIGHT_END_POINT_DETECTION_LEVEL 750
695 #define LEFT_RIGHT_END_POINT_DEAVTIVALION_LEVEL 850
696 #define TOP_END_POINT_DETECTION_LEVEL 550
697 #define BOTTOM_END_POINT_DETECTION_LEVEL 950
698 #define TOP_BOTTOM_END_POINT_DEAVTIVALION_LEVEL 700
699 static int touchpad_check_endpoint(struct ad714x_chip *ad714x, int idx)
700 {
701 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
702 struct ad714x_touchpad_drv *sw = &ad714x->sw->touchpad[idx];
703 int percent_sensor_diff;
704
705
706 percent_sensor_diff = (ad714x->sensor_val[hw->x_start_stage] -
707 ad714x->sensor_val[hw->x_start_stage + 1]) * 100 /
708 ad714x->sensor_val[hw->x_start_stage + 1];
709 if (!sw->left_ep) {
710 if (percent_sensor_diff >= LEFT_END_POINT_DETECTION_LEVEL) {
711 sw->left_ep = 1;
712 sw->left_ep_val =
713 ad714x->sensor_val[hw->x_start_stage + 1];
714 }
715 } else {
716 if ((percent_sensor_diff < LEFT_END_POINT_DETECTION_LEVEL) &&
717 (ad714x->sensor_val[hw->x_start_stage + 1] >
718 LEFT_RIGHT_END_POINT_DEAVTIVALION_LEVEL + sw->left_ep_val))
719 sw->left_ep = 0;
720 }
721
722
723 percent_sensor_diff = (ad714x->sensor_val[hw->x_end_stage] -
724 ad714x->sensor_val[hw->x_end_stage - 1]) * 100 /
725 ad714x->sensor_val[hw->x_end_stage - 1];
726 if (!sw->right_ep) {
727 if (percent_sensor_diff >= RIGHT_END_POINT_DETECTION_LEVEL) {
728 sw->right_ep = 1;
729 sw->right_ep_val =
730 ad714x->sensor_val[hw->x_end_stage - 1];
731 }
732 } else {
733 if ((percent_sensor_diff < RIGHT_END_POINT_DETECTION_LEVEL) &&
734 (ad714x->sensor_val[hw->x_end_stage - 1] >
735 LEFT_RIGHT_END_POINT_DEAVTIVALION_LEVEL + sw->right_ep_val))
736 sw->right_ep = 0;
737 }
738
739
740 percent_sensor_diff = (ad714x->sensor_val[hw->y_start_stage] -
741 ad714x->sensor_val[hw->y_start_stage + 1]) * 100 /
742 ad714x->sensor_val[hw->y_start_stage + 1];
743 if (!sw->top_ep) {
744 if (percent_sensor_diff >= TOP_END_POINT_DETECTION_LEVEL) {
745 sw->top_ep = 1;
746 sw->top_ep_val =
747 ad714x->sensor_val[hw->y_start_stage + 1];
748 }
749 } else {
750 if ((percent_sensor_diff < TOP_END_POINT_DETECTION_LEVEL) &&
751 (ad714x->sensor_val[hw->y_start_stage + 1] >
752 TOP_BOTTOM_END_POINT_DEAVTIVALION_LEVEL + sw->top_ep_val))
753 sw->top_ep = 0;
754 }
755
756
757 percent_sensor_diff = (ad714x->sensor_val[hw->y_end_stage] -
758 ad714x->sensor_val[hw->y_end_stage - 1]) * 100 /
759 ad714x->sensor_val[hw->y_end_stage - 1];
760 if (!sw->bottom_ep) {
761 if (percent_sensor_diff >= BOTTOM_END_POINT_DETECTION_LEVEL) {
762 sw->bottom_ep = 1;
763 sw->bottom_ep_val =
764 ad714x->sensor_val[hw->y_end_stage - 1];
765 }
766 } else {
767 if ((percent_sensor_diff < BOTTOM_END_POINT_DETECTION_LEVEL) &&
768 (ad714x->sensor_val[hw->y_end_stage - 1] >
769 TOP_BOTTOM_END_POINT_DEAVTIVALION_LEVEL + sw->bottom_ep_val))
770 sw->bottom_ep = 0;
771 }
772
773 return sw->left_ep || sw->right_ep || sw->top_ep || sw->bottom_ep;
774 }
775
776 static void touchpad_use_com_int(struct ad714x_chip *ad714x, int idx)
777 {
778 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
779
780 ad714x_use_com_int(ad714x, hw->x_start_stage, hw->x_end_stage);
781 }
782
783 static void touchpad_use_thr_int(struct ad714x_chip *ad714x, int idx)
784 {
785 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
786
787 ad714x_use_thr_int(ad714x, hw->x_start_stage, hw->x_end_stage);
788 ad714x_use_thr_int(ad714x, hw->y_start_stage, hw->y_end_stage);
789 }
790
791 static void ad714x_touchpad_state_machine(struct ad714x_chip *ad714x, int idx)
792 {
793 struct ad714x_touchpad_plat *hw = &ad714x->hw->touchpad[idx];
794 struct ad714x_touchpad_drv *sw = &ad714x->sw->touchpad[idx];
795 unsigned short h_state, c_state;
796 unsigned short mask;
797
798 mask = (((1 << (hw->x_end_stage + 1)) - 1) -
799 ((1 << hw->x_start_stage) - 1)) +
800 (((1 << (hw->y_end_stage + 1)) - 1) -
801 ((1 << hw->y_start_stage) - 1));
802
803 h_state = ad714x->h_state & mask;
804 c_state = ad714x->c_state & mask;
805
806 switch (sw->state) {
807 case IDLE:
808 if (h_state) {
809 sw->state = JITTER;
810
811
812
813 touchpad_use_com_int(ad714x, idx);
814 dev_dbg(ad714x->dev, "touchpad %d touched\n", idx);
815 }
816 break;
817
818 case JITTER:
819 if (c_state == mask) {
820 touchpad_cal_sensor_val(ad714x, idx);
821 touchpad_cal_highest_stage(ad714x, idx);
822 if ((!touchpad_check_second_peak(ad714x, idx)) &&
823 (!touchpad_check_endpoint(ad714x, idx))) {
824 dev_dbg(ad714x->dev,
825 "touchpad%d, 2 fingers or endpoint\n",
826 idx);
827 touchpad_cal_abs_pos(ad714x, idx);
828 sw->x_flt_pos = sw->x_abs_pos;
829 sw->y_flt_pos = sw->y_abs_pos;
830 sw->state = ACTIVE;
831 }
832 }
833 break;
834
835 case ACTIVE:
836 if (c_state == mask) {
837 if (h_state) {
838 touchpad_cal_sensor_val(ad714x, idx);
839 touchpad_cal_highest_stage(ad714x, idx);
840 if ((!touchpad_check_second_peak(ad714x, idx))
841 && (!touchpad_check_endpoint(ad714x, idx))) {
842 touchpad_cal_abs_pos(ad714x, idx);
843 touchpad_cal_flt_pos(ad714x, idx);
844 input_report_abs(sw->input, ABS_X,
845 sw->x_flt_pos);
846 input_report_abs(sw->input, ABS_Y,
847 sw->y_flt_pos);
848 input_report_key(sw->input, BTN_TOUCH,
849 1);
850 }
851 } else {
852
853
854
855 touchpad_use_thr_int(ad714x, idx);
856 sw->state = IDLE;
857 input_report_key(sw->input, BTN_TOUCH, 0);
858 dev_dbg(ad714x->dev, "touchpad %d released\n",
859 idx);
860 }
861 input_sync(sw->input);
862 }
863 break;
864
865 default:
866 break;
867 }
868 }
869
870 static int ad714x_hw_detect(struct ad714x_chip *ad714x)
871 {
872 unsigned short data;
873
874 ad714x->read(ad714x, AD714X_PARTID_REG, &data, 1);
875 switch (data & 0xFFF0) {
876 case AD7142_PARTID:
877 ad714x->product = 0x7142;
878 ad714x->version = data & 0xF;
879 dev_info(ad714x->dev, "found AD7142 captouch, rev:%d\n",
880 ad714x->version);
881 return 0;
882
883 case AD7143_PARTID:
884 ad714x->product = 0x7143;
885 ad714x->version = data & 0xF;
886 dev_info(ad714x->dev, "found AD7143 captouch, rev:%d\n",
887 ad714x->version);
888 return 0;
889
890 case AD7147_PARTID:
891 ad714x->product = 0x7147;
892 ad714x->version = data & 0xF;
893 dev_info(ad714x->dev, "found AD7147(A) captouch, rev:%d\n",
894 ad714x->version);
895 return 0;
896
897 case AD7148_PARTID:
898 ad714x->product = 0x7148;
899 ad714x->version = data & 0xF;
900 dev_info(ad714x->dev, "found AD7148 captouch, rev:%d\n",
901 ad714x->version);
902 return 0;
903
904 default:
905 dev_err(ad714x->dev,
906 "fail to detect AD714X captouch, read ID is %04x\n",
907 data);
908 return -ENODEV;
909 }
910 }
911
912 static void ad714x_hw_init(struct ad714x_chip *ad714x)
913 {
914 int i, j;
915 unsigned short reg_base;
916 unsigned short data;
917
918
919
920 for (i = 0; i < STAGE_NUM; i++) {
921 reg_base = AD714X_STAGECFG_REG + i * STAGE_CFGREG_NUM;
922 for (j = 0; j < STAGE_CFGREG_NUM; j++)
923 ad714x->write(ad714x, reg_base + j,
924 ad714x->hw->stage_cfg_reg[i][j]);
925 }
926
927 for (i = 0; i < SYS_CFGREG_NUM; i++)
928 ad714x->write(ad714x, AD714X_SYSCFG_REG + i,
929 ad714x->hw->sys_cfg_reg[i]);
930 for (i = 0; i < SYS_CFGREG_NUM; i++)
931 ad714x->read(ad714x, AD714X_SYSCFG_REG + i, &data, 1);
932
933 ad714x->write(ad714x, AD714X_STG_CAL_EN_REG, 0xFFF);
934
935
936 ad714x->read(ad714x, STG_LOW_INT_STA_REG, &ad714x->l_state, 3);
937 }
938
939 static irqreturn_t ad714x_interrupt_thread(int irq, void *data)
940 {
941 struct ad714x_chip *ad714x = data;
942 int i;
943
944 mutex_lock(&ad714x->mutex);
945
946 ad714x->read(ad714x, STG_LOW_INT_STA_REG, &ad714x->l_state, 3);
947
948 for (i = 0; i < ad714x->hw->button_num; i++)
949 ad714x_button_state_machine(ad714x, i);
950 for (i = 0; i < ad714x->hw->slider_num; i++)
951 ad714x_slider_state_machine(ad714x, i);
952 for (i = 0; i < ad714x->hw->wheel_num; i++)
953 ad714x_wheel_state_machine(ad714x, i);
954 for (i = 0; i < ad714x->hw->touchpad_num; i++)
955 ad714x_touchpad_state_machine(ad714x, i);
956
957 mutex_unlock(&ad714x->mutex);
958
959 return IRQ_HANDLED;
960 }
961
962 struct ad714x_chip *ad714x_probe(struct device *dev, u16 bus_type, int irq,
963 ad714x_read_t read, ad714x_write_t write)
964 {
965 int i;
966 int error;
967 struct input_dev *input;
968
969 struct ad714x_platform_data *plat_data = dev_get_platdata(dev);
970 struct ad714x_chip *ad714x;
971 void *drv_mem;
972 unsigned long irqflags;
973
974 struct ad714x_button_drv *bt_drv;
975 struct ad714x_slider_drv *sd_drv;
976 struct ad714x_wheel_drv *wl_drv;
977 struct ad714x_touchpad_drv *tp_drv;
978
979
980 if (irq <= 0) {
981 dev_err(dev, "IRQ not configured!\n");
982 error = -EINVAL;
983 return ERR_PTR(error);
984 }
985
986 if (dev_get_platdata(dev) == NULL) {
987 dev_err(dev, "platform data for ad714x doesn't exist\n");
988 error = -EINVAL;
989 return ERR_PTR(error);
990 }
991
992 ad714x = devm_kzalloc(dev, sizeof(*ad714x) + sizeof(*ad714x->sw) +
993 sizeof(*sd_drv) * plat_data->slider_num +
994 sizeof(*wl_drv) * plat_data->wheel_num +
995 sizeof(*tp_drv) * plat_data->touchpad_num +
996 sizeof(*bt_drv) * plat_data->button_num,
997 GFP_KERNEL);
998 if (!ad714x) {
999 error = -ENOMEM;
1000 return ERR_PTR(error);
1001 }
1002 ad714x->hw = plat_data;
1003
1004 drv_mem = ad714x + 1;
1005 ad714x->sw = drv_mem;
1006 drv_mem += sizeof(*ad714x->sw);
1007 ad714x->sw->slider = sd_drv = drv_mem;
1008 drv_mem += sizeof(*sd_drv) * ad714x->hw->slider_num;
1009 ad714x->sw->wheel = wl_drv = drv_mem;
1010 drv_mem += sizeof(*wl_drv) * ad714x->hw->wheel_num;
1011 ad714x->sw->touchpad = tp_drv = drv_mem;
1012 drv_mem += sizeof(*tp_drv) * ad714x->hw->touchpad_num;
1013 ad714x->sw->button = bt_drv = drv_mem;
1014 drv_mem += sizeof(*bt_drv) * ad714x->hw->button_num;
1015
1016 ad714x->read = read;
1017 ad714x->write = write;
1018 ad714x->irq = irq;
1019 ad714x->dev = dev;
1020
1021 error = ad714x_hw_detect(ad714x);
1022 if (error)
1023 return ERR_PTR(error);
1024
1025
1026
1027 ad714x_hw_init(ad714x);
1028 mutex_init(&ad714x->mutex);
1029
1030
1031 if (ad714x->hw->slider_num > 0) {
1032 struct ad714x_slider_plat *sd_plat = ad714x->hw->slider;
1033
1034 for (i = 0; i < ad714x->hw->slider_num; i++) {
1035 input = devm_input_allocate_device(dev);
1036 if (!input)
1037 return ERR_PTR(-ENOMEM);
1038
1039 __set_bit(EV_ABS, input->evbit);
1040 __set_bit(EV_KEY, input->evbit);
1041 __set_bit(ABS_X, input->absbit);
1042 __set_bit(BTN_TOUCH, input->keybit);
1043 input_set_abs_params(input,
1044 ABS_X, 0, sd_plat->max_coord, 0, 0);
1045
1046 input->id.bustype = bus_type;
1047 input->id.product = ad714x->product;
1048 input->id.version = ad714x->version;
1049 input->name = "ad714x_captouch_slider";
1050 input->dev.parent = dev;
1051
1052 error = input_register_device(input);
1053 if (error)
1054 return ERR_PTR(error);
1055
1056 sd_drv[i].input = input;
1057 }
1058 }
1059
1060
1061 if (ad714x->hw->wheel_num > 0) {
1062 struct ad714x_wheel_plat *wl_plat = ad714x->hw->wheel;
1063
1064 for (i = 0; i < ad714x->hw->wheel_num; i++) {
1065 input = devm_input_allocate_device(dev);
1066 if (!input)
1067 return ERR_PTR(-ENOMEM);
1068
1069 __set_bit(EV_KEY, input->evbit);
1070 __set_bit(EV_ABS, input->evbit);
1071 __set_bit(ABS_WHEEL, input->absbit);
1072 __set_bit(BTN_TOUCH, input->keybit);
1073 input_set_abs_params(input,
1074 ABS_WHEEL, 0, wl_plat->max_coord, 0, 0);
1075
1076 input->id.bustype = bus_type;
1077 input->id.product = ad714x->product;
1078 input->id.version = ad714x->version;
1079 input->name = "ad714x_captouch_wheel";
1080 input->dev.parent = dev;
1081
1082 error = input_register_device(input);
1083 if (error)
1084 return ERR_PTR(error);
1085
1086 wl_drv[i].input = input;
1087 }
1088 }
1089
1090
1091 if (ad714x->hw->touchpad_num > 0) {
1092 struct ad714x_touchpad_plat *tp_plat = ad714x->hw->touchpad;
1093
1094 for (i = 0; i < ad714x->hw->touchpad_num; i++) {
1095 input = devm_input_allocate_device(dev);
1096 if (!input)
1097 return ERR_PTR(-ENOMEM);
1098
1099 __set_bit(EV_ABS, input->evbit);
1100 __set_bit(EV_KEY, input->evbit);
1101 __set_bit(ABS_X, input->absbit);
1102 __set_bit(ABS_Y, input->absbit);
1103 __set_bit(BTN_TOUCH, input->keybit);
1104 input_set_abs_params(input,
1105 ABS_X, 0, tp_plat->x_max_coord, 0, 0);
1106 input_set_abs_params(input,
1107 ABS_Y, 0, tp_plat->y_max_coord, 0, 0);
1108
1109 input->id.bustype = bus_type;
1110 input->id.product = ad714x->product;
1111 input->id.version = ad714x->version;
1112 input->name = "ad714x_captouch_pad";
1113 input->dev.parent = dev;
1114
1115 error = input_register_device(input);
1116 if (error)
1117 return ERR_PTR(error);
1118
1119 tp_drv[i].input = input;
1120 }
1121 }
1122
1123
1124 if (ad714x->hw->button_num > 0) {
1125 struct ad714x_button_plat *bt_plat = ad714x->hw->button;
1126
1127 input = devm_input_allocate_device(dev);
1128 if (!input) {
1129 error = -ENOMEM;
1130 return ERR_PTR(error);
1131 }
1132
1133 __set_bit(EV_KEY, input->evbit);
1134 for (i = 0; i < ad714x->hw->button_num; i++) {
1135 bt_drv[i].input = input;
1136 __set_bit(bt_plat[i].keycode, input->keybit);
1137 }
1138
1139 input->id.bustype = bus_type;
1140 input->id.product = ad714x->product;
1141 input->id.version = ad714x->version;
1142 input->name = "ad714x_captouch_button";
1143 input->dev.parent = dev;
1144
1145 error = input_register_device(input);
1146 if (error)
1147 return ERR_PTR(error);
1148 }
1149
1150 irqflags = plat_data->irqflags ?: IRQF_TRIGGER_FALLING;
1151 irqflags |= IRQF_ONESHOT;
1152
1153 error = devm_request_threaded_irq(dev, ad714x->irq, NULL,
1154 ad714x_interrupt_thread,
1155 irqflags, "ad714x_captouch", ad714x);
1156 if (error) {
1157 dev_err(dev, "can't allocate irq %d\n", ad714x->irq);
1158 return ERR_PTR(error);
1159 }
1160
1161 return ad714x;
1162 }
1163 EXPORT_SYMBOL(ad714x_probe);
1164
1165 #ifdef CONFIG_PM
1166 int ad714x_disable(struct ad714x_chip *ad714x)
1167 {
1168 unsigned short data;
1169
1170 dev_dbg(ad714x->dev, "%s enter\n", __func__);
1171
1172 mutex_lock(&ad714x->mutex);
1173
1174 data = ad714x->hw->sys_cfg_reg[AD714X_PWR_CTRL] | 0x3;
1175 ad714x->write(ad714x, AD714X_PWR_CTRL, data);
1176
1177 mutex_unlock(&ad714x->mutex);
1178
1179 return 0;
1180 }
1181 EXPORT_SYMBOL(ad714x_disable);
1182
1183 int ad714x_enable(struct ad714x_chip *ad714x)
1184 {
1185 dev_dbg(ad714x->dev, "%s enter\n", __func__);
1186
1187 mutex_lock(&ad714x->mutex);
1188
1189
1190
1191 ad714x->write(ad714x, AD714X_PWR_CTRL,
1192 ad714x->hw->sys_cfg_reg[AD714X_PWR_CTRL]);
1193
1194
1195
1196
1197
1198 ad714x->read(ad714x, STG_LOW_INT_STA_REG, &ad714x->l_state, 3);
1199
1200 mutex_unlock(&ad714x->mutex);
1201
1202 return 0;
1203 }
1204 EXPORT_SYMBOL(ad714x_enable);
1205 #endif
1206
1207 MODULE_DESCRIPTION("Analog Devices AD714X Capacitance Touch Sensor Driver");
1208 MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>");
1209 MODULE_LICENSE("GPL");