Linux Audio

Check our new training course

Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0
  2//
  3// Copyright (C) 2014-2015 Pengutronix, Markus Pargmann <mpa@pengutronix.de>
  4// Based on driver from 2011:
  5//   Juergen Beisert, Pengutronix <kernel@pengutronix.de>
  6//
  7// This is the driver for the imx25 TCQ (Touchscreen Conversion Queue)
  8// connected to the imx25 ADC.
 
 
 
 
 
  9
 10#include <linux/clk.h>
 11#include <linux/device.h>
 12#include <linux/input.h>
 13#include <linux/interrupt.h>
 14#include <linux/mfd/imx25-tsadc.h>
 15#include <linux/module.h>
 16#include <linux/of.h>
 17#include <linux/platform_device.h>
 18#include <linux/regmap.h>
 19
 20static const char mx25_tcq_name[] = "mx25-tcq";
 21
 22enum mx25_tcq_mode {
 23	MX25_TS_4WIRE,
 24};
 25
 26struct mx25_tcq_priv {
 27	struct regmap *regs;
 28	struct regmap *core_regs;
 29	struct input_dev *idev;
 30	enum mx25_tcq_mode mode;
 31	unsigned int pen_threshold;
 32	unsigned int sample_count;
 33	unsigned int expected_samples;
 34	unsigned int pen_debounce;
 35	unsigned int settling_time;
 36	struct clk *clk;
 37	int irq;
 38	struct device *dev;
 39};
 40
 41static const struct regmap_config mx25_tcq_regconfig = {
 42	.fast_io = true,
 43	.max_register = 0x5c,
 44	.reg_bits = 32,
 45	.val_bits = 32,
 46	.reg_stride = 4,
 47};
 48
 49static const struct of_device_id mx25_tcq_ids[] = {
 50	{ .compatible = "fsl,imx25-tcq", },
 51	{ /* Sentinel */ }
 52};
 53MODULE_DEVICE_TABLE(of, mx25_tcq_ids);
 54
 55#define TSC_4WIRE_PRE_INDEX 0
 56#define TSC_4WIRE_X_INDEX 1
 57#define TSC_4WIRE_Y_INDEX 2
 58#define TSC_4WIRE_POST_INDEX 3
 59#define TSC_4WIRE_LEAVE 4
 60
 61#define MX25_TSC_DEF_THRESHOLD 80
 62#define TSC_MAX_SAMPLES 16
 63
 64#define MX25_TSC_REPEAT_WAIT 14
 65
 66enum mx25_adc_configurations {
 67	MX25_CFG_PRECHARGE = 0,
 68	MX25_CFG_TOUCH_DETECT,
 69	MX25_CFG_X_MEASUREMENT,
 70	MX25_CFG_Y_MEASUREMENT,
 71};
 72
 73#define MX25_PRECHARGE_VALUE (\
 74			MX25_ADCQ_CFG_YPLL_OFF | \
 75			MX25_ADCQ_CFG_XNUR_OFF | \
 76			MX25_ADCQ_CFG_XPUL_HIGH | \
 77			MX25_ADCQ_CFG_REFP_INT | \
 78			MX25_ADCQ_CFG_IN_XP | \
 79			MX25_ADCQ_CFG_REFN_NGND2 | \
 80			MX25_ADCQ_CFG_IGS)
 81
 82#define MX25_TOUCH_DETECT_VALUE (\
 83			MX25_ADCQ_CFG_YNLR | \
 84			MX25_ADCQ_CFG_YPLL_OFF | \
 85			MX25_ADCQ_CFG_XNUR_OFF | \
 86			MX25_ADCQ_CFG_XPUL_OFF | \
 87			MX25_ADCQ_CFG_REFP_INT | \
 88			MX25_ADCQ_CFG_IN_XP | \
 89			MX25_ADCQ_CFG_REFN_NGND2 | \
 90			MX25_ADCQ_CFG_PENIACK)
 91
 92static void imx25_setup_queue_cfgs(struct mx25_tcq_priv *priv,
 93				   unsigned int settling_cnt)
 94{
 95	u32 precharge_cfg =
 96			MX25_PRECHARGE_VALUE |
 97			MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt);
 98	u32 touch_detect_cfg =
 99			MX25_TOUCH_DETECT_VALUE |
100			MX25_ADCQ_CFG_NOS(1) |
101			MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt);
102
103	regmap_write(priv->core_regs, MX25_TSC_TICR, precharge_cfg);
104
105	/* PRECHARGE */
106	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_PRECHARGE),
107		     precharge_cfg);
108
109	/* TOUCH_DETECT */
110	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_TOUCH_DETECT),
111		     touch_detect_cfg);
112
113	/* X Measurement */
114	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_X_MEASUREMENT),
115		     MX25_ADCQ_CFG_YPLL_OFF |
116		     MX25_ADCQ_CFG_XNUR_LOW |
117		     MX25_ADCQ_CFG_XPUL_HIGH |
118		     MX25_ADCQ_CFG_REFP_XP |
119		     MX25_ADCQ_CFG_IN_YP |
120		     MX25_ADCQ_CFG_REFN_XN |
121		     MX25_ADCQ_CFG_NOS(priv->sample_count) |
122		     MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt));
123
124	/* Y Measurement */
125	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_Y_MEASUREMENT),
126		     MX25_ADCQ_CFG_YNLR |
127		     MX25_ADCQ_CFG_YPLL_HIGH |
128		     MX25_ADCQ_CFG_XNUR_OFF |
129		     MX25_ADCQ_CFG_XPUL_OFF |
130		     MX25_ADCQ_CFG_REFP_YP |
131		     MX25_ADCQ_CFG_IN_XP |
132		     MX25_ADCQ_CFG_REFN_YN |
133		     MX25_ADCQ_CFG_NOS(priv->sample_count) |
134		     MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt));
135
136	/* Enable the touch detection right now */
137	regmap_write(priv->core_regs, MX25_TSC_TICR, touch_detect_cfg |
138		     MX25_ADCQ_CFG_IGS);
139}
140
141static int imx25_setup_queue_4wire(struct mx25_tcq_priv *priv,
142				   unsigned settling_cnt, int *items)
143{
144	imx25_setup_queue_cfgs(priv, settling_cnt);
145
146	/* Setup the conversion queue */
147	regmap_write(priv->regs, MX25_ADCQ_ITEM_7_0,
148		     MX25_ADCQ_ITEM(0, MX25_CFG_PRECHARGE) |
149		     MX25_ADCQ_ITEM(1, MX25_CFG_TOUCH_DETECT) |
150		     MX25_ADCQ_ITEM(2, MX25_CFG_X_MEASUREMENT) |
151		     MX25_ADCQ_ITEM(3, MX25_CFG_Y_MEASUREMENT) |
152		     MX25_ADCQ_ITEM(4, MX25_CFG_PRECHARGE) |
153		     MX25_ADCQ_ITEM(5, MX25_CFG_TOUCH_DETECT));
154
155	/*
156	 * We measure X/Y with 'sample_count' number of samples and execute a
157	 * touch detection twice, with 1 sample each
158	 */
159	priv->expected_samples = priv->sample_count * 2 + 2;
160	*items = 6;
161
162	return 0;
163}
164
165static void mx25_tcq_disable_touch_irq(struct mx25_tcq_priv *priv)
166{
167	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_PDMSK,
168			   MX25_ADCQ_CR_PDMSK);
169}
170
171static void mx25_tcq_enable_touch_irq(struct mx25_tcq_priv *priv)
172{
173	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_PDMSK, 0);
174}
175
176static void mx25_tcq_disable_fifo_irq(struct mx25_tcq_priv *priv)
177{
178	regmap_update_bits(priv->regs, MX25_ADCQ_MR, MX25_ADCQ_MR_FDRY_IRQ,
179			   MX25_ADCQ_MR_FDRY_IRQ);
180}
181
182static void mx25_tcq_enable_fifo_irq(struct mx25_tcq_priv *priv)
183{
184	regmap_update_bits(priv->regs, MX25_ADCQ_MR, MX25_ADCQ_MR_FDRY_IRQ, 0);
185}
186
187static void mx25_tcq_force_queue_start(struct mx25_tcq_priv *priv)
188{
189	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
190			   MX25_ADCQ_CR_FQS,
191			   MX25_ADCQ_CR_FQS);
192}
193
194static void mx25_tcq_force_queue_stop(struct mx25_tcq_priv *priv)
195{
196	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
197			   MX25_ADCQ_CR_FQS, 0);
198}
199
200static void mx25_tcq_fifo_reset(struct mx25_tcq_priv *priv)
201{
202	u32 tcqcr;
203
204	regmap_read(priv->regs, MX25_ADCQ_CR, &tcqcr);
205	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_FRST,
206			   MX25_ADCQ_CR_FRST);
207	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_FRST, 0);
208	regmap_write(priv->regs, MX25_ADCQ_CR, tcqcr);
209}
210
211static void mx25_tcq_re_enable_touch_detection(struct mx25_tcq_priv *priv)
212{
213	/* stop the queue from looping */
214	mx25_tcq_force_queue_stop(priv);
215
216	/* for a clean touch detection, preload the X plane */
217	regmap_write(priv->core_regs, MX25_TSC_TICR, MX25_PRECHARGE_VALUE);
218
219	/* waste some time now to pre-load the X plate to high voltage */
220	mx25_tcq_fifo_reset(priv);
221
222	/* re-enable the detection right now */
223	regmap_write(priv->core_regs, MX25_TSC_TICR,
224		     MX25_TOUCH_DETECT_VALUE | MX25_ADCQ_CFG_IGS);
225
226	regmap_update_bits(priv->regs, MX25_ADCQ_SR, MX25_ADCQ_SR_PD,
227			   MX25_ADCQ_SR_PD);
228
229	/* enable the pen down event to be a source for the interrupt */
230	regmap_update_bits(priv->regs, MX25_ADCQ_MR, MX25_ADCQ_MR_PD_IRQ, 0);
231
232	/* lets fire the next IRQ if someone touches the touchscreen */
233	mx25_tcq_enable_touch_irq(priv);
234}
235
236static void mx25_tcq_create_event_for_4wire(struct mx25_tcq_priv *priv,
237					    u32 *sample_buf,
238					    unsigned int samples)
239{
240	unsigned int x_pos = 0;
241	unsigned int y_pos = 0;
242	unsigned int touch_pre = 0;
243	unsigned int touch_post = 0;
244	unsigned int i;
245
246	for (i = 0; i < samples; i++) {
247		unsigned int index = MX25_ADCQ_FIFO_ID(sample_buf[i]);
248		unsigned int val = MX25_ADCQ_FIFO_DATA(sample_buf[i]);
249
250		switch (index) {
251		case 1:
252			touch_pre = val;
253			break;
254		case 2:
255			x_pos = val;
256			break;
257		case 3:
258			y_pos = val;
259			break;
260		case 5:
261			touch_post = val;
262			break;
263		default:
264			dev_dbg(priv->dev, "Dropped samples because of invalid index %d\n",
265				index);
266			return;
267		}
268	}
269
270	if (samples != 0) {
271		/*
272		 * only if both touch measures are below a threshold,
273		 * the position is valid
274		 */
275		if (touch_pre < priv->pen_threshold &&
276		    touch_post < priv->pen_threshold) {
277			/* valid samples, generate a report */
278			x_pos /= priv->sample_count;
279			y_pos /= priv->sample_count;
280			input_report_abs(priv->idev, ABS_X, x_pos);
281			input_report_abs(priv->idev, ABS_Y, y_pos);
282			input_report_key(priv->idev, BTN_TOUCH, 1);
283			input_sync(priv->idev);
284
285			/* get next sample */
286			mx25_tcq_enable_fifo_irq(priv);
287		} else if (touch_pre >= priv->pen_threshold &&
288			   touch_post >= priv->pen_threshold) {
289			/*
290			 * if both samples are invalid,
291			 * generate a release report
292			 */
293			input_report_key(priv->idev, BTN_TOUCH, 0);
294			input_sync(priv->idev);
295			mx25_tcq_re_enable_touch_detection(priv);
296		} else {
297			/*
298			 * if only one of both touch measurements are
299			 * below the threshold, still some bouncing
300			 * happens. Take additional samples in this
301			 * case to be sure
302			 */
303			mx25_tcq_enable_fifo_irq(priv);
304		}
305	}
306}
307
308static irqreturn_t mx25_tcq_irq_thread(int irq, void *dev_id)
309{
310	struct mx25_tcq_priv *priv = dev_id;
311	u32 sample_buf[TSC_MAX_SAMPLES];
312	unsigned int samples;
313	u32 stats;
314	unsigned int i;
315
316	/*
317	 * Check how many samples are available. We always have to read exactly
318	 * sample_count samples from the fifo, or a multiple of sample_count.
319	 * Otherwise we mixup samples into different touch events.
320	 */
321	regmap_read(priv->regs, MX25_ADCQ_SR, &stats);
322	samples = MX25_ADCQ_SR_FDN(stats);
323	samples -= samples % priv->sample_count;
324
325	if (!samples)
326		return IRQ_HANDLED;
327
328	for (i = 0; i != samples; ++i)
329		regmap_read(priv->regs, MX25_ADCQ_FIFO, &sample_buf[i]);
330
331	mx25_tcq_create_event_for_4wire(priv, sample_buf, samples);
332
333	return IRQ_HANDLED;
334}
335
336static irqreturn_t mx25_tcq_irq(int irq, void *dev_id)
337{
338	struct mx25_tcq_priv *priv = dev_id;
339	u32 stat;
340	int ret = IRQ_HANDLED;
341
342	regmap_read(priv->regs, MX25_ADCQ_SR, &stat);
343
344	if (stat & (MX25_ADCQ_SR_FRR | MX25_ADCQ_SR_FUR | MX25_ADCQ_SR_FOR))
345		mx25_tcq_re_enable_touch_detection(priv);
346
347	if (stat & MX25_ADCQ_SR_PD) {
348		mx25_tcq_disable_touch_irq(priv);
349		mx25_tcq_force_queue_start(priv);
350		mx25_tcq_enable_fifo_irq(priv);
351	}
352
353	if (stat & MX25_ADCQ_SR_FDRY) {
354		mx25_tcq_disable_fifo_irq(priv);
355		ret = IRQ_WAKE_THREAD;
356	}
357
358	regmap_update_bits(priv->regs, MX25_ADCQ_SR, MX25_ADCQ_SR_FRR |
359			   MX25_ADCQ_SR_FUR | MX25_ADCQ_SR_FOR |
360			   MX25_ADCQ_SR_PD,
361			   MX25_ADCQ_SR_FRR | MX25_ADCQ_SR_FUR |
362			   MX25_ADCQ_SR_FOR | MX25_ADCQ_SR_PD);
363
364	return ret;
365}
366
367/* configure the state machine for a 4-wire touchscreen */
368static int mx25_tcq_init(struct mx25_tcq_priv *priv)
369{
370	u32 tgcr;
371	unsigned int ipg_div;
372	unsigned int adc_period;
373	unsigned int debounce_cnt;
374	unsigned int settling_cnt;
375	int itemct;
376	int error;
377
378	regmap_read(priv->core_regs, MX25_TSC_TGCR, &tgcr);
379	ipg_div = max_t(unsigned int, 4, MX25_TGCR_GET_ADCCLK(tgcr));
380	adc_period = USEC_PER_SEC * ipg_div * 2 + 2;
381	adc_period /= clk_get_rate(priv->clk) / 1000 + 1;
382	debounce_cnt = DIV_ROUND_UP(priv->pen_debounce, adc_period * 8) - 1;
383	settling_cnt = DIV_ROUND_UP(priv->settling_time, adc_period * 8) - 1;
384
385	/* Reset */
386	regmap_write(priv->regs, MX25_ADCQ_CR,
387		     MX25_ADCQ_CR_QRST | MX25_ADCQ_CR_FRST);
388	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
389			   MX25_ADCQ_CR_QRST | MX25_ADCQ_CR_FRST, 0);
390
391	/* up to 128 * 8 ADC clocks are possible */
392	if (debounce_cnt > 127)
393		debounce_cnt = 127;
394
395	/* up to 255 * 8 ADC clocks are possible */
396	if (settling_cnt > 255)
397		settling_cnt = 255;
398
399	error = imx25_setup_queue_4wire(priv, settling_cnt, &itemct);
400	if (error)
401		return error;
402
403	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
404			   MX25_ADCQ_CR_LITEMID_MASK | MX25_ADCQ_CR_WMRK_MASK,
405			   MX25_ADCQ_CR_LITEMID(itemct - 1) |
406			   MX25_ADCQ_CR_WMRK(priv->expected_samples - 1));
407
408	/* setup debounce count */
409	regmap_update_bits(priv->core_regs, MX25_TSC_TGCR,
410			   MX25_TGCR_PDBTIME_MASK,
411			   MX25_TGCR_PDBTIME(debounce_cnt));
412
413	/* enable debounce */
414	regmap_update_bits(priv->core_regs, MX25_TSC_TGCR, MX25_TGCR_PDBEN,
415			   MX25_TGCR_PDBEN);
416	regmap_update_bits(priv->core_regs, MX25_TSC_TGCR, MX25_TGCR_PDEN,
417			   MX25_TGCR_PDEN);
418
419	/* enable the engine on demand */
420	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_QSM_MASK,
421			   MX25_ADCQ_CR_QSM_FQS);
422
423	/* Enable repeat and repeat wait */
424	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
425			   MX25_ADCQ_CR_RPT | MX25_ADCQ_CR_RWAIT_MASK,
426			   MX25_ADCQ_CR_RPT |
427			   MX25_ADCQ_CR_RWAIT(MX25_TSC_REPEAT_WAIT));
428
429	return 0;
430}
431
432static int mx25_tcq_parse_dt(struct platform_device *pdev,
433			     struct mx25_tcq_priv *priv)
434{
435	struct device_node *np = pdev->dev.of_node;
436	u32 wires;
437	int error;
438
439	/* Setup defaults */
440	priv->pen_threshold = 500;
441	priv->sample_count = 3;
442	priv->pen_debounce = 1000000;
443	priv->settling_time = 250000;
444
445	error = of_property_read_u32(np, "fsl,wires", &wires);
446	if (error) {
447		dev_err(&pdev->dev, "Failed to find fsl,wires properties\n");
448		return error;
449	}
450
451	if (wires == 4) {
452		priv->mode = MX25_TS_4WIRE;
453	} else {
454		dev_err(&pdev->dev, "%u-wire mode not supported\n", wires);
455		return -EINVAL;
456	}
457
458	/* These are optional, we don't care about the return values */
459	of_property_read_u32(np, "fsl,pen-threshold", &priv->pen_threshold);
460	of_property_read_u32(np, "fsl,settling-time-ns", &priv->settling_time);
461	of_property_read_u32(np, "fsl,pen-debounce-ns", &priv->pen_debounce);
462
463	return 0;
464}
465
466static int mx25_tcq_open(struct input_dev *idev)
467{
468	struct device *dev = &idev->dev;
469	struct mx25_tcq_priv *priv = dev_get_drvdata(dev);
470	int error;
471
472	error = clk_prepare_enable(priv->clk);
473	if (error) {
474		dev_err(dev, "Failed to enable ipg clock\n");
475		return error;
476	}
477
478	error = mx25_tcq_init(priv);
479	if (error) {
480		dev_err(dev, "Failed to init tcq\n");
481		clk_disable_unprepare(priv->clk);
482		return error;
483	}
484
485	mx25_tcq_re_enable_touch_detection(priv);
486
487	return 0;
488}
489
490static void mx25_tcq_close(struct input_dev *idev)
491{
492	struct mx25_tcq_priv *priv = input_get_drvdata(idev);
493
494	mx25_tcq_force_queue_stop(priv);
495	mx25_tcq_disable_touch_irq(priv);
496	mx25_tcq_disable_fifo_irq(priv);
497	clk_disable_unprepare(priv->clk);
498}
499
500static int mx25_tcq_probe(struct platform_device *pdev)
501{
502	struct device *dev = &pdev->dev;
503	struct input_dev *idev;
504	struct mx25_tcq_priv *priv;
505	struct mx25_tsadc *tsadc = dev_get_drvdata(dev->parent);
 
506	void __iomem *mem;
507	int error;
508
509	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
510	if (!priv)
511		return -ENOMEM;
512	priv->dev = dev;
513
514	mem = devm_platform_ioremap_resource(pdev, 0);
 
515	if (IS_ERR(mem))
516		return PTR_ERR(mem);
517
518	error = mx25_tcq_parse_dt(pdev, priv);
519	if (error)
520		return error;
521
522	priv->regs = devm_regmap_init_mmio(dev, mem, &mx25_tcq_regconfig);
523	if (IS_ERR(priv->regs)) {
524		dev_err(dev, "Failed to initialize regmap\n");
525		return PTR_ERR(priv->regs);
526	}
527
528	priv->irq = platform_get_irq(pdev, 0);
529	if (priv->irq <= 0)
 
530		return priv->irq;
 
531
532	idev = devm_input_allocate_device(dev);
533	if (!idev) {
534		dev_err(dev, "Failed to allocate input device\n");
535		return -ENOMEM;
536	}
537
538	idev->name = mx25_tcq_name;
539	input_set_capability(idev, EV_KEY, BTN_TOUCH);
540	input_set_abs_params(idev, ABS_X, 0, 0xfff, 0, 0);
541	input_set_abs_params(idev, ABS_Y, 0, 0xfff, 0, 0);
542
543	idev->id.bustype = BUS_HOST;
544	idev->open = mx25_tcq_open;
545	idev->close = mx25_tcq_close;
546
547	priv->idev = idev;
548	input_set_drvdata(idev, priv);
549
550	priv->core_regs = tsadc->regs;
551	if (!priv->core_regs)
552		return -EINVAL;
553
554	priv->clk = tsadc->clk;
555	if (!priv->clk)
556		return -EINVAL;
557
558	platform_set_drvdata(pdev, priv);
559
560	error = devm_request_threaded_irq(dev, priv->irq, mx25_tcq_irq,
561					  mx25_tcq_irq_thread, 0, pdev->name,
562					  priv);
563	if (error) {
564		dev_err(dev, "Failed requesting IRQ\n");
565		return error;
566	}
567
568	error = input_register_device(idev);
569	if (error) {
570		dev_err(dev, "Failed to register input device\n");
571		return error;
572	}
573
574	return 0;
575}
576
577static struct platform_driver mx25_tcq_driver = {
578	.driver		= {
579		.name	= "mx25-tcq",
580		.of_match_table = mx25_tcq_ids,
581	},
582	.probe		= mx25_tcq_probe,
583};
584module_platform_driver(mx25_tcq_driver);
585
586MODULE_DESCRIPTION("TS input driver for Freescale mx25");
587MODULE_AUTHOR("Markus Pargmann <mpa@pengutronix.de>");
588MODULE_LICENSE("GPL v2");
v4.17
  1/*
  2 * Copyright (C) 2014-2015 Pengutronix, Markus Pargmann <mpa@pengutronix.de>
  3 *
  4 * This program is free software; you can redistribute it and/or modify it under
  5 * the terms of the GNU General Public License version 2 as published by the
  6 * Free Software Foundation.
  7 *
  8 * Based on driver from 2011:
  9 *   Juergen Beisert, Pengutronix <kernel@pengutronix.de>
 10 *
 11 * This is the driver for the imx25 TCQ (Touchscreen Conversion Queue)
 12 * connected to the imx25 ADC.
 13 */
 14
 15#include <linux/clk.h>
 16#include <linux/device.h>
 17#include <linux/input.h>
 18#include <linux/interrupt.h>
 19#include <linux/mfd/imx25-tsadc.h>
 20#include <linux/module.h>
 21#include <linux/of.h>
 22#include <linux/platform_device.h>
 23#include <linux/regmap.h>
 24
 25static const char mx25_tcq_name[] = "mx25-tcq";
 26
 27enum mx25_tcq_mode {
 28	MX25_TS_4WIRE,
 29};
 30
 31struct mx25_tcq_priv {
 32	struct regmap *regs;
 33	struct regmap *core_regs;
 34	struct input_dev *idev;
 35	enum mx25_tcq_mode mode;
 36	unsigned int pen_threshold;
 37	unsigned int sample_count;
 38	unsigned int expected_samples;
 39	unsigned int pen_debounce;
 40	unsigned int settling_time;
 41	struct clk *clk;
 42	int irq;
 43	struct device *dev;
 44};
 45
 46static struct regmap_config mx25_tcq_regconfig = {
 47	.fast_io = true,
 48	.max_register = 0x5c,
 49	.reg_bits = 32,
 50	.val_bits = 32,
 51	.reg_stride = 4,
 52};
 53
 54static const struct of_device_id mx25_tcq_ids[] = {
 55	{ .compatible = "fsl,imx25-tcq", },
 56	{ /* Sentinel */ }
 57};
 58MODULE_DEVICE_TABLE(of, mx25_tcq_ids);
 59
 60#define TSC_4WIRE_PRE_INDEX 0
 61#define TSC_4WIRE_X_INDEX 1
 62#define TSC_4WIRE_Y_INDEX 2
 63#define TSC_4WIRE_POST_INDEX 3
 64#define TSC_4WIRE_LEAVE 4
 65
 66#define MX25_TSC_DEF_THRESHOLD 80
 67#define TSC_MAX_SAMPLES 16
 68
 69#define MX25_TSC_REPEAT_WAIT 14
 70
 71enum mx25_adc_configurations {
 72	MX25_CFG_PRECHARGE = 0,
 73	MX25_CFG_TOUCH_DETECT,
 74	MX25_CFG_X_MEASUREMENT,
 75	MX25_CFG_Y_MEASUREMENT,
 76};
 77
 78#define MX25_PRECHARGE_VALUE (\
 79			MX25_ADCQ_CFG_YPLL_OFF | \
 80			MX25_ADCQ_CFG_XNUR_OFF | \
 81			MX25_ADCQ_CFG_XPUL_HIGH | \
 82			MX25_ADCQ_CFG_REFP_INT | \
 83			MX25_ADCQ_CFG_IN_XP | \
 84			MX25_ADCQ_CFG_REFN_NGND2 | \
 85			MX25_ADCQ_CFG_IGS)
 86
 87#define MX25_TOUCH_DETECT_VALUE (\
 88			MX25_ADCQ_CFG_YNLR | \
 89			MX25_ADCQ_CFG_YPLL_OFF | \
 90			MX25_ADCQ_CFG_XNUR_OFF | \
 91			MX25_ADCQ_CFG_XPUL_OFF | \
 92			MX25_ADCQ_CFG_REFP_INT | \
 93			MX25_ADCQ_CFG_IN_XP | \
 94			MX25_ADCQ_CFG_REFN_NGND2 | \
 95			MX25_ADCQ_CFG_PENIACK)
 96
 97static void imx25_setup_queue_cfgs(struct mx25_tcq_priv *priv,
 98				   unsigned int settling_cnt)
 99{
100	u32 precharge_cfg =
101			MX25_PRECHARGE_VALUE |
102			MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt);
103	u32 touch_detect_cfg =
104			MX25_TOUCH_DETECT_VALUE |
105			MX25_ADCQ_CFG_NOS(1) |
106			MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt);
107
108	regmap_write(priv->core_regs, MX25_TSC_TICR, precharge_cfg);
109
110	/* PRECHARGE */
111	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_PRECHARGE),
112		     precharge_cfg);
113
114	/* TOUCH_DETECT */
115	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_TOUCH_DETECT),
116		     touch_detect_cfg);
117
118	/* X Measurement */
119	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_X_MEASUREMENT),
120		     MX25_ADCQ_CFG_YPLL_OFF |
121		     MX25_ADCQ_CFG_XNUR_LOW |
122		     MX25_ADCQ_CFG_XPUL_HIGH |
123		     MX25_ADCQ_CFG_REFP_XP |
124		     MX25_ADCQ_CFG_IN_YP |
125		     MX25_ADCQ_CFG_REFN_XN |
126		     MX25_ADCQ_CFG_NOS(priv->sample_count) |
127		     MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt));
128
129	/* Y Measurement */
130	regmap_write(priv->regs, MX25_ADCQ_CFG(MX25_CFG_Y_MEASUREMENT),
131		     MX25_ADCQ_CFG_YNLR |
132		     MX25_ADCQ_CFG_YPLL_HIGH |
133		     MX25_ADCQ_CFG_XNUR_OFF |
134		     MX25_ADCQ_CFG_XPUL_OFF |
135		     MX25_ADCQ_CFG_REFP_YP |
136		     MX25_ADCQ_CFG_IN_XP |
137		     MX25_ADCQ_CFG_REFN_YN |
138		     MX25_ADCQ_CFG_NOS(priv->sample_count) |
139		     MX25_ADCQ_CFG_SETTLING_TIME(settling_cnt));
140
141	/* Enable the touch detection right now */
142	regmap_write(priv->core_regs, MX25_TSC_TICR, touch_detect_cfg |
143		     MX25_ADCQ_CFG_IGS);
144}
145
146static int imx25_setup_queue_4wire(struct mx25_tcq_priv *priv,
147				   unsigned settling_cnt, int *items)
148{
149	imx25_setup_queue_cfgs(priv, settling_cnt);
150
151	/* Setup the conversion queue */
152	regmap_write(priv->regs, MX25_ADCQ_ITEM_7_0,
153		     MX25_ADCQ_ITEM(0, MX25_CFG_PRECHARGE) |
154		     MX25_ADCQ_ITEM(1, MX25_CFG_TOUCH_DETECT) |
155		     MX25_ADCQ_ITEM(2, MX25_CFG_X_MEASUREMENT) |
156		     MX25_ADCQ_ITEM(3, MX25_CFG_Y_MEASUREMENT) |
157		     MX25_ADCQ_ITEM(4, MX25_CFG_PRECHARGE) |
158		     MX25_ADCQ_ITEM(5, MX25_CFG_TOUCH_DETECT));
159
160	/*
161	 * We measure X/Y with 'sample_count' number of samples and execute a
162	 * touch detection twice, with 1 sample each
163	 */
164	priv->expected_samples = priv->sample_count * 2 + 2;
165	*items = 6;
166
167	return 0;
168}
169
170static void mx25_tcq_disable_touch_irq(struct mx25_tcq_priv *priv)
171{
172	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_PDMSK,
173			   MX25_ADCQ_CR_PDMSK);
174}
175
176static void mx25_tcq_enable_touch_irq(struct mx25_tcq_priv *priv)
177{
178	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_PDMSK, 0);
179}
180
181static void mx25_tcq_disable_fifo_irq(struct mx25_tcq_priv *priv)
182{
183	regmap_update_bits(priv->regs, MX25_ADCQ_MR, MX25_ADCQ_MR_FDRY_IRQ,
184			   MX25_ADCQ_MR_FDRY_IRQ);
185}
186
187static void mx25_tcq_enable_fifo_irq(struct mx25_tcq_priv *priv)
188{
189	regmap_update_bits(priv->regs, MX25_ADCQ_MR, MX25_ADCQ_MR_FDRY_IRQ, 0);
190}
191
192static void mx25_tcq_force_queue_start(struct mx25_tcq_priv *priv)
193{
194	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
195			   MX25_ADCQ_CR_FQS,
196			   MX25_ADCQ_CR_FQS);
197}
198
199static void mx25_tcq_force_queue_stop(struct mx25_tcq_priv *priv)
200{
201	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
202			   MX25_ADCQ_CR_FQS, 0);
203}
204
205static void mx25_tcq_fifo_reset(struct mx25_tcq_priv *priv)
206{
207	u32 tcqcr;
208
209	regmap_read(priv->regs, MX25_ADCQ_CR, &tcqcr);
210	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_FRST,
211			   MX25_ADCQ_CR_FRST);
212	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_FRST, 0);
213	regmap_write(priv->regs, MX25_ADCQ_CR, tcqcr);
214}
215
216static void mx25_tcq_re_enable_touch_detection(struct mx25_tcq_priv *priv)
217{
218	/* stop the queue from looping */
219	mx25_tcq_force_queue_stop(priv);
220
221	/* for a clean touch detection, preload the X plane */
222	regmap_write(priv->core_regs, MX25_TSC_TICR, MX25_PRECHARGE_VALUE);
223
224	/* waste some time now to pre-load the X plate to high voltage */
225	mx25_tcq_fifo_reset(priv);
226
227	/* re-enable the detection right now */
228	regmap_write(priv->core_regs, MX25_TSC_TICR,
229		     MX25_TOUCH_DETECT_VALUE | MX25_ADCQ_CFG_IGS);
230
231	regmap_update_bits(priv->regs, MX25_ADCQ_SR, MX25_ADCQ_SR_PD,
232			   MX25_ADCQ_SR_PD);
233
234	/* enable the pen down event to be a source for the interrupt */
235	regmap_update_bits(priv->regs, MX25_ADCQ_MR, MX25_ADCQ_MR_PD_IRQ, 0);
236
237	/* lets fire the next IRQ if someone touches the touchscreen */
238	mx25_tcq_enable_touch_irq(priv);
239}
240
241static void mx25_tcq_create_event_for_4wire(struct mx25_tcq_priv *priv,
242					    u32 *sample_buf,
243					    unsigned int samples)
244{
245	unsigned int x_pos = 0;
246	unsigned int y_pos = 0;
247	unsigned int touch_pre = 0;
248	unsigned int touch_post = 0;
249	unsigned int i;
250
251	for (i = 0; i < samples; i++) {
252		unsigned int index = MX25_ADCQ_FIFO_ID(sample_buf[i]);
253		unsigned int val = MX25_ADCQ_FIFO_DATA(sample_buf[i]);
254
255		switch (index) {
256		case 1:
257			touch_pre = val;
258			break;
259		case 2:
260			x_pos = val;
261			break;
262		case 3:
263			y_pos = val;
264			break;
265		case 5:
266			touch_post = val;
267			break;
268		default:
269			dev_dbg(priv->dev, "Dropped samples because of invalid index %d\n",
270				index);
271			return;
272		}
273	}
274
275	if (samples != 0) {
276		/*
277		 * only if both touch measures are below a threshold,
278		 * the position is valid
279		 */
280		if (touch_pre < priv->pen_threshold &&
281		    touch_post < priv->pen_threshold) {
282			/* valid samples, generate a report */
283			x_pos /= priv->sample_count;
284			y_pos /= priv->sample_count;
285			input_report_abs(priv->idev, ABS_X, x_pos);
286			input_report_abs(priv->idev, ABS_Y, y_pos);
287			input_report_key(priv->idev, BTN_TOUCH, 1);
288			input_sync(priv->idev);
289
290			/* get next sample */
291			mx25_tcq_enable_fifo_irq(priv);
292		} else if (touch_pre >= priv->pen_threshold &&
293			   touch_post >= priv->pen_threshold) {
294			/*
295			 * if both samples are invalid,
296			 * generate a release report
297			 */
298			input_report_key(priv->idev, BTN_TOUCH, 0);
299			input_sync(priv->idev);
300			mx25_tcq_re_enable_touch_detection(priv);
301		} else {
302			/*
303			 * if only one of both touch measurements are
304			 * below the threshold, still some bouncing
305			 * happens. Take additional samples in this
306			 * case to be sure
307			 */
308			mx25_tcq_enable_fifo_irq(priv);
309		}
310	}
311}
312
313static irqreturn_t mx25_tcq_irq_thread(int irq, void *dev_id)
314{
315	struct mx25_tcq_priv *priv = dev_id;
316	u32 sample_buf[TSC_MAX_SAMPLES];
317	unsigned int samples;
318	u32 stats;
319	unsigned int i;
320
321	/*
322	 * Check how many samples are available. We always have to read exactly
323	 * sample_count samples from the fifo, or a multiple of sample_count.
324	 * Otherwise we mixup samples into different touch events.
325	 */
326	regmap_read(priv->regs, MX25_ADCQ_SR, &stats);
327	samples = MX25_ADCQ_SR_FDN(stats);
328	samples -= samples % priv->sample_count;
329
330	if (!samples)
331		return IRQ_HANDLED;
332
333	for (i = 0; i != samples; ++i)
334		regmap_read(priv->regs, MX25_ADCQ_FIFO, &sample_buf[i]);
335
336	mx25_tcq_create_event_for_4wire(priv, sample_buf, samples);
337
338	return IRQ_HANDLED;
339}
340
341static irqreturn_t mx25_tcq_irq(int irq, void *dev_id)
342{
343	struct mx25_tcq_priv *priv = dev_id;
344	u32 stat;
345	int ret = IRQ_HANDLED;
346
347	regmap_read(priv->regs, MX25_ADCQ_SR, &stat);
348
349	if (stat & (MX25_ADCQ_SR_FRR | MX25_ADCQ_SR_FUR | MX25_ADCQ_SR_FOR))
350		mx25_tcq_re_enable_touch_detection(priv);
351
352	if (stat & MX25_ADCQ_SR_PD) {
353		mx25_tcq_disable_touch_irq(priv);
354		mx25_tcq_force_queue_start(priv);
355		mx25_tcq_enable_fifo_irq(priv);
356	}
357
358	if (stat & MX25_ADCQ_SR_FDRY) {
359		mx25_tcq_disable_fifo_irq(priv);
360		ret = IRQ_WAKE_THREAD;
361	}
362
363	regmap_update_bits(priv->regs, MX25_ADCQ_SR, MX25_ADCQ_SR_FRR |
364			   MX25_ADCQ_SR_FUR | MX25_ADCQ_SR_FOR |
365			   MX25_ADCQ_SR_PD,
366			   MX25_ADCQ_SR_FRR | MX25_ADCQ_SR_FUR |
367			   MX25_ADCQ_SR_FOR | MX25_ADCQ_SR_PD);
368
369	return ret;
370}
371
372/* configure the state machine for a 4-wire touchscreen */
373static int mx25_tcq_init(struct mx25_tcq_priv *priv)
374{
375	u32 tgcr;
376	unsigned int ipg_div;
377	unsigned int adc_period;
378	unsigned int debounce_cnt;
379	unsigned int settling_cnt;
380	int itemct;
381	int error;
382
383	regmap_read(priv->core_regs, MX25_TSC_TGCR, &tgcr);
384	ipg_div = max_t(unsigned int, 4, MX25_TGCR_GET_ADCCLK(tgcr));
385	adc_period = USEC_PER_SEC * ipg_div * 2 + 2;
386	adc_period /= clk_get_rate(priv->clk) / 1000 + 1;
387	debounce_cnt = DIV_ROUND_UP(priv->pen_debounce, adc_period * 8) - 1;
388	settling_cnt = DIV_ROUND_UP(priv->settling_time, adc_period * 8) - 1;
389
390	/* Reset */
391	regmap_write(priv->regs, MX25_ADCQ_CR,
392		     MX25_ADCQ_CR_QRST | MX25_ADCQ_CR_FRST);
393	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
394			   MX25_ADCQ_CR_QRST | MX25_ADCQ_CR_FRST, 0);
395
396	/* up to 128 * 8 ADC clocks are possible */
397	if (debounce_cnt > 127)
398		debounce_cnt = 127;
399
400	/* up to 255 * 8 ADC clocks are possible */
401	if (settling_cnt > 255)
402		settling_cnt = 255;
403
404	error = imx25_setup_queue_4wire(priv, settling_cnt, &itemct);
405	if (error)
406		return error;
407
408	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
409			   MX25_ADCQ_CR_LITEMID_MASK | MX25_ADCQ_CR_WMRK_MASK,
410			   MX25_ADCQ_CR_LITEMID(itemct - 1) |
411			   MX25_ADCQ_CR_WMRK(priv->expected_samples - 1));
412
413	/* setup debounce count */
414	regmap_update_bits(priv->core_regs, MX25_TSC_TGCR,
415			   MX25_TGCR_PDBTIME_MASK,
416			   MX25_TGCR_PDBTIME(debounce_cnt));
417
418	/* enable debounce */
419	regmap_update_bits(priv->core_regs, MX25_TSC_TGCR, MX25_TGCR_PDBEN,
420			   MX25_TGCR_PDBEN);
421	regmap_update_bits(priv->core_regs, MX25_TSC_TGCR, MX25_TGCR_PDEN,
422			   MX25_TGCR_PDEN);
423
424	/* enable the engine on demand */
425	regmap_update_bits(priv->regs, MX25_ADCQ_CR, MX25_ADCQ_CR_QSM_MASK,
426			   MX25_ADCQ_CR_QSM_FQS);
427
428	/* Enable repeat and repeat wait */
429	regmap_update_bits(priv->regs, MX25_ADCQ_CR,
430			   MX25_ADCQ_CR_RPT | MX25_ADCQ_CR_RWAIT_MASK,
431			   MX25_ADCQ_CR_RPT |
432			   MX25_ADCQ_CR_RWAIT(MX25_TSC_REPEAT_WAIT));
433
434	return 0;
435}
436
437static int mx25_tcq_parse_dt(struct platform_device *pdev,
438			     struct mx25_tcq_priv *priv)
439{
440	struct device_node *np = pdev->dev.of_node;
441	u32 wires;
442	int error;
443
444	/* Setup defaults */
445	priv->pen_threshold = 500;
446	priv->sample_count = 3;
447	priv->pen_debounce = 1000000;
448	priv->settling_time = 250000;
449
450	error = of_property_read_u32(np, "fsl,wires", &wires);
451	if (error) {
452		dev_err(&pdev->dev, "Failed to find fsl,wires properties\n");
453		return error;
454	}
455
456	if (wires == 4) {
457		priv->mode = MX25_TS_4WIRE;
458	} else {
459		dev_err(&pdev->dev, "%u-wire mode not supported\n", wires);
460		return -EINVAL;
461	}
462
463	/* These are optional, we don't care about the return values */
464	of_property_read_u32(np, "fsl,pen-threshold", &priv->pen_threshold);
465	of_property_read_u32(np, "fsl,settling-time-ns", &priv->settling_time);
466	of_property_read_u32(np, "fsl,pen-debounce-ns", &priv->pen_debounce);
467
468	return 0;
469}
470
471static int mx25_tcq_open(struct input_dev *idev)
472{
473	struct device *dev = &idev->dev;
474	struct mx25_tcq_priv *priv = dev_get_drvdata(dev);
475	int error;
476
477	error = clk_prepare_enable(priv->clk);
478	if (error) {
479		dev_err(dev, "Failed to enable ipg clock\n");
480		return error;
481	}
482
483	error = mx25_tcq_init(priv);
484	if (error) {
485		dev_err(dev, "Failed to init tcq\n");
486		clk_disable_unprepare(priv->clk);
487		return error;
488	}
489
490	mx25_tcq_re_enable_touch_detection(priv);
491
492	return 0;
493}
494
495static void mx25_tcq_close(struct input_dev *idev)
496{
497	struct mx25_tcq_priv *priv = input_get_drvdata(idev);
498
499	mx25_tcq_force_queue_stop(priv);
500	mx25_tcq_disable_touch_irq(priv);
501	mx25_tcq_disable_fifo_irq(priv);
502	clk_disable_unprepare(priv->clk);
503}
504
505static int mx25_tcq_probe(struct platform_device *pdev)
506{
507	struct device *dev = &pdev->dev;
508	struct input_dev *idev;
509	struct mx25_tcq_priv *priv;
510	struct mx25_tsadc *tsadc = dev_get_drvdata(dev->parent);
511	struct resource *res;
512	void __iomem *mem;
513	int error;
514
515	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
516	if (!priv)
517		return -ENOMEM;
518	priv->dev = dev;
519
520	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
521	mem = devm_ioremap_resource(dev, res);
522	if (IS_ERR(mem))
523		return PTR_ERR(mem);
524
525	error = mx25_tcq_parse_dt(pdev, priv);
526	if (error)
527		return error;
528
529	priv->regs = devm_regmap_init_mmio(dev, mem, &mx25_tcq_regconfig);
530	if (IS_ERR(priv->regs)) {
531		dev_err(dev, "Failed to initialize regmap\n");
532		return PTR_ERR(priv->regs);
533	}
534
535	priv->irq = platform_get_irq(pdev, 0);
536	if (priv->irq <= 0) {
537		dev_err(dev, "Failed to get IRQ\n");
538		return priv->irq;
539	}
540
541	idev = devm_input_allocate_device(dev);
542	if (!idev) {
543		dev_err(dev, "Failed to allocate input device\n");
544		return -ENOMEM;
545	}
546
547	idev->name = mx25_tcq_name;
548	input_set_capability(idev, EV_KEY, BTN_TOUCH);
549	input_set_abs_params(idev, ABS_X, 0, 0xfff, 0, 0);
550	input_set_abs_params(idev, ABS_Y, 0, 0xfff, 0, 0);
551
552	idev->id.bustype = BUS_HOST;
553	idev->open = mx25_tcq_open;
554	idev->close = mx25_tcq_close;
555
556	priv->idev = idev;
557	input_set_drvdata(idev, priv);
558
559	priv->core_regs = tsadc->regs;
560	if (!priv->core_regs)
561		return -EINVAL;
562
563	priv->clk = tsadc->clk;
564	if (!priv->clk)
565		return -EINVAL;
566
567	platform_set_drvdata(pdev, priv);
568
569	error = devm_request_threaded_irq(dev, priv->irq, mx25_tcq_irq,
570					  mx25_tcq_irq_thread, 0, pdev->name,
571					  priv);
572	if (error) {
573		dev_err(dev, "Failed requesting IRQ\n");
574		return error;
575	}
576
577	error = input_register_device(idev);
578	if (error) {
579		dev_err(dev, "Failed to register input device\n");
580		return error;
581	}
582
583	return 0;
584}
585
586static struct platform_driver mx25_tcq_driver = {
587	.driver		= {
588		.name	= "mx25-tcq",
589		.of_match_table = mx25_tcq_ids,
590	},
591	.probe		= mx25_tcq_probe,
592};
593module_platform_driver(mx25_tcq_driver);
594
595MODULE_DESCRIPTION("TS input driver for Freescale mx25");
596MODULE_AUTHOR("Markus Pargmann <mpa@pengutronix.de>");
597MODULE_LICENSE("GPL v2");