[linux-2.6-block.git] / drivers / input / touchscreen / ti_am335x_tsc.c

/*
 * TI Touch Screen driver
 *
 * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation version 2.
 *
 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
 * kind, whether express or implied; without even the implied warranty
 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */


#include <linux/kernel.h>
#include <linux/err.h>
#include <linux/module.h>
#include <linux/input.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/clk.h>
#include <linux/platform_device.h>
#include <linux/io.h>
#include <linux/delay.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/sort.h>
#include <linux/pm_wakeirq.h>

#include <linux/mfd/ti_am335x_tscadc.h>

#define ADCFSM_STEPID		0x10
#define SEQ_SETTLE		275
#define MAX_12BIT		((1 << 12) - 1)

#define TSC_IRQENB_MASK		(IRQENB_FIFO0THRES | IRQENB_EOS | IRQENB_HW_PEN)

static const int config_pins[] = {
	STEPCONFIG_XPP,
	STEPCONFIG_XNN,
	STEPCONFIG_YPP,
	STEPCONFIG_YNN,
};

struct titsc {
	struct input_dev	*input;
	struct ti_tscadc_dev	*mfd_tscadc;
	struct device		*dev;
	unsigned int		irq;
	unsigned int		wires;
	unsigned int		x_plate_resistance;
	bool			pen_down;
	int			coordinate_readouts;
	u32			config_inp[4];
	u32			bit_xp, bit_xn, bit_yp, bit_yn;
	u32			inp_xp, inp_xn, inp_yp, inp_yn;
	u32			step_mask;
	u32			charge_delay;
};

static unsigned int titsc_readl(struct titsc *ts, unsigned int reg)
{
	return readl(ts->mfd_tscadc->tscadc_base + reg);
}

static void titsc_writel(struct titsc *tsc, unsigned int reg,
					unsigned int val)
{
	writel(val, tsc->mfd_tscadc->tscadc_base + reg);
}

static int titsc_config_wires(struct titsc *ts_dev)
{
	u32 analog_line[4];
	u32 wire_order[4];
	int i, bit_cfg;

	for (i = 0; i < 4; i++) {
		/*
		 * Get the order in which TSC wires are attached
		 * w.r.t. each of the analog input lines on the EVM.
		 */
		analog_line[i] = (ts_dev->config_inp[i] & 0xF0) >> 4;
		wire_order[i] = ts_dev->config_inp[i] & 0x0F;
		if (WARN_ON(analog_line[i] > 7))
			return -EINVAL;
		if (WARN_ON(wire_order[i] > ARRAY_SIZE(config_pins)))
			return -EINVAL;
	}

	for (i = 0; i < 4; i++) {
		int an_line;
		int wi_order;

		an_line = analog_line[i];
		wi_order = wire_order[i];
		bit_cfg = config_pins[wi_order];
		if (bit_cfg == 0)
			return -EINVAL;
		switch (wi_order) {
		case 0:
			ts_dev->bit_xp = bit_cfg;
			ts_dev->inp_xp = an_line;
			break;

		case 1:
			ts_dev->bit_xn = bit_cfg;
			ts_dev->inp_xn = an_line;
			break;

		case 2:
			ts_dev->bit_yp = bit_cfg;
			ts_dev->inp_yp = an_line;
			break;
		case 3:
			ts_dev->bit_yn = bit_cfg;
			ts_dev->inp_yn = an_line;
			break;
		}
	}
	return 0;
}

static void titsc_step_config(struct titsc *ts_dev)
{
	unsigned int	config;
	int i;
	int end_step, first_step, tsc_steps;
	u32 stepenable;

	config = STEPCONFIG_MODE_HWSYNC |
			STEPCONFIG_AVG_16 | ts_dev->bit_xp;
	switch (ts_dev->wires) {
	case 4:
		config |= STEPCONFIG_INP(ts_dev->inp_yp) | ts_dev->bit_xn;
		break;
	case 5:
		config |= ts_dev->bit_yn |
				STEPCONFIG_INP_AN4 | ts_dev->bit_xn |
				ts_dev->bit_yp;
		break;
	case 8:
		config |= STEPCONFIG_INP(ts_dev->inp_yp) | ts_dev->bit_xn;
		break;
	}

	tsc_steps = ts_dev->coordinate_readouts * 2 + 2;
	first_step = TOTAL_STEPS - tsc_steps;
	/* Steps 16 to 16-coordinate_readouts is for X */
	end_step = first_step + tsc_steps;
	for (i = end_step - ts_dev->coordinate_readouts; i < end_step; i++) {
		titsc_writel(ts_dev, REG_STEPCONFIG(i), config);
		titsc_writel(ts_dev, REG_STEPDELAY(i), STEPCONFIG_OPENDLY);
	}

	config = 0;
	config = STEPCONFIG_MODE_HWSYNC |
			STEPCONFIG_AVG_16 | ts_dev->bit_yn |
			STEPCONFIG_INM_ADCREFM;
	switch (ts_dev->wires) {
	case 4:
		config |= ts_dev->bit_yp | STEPCONFIG_INP(ts_dev->inp_xp);
		break;
	case 5:
		config |= ts_dev->bit_xp | STEPCONFIG_INP_AN4 |
				STEPCONFIG_XNP | STEPCONFIG_YPN;
		break;
	case 8:
		config |= ts_dev->bit_yp | STEPCONFIG_INP(ts_dev->inp_xp);
		break;
	}

	/* 1 ... coordinate_readouts is for Y */
	end_step = first_step + ts_dev->coordinate_readouts;
	for (i = first_step; i < end_step; i++) {
		titsc_writel(ts_dev, REG_STEPCONFIG(i), config);
		titsc_writel(ts_dev, REG_STEPDELAY(i), STEPCONFIG_OPENDLY);
	}

	/* Make CHARGECONFIG same as IDLECONFIG */

	config = titsc_readl(ts_dev, REG_IDLECONFIG);
	titsc_writel(ts_dev, REG_CHARGECONFIG, config);
	titsc_writel(ts_dev, REG_CHARGEDELAY, ts_dev->charge_delay);

	/* coordinate_readouts + 1 ... coordinate_readouts + 2 is for Z */
	config = STEPCONFIG_MODE_HWSYNC |
			STEPCONFIG_AVG_16 | ts_dev->bit_yp |
			ts_dev->bit_xn | STEPCONFIG_INM_ADCREFM |
			STEPCONFIG_INP(ts_dev->inp_xp);
	titsc_writel(ts_dev, REG_STEPCONFIG(end_step), config);
	titsc_writel(ts_dev, REG_STEPDELAY(end_step),
			STEPCONFIG_OPENDLY);

	end_step++;
	config |= STEPCONFIG_INP(ts_dev->inp_yn);
	titsc_writel(ts_dev, REG_STEPCONFIG(end_step), config);
	titsc_writel(ts_dev, REG_STEPDELAY(end_step),
			STEPCONFIG_OPENDLY);

	/* The steps end ... end - readouts * 2 + 2 and bit 0 for TS_Charge */
	stepenable = 1;
	for (i = 0; i < tsc_steps; i++)
		stepenable |= 1 << (first_step + i + 1);

	ts_dev->step_mask = stepenable;
	am335x_tsc_se_set_cache(ts_dev->mfd_tscadc, ts_dev->step_mask);
}

static int titsc_cmp_coord(const void *a, const void *b)
{
	return *(int *)a - *(int *)b;
}

static void titsc_read_coordinates(struct titsc *ts_dev,
		u32 *x, u32 *y, u32 *z1, u32 *z2)
{
	unsigned int yvals[7], xvals[7];
	unsigned int i, xsum = 0, ysum = 0;
	unsigned int creads = ts_dev->coordinate_readouts;

	for (i = 0; i < creads; i++) {
		yvals[i] = titsc_readl(ts_dev, REG_FIFO0);
		yvals[i] &= 0xfff;
	}

	*z1 = titsc_readl(ts_dev, REG_FIFO0);
	*z1 &= 0xfff;
	*z2 = titsc_readl(ts_dev, REG_FIFO0);
	*z2 &= 0xfff;

	for (i = 0; i < creads; i++) {
		xvals[i] = titsc_readl(ts_dev, REG_FIFO0);
		xvals[i] &= 0xfff;
	}

	/*
	 * If co-ordinates readouts is less than 4 then
	 * report the average. In case of 4 or more
	 * readouts, sort the co-ordinate samples, drop
	 * min and max values and report the average of
	 * remaining values.
	 */
	if (creads <=  3) {
		for (i = 0; i < creads; i++) {
			ysum += yvals[i];
			xsum += xvals[i];
		}
		ysum /= creads;
		xsum /= creads;
	} else {
		sort(yvals, creads, sizeof(unsigned int),
		     titsc_cmp_coord, NULL);
		sort(xvals, creads, sizeof(unsigned int),
		     titsc_cmp_coord, NULL);
		for (i = 1; i < creads - 1; i++) {
			ysum += yvals[i];
			xsum += xvals[i];
		}
		ysum /= creads - 2;
		xsum /= creads - 2;
	}
	*y = ysum;
	*x = xsum;
}

static irqreturn_t titsc_irq(int irq, void *dev)
{
	struct titsc *ts_dev = dev;
	struct input_dev *input_dev = ts_dev->input;
	unsigned int fsm, status, irqclr = 0;
	unsigned int x = 0, y = 0;
	unsigned int z1, z2, z;

	status = titsc_readl(ts_dev, REG_RAWIRQSTATUS);
	if (status & IRQENB_HW_PEN) {
		ts_dev->pen_down = true;
		irqclr |= IRQENB_HW_PEN;
		pm_stay_awake(ts_dev->dev);
	}

	if (status & IRQENB_PENUP) {
		fsm = titsc_readl(ts_dev, REG_ADCFSM);
		if (fsm == ADCFSM_STEPID) {
			ts_dev->pen_down = false;
			input_report_key(input_dev, BTN_TOUCH, 0);
			input_report_abs(input_dev, ABS_PRESSURE, 0);
			input_sync(input_dev);
			pm_relax(ts_dev->dev);
		} else {
			ts_dev->pen_down = true;
		}
		irqclr |= IRQENB_PENUP;
	}

	if (status & IRQENB_EOS)
		irqclr |= IRQENB_EOS;

	/*
	 * ADC and touchscreen share the IRQ line.
	 * FIFO1 interrupts are used by ADC. Handle FIFO0 IRQs here only
	 */
	if (status & IRQENB_FIFO0THRES) {

		titsc_read_coordinates(ts_dev, &x, &y, &z1, &z2);

		if (ts_dev->pen_down && z1 != 0 && z2 != 0) {
			/*
			 * Calculate pressure using formula
			 * Resistance(touch) = x plate resistance *
			 * x postion/4096 * ((z2 / z1) - 1)
			 */
			z = z1 - z2;
			z *= x;
			z *= ts_dev->x_plate_resistance;
			z /= z2;
			z = (z + 2047) >> 12;

			if (z <= MAX_12BIT) {
				input_report_abs(input_dev, ABS_X, x);
				input_report_abs(input_dev, ABS_Y, y);
				input_report_abs(input_dev, ABS_PRESSURE, z);
				input_report_key(input_dev, BTN_TOUCH, 1);
				input_sync(input_dev);
			}
		}
		irqclr |= IRQENB_FIFO0THRES;
	}
	if (irqclr) {
		titsc_writel(ts_dev, REG_IRQSTATUS, irqclr);
		if (status & IRQENB_EOS)
			am335x_tsc_se_set_cache(ts_dev->mfd_tscadc,
						ts_dev->step_mask);
		return IRQ_HANDLED;
	}
	return IRQ_NONE;
}

static int titsc_parse_dt(struct platform_device *pdev,
					struct titsc *ts_dev)
{
	struct device_node *node = pdev->dev.of_node;
	int err;

	if (!node)
		return -EINVAL;

	err = of_property_read_u32(node, "ti,wires", &ts_dev->wires);
	if (err < 0)
		return err;
	switch (ts_dev->wires) {
	case 4:
	case 5:
	case 8:
		break;
	default:
		return -EINVAL;
	}

	err = of_property_read_u32(node, "ti,x-plate-resistance",
			&ts_dev->x_plate_resistance);
	if (err < 0)
		return err;

	/*
	 * Try with the new binding first. If it fails, try again with
	 * bogus, miss-spelled version.
	 */
	err = of_property_read_u32(node, "ti,coordinate-readouts",
			&ts_dev->coordinate_readouts);
	if (err < 0) {
		dev_warn(&pdev->dev, "please use 'ti,coordinate-readouts' instead\n");
		err = of_property_read_u32(node, "ti,coordiante-readouts",
				&ts_dev->coordinate_readouts);
	}

	if (err < 0)
		return err;

	if (ts_dev->coordinate_readouts <= 0) {
		dev_warn(&pdev->dev,
			 "invalid co-ordinate readouts, resetting it to 5\n");
		ts_dev->coordinate_readouts = 5;
	}

	err = of_property_read_u32(node, "ti,charge-delay",
				   &ts_dev->charge_delay);
	/*
	 * If ti,charge-delay value is not specified, then use
	 * CHARGEDLY_OPENDLY as the default value.
	 */
	if (err < 0) {
		ts_dev->charge_delay = CHARGEDLY_OPENDLY;
		dev_warn(&pdev->dev, "ti,charge-delay not specified\n");
	}

	return of_property_read_u32_array(node, "ti,wire-config",
			ts_dev->config_inp, ARRAY_SIZE(ts_dev->config_inp));
}

/*
 * The functions for inserting/removing driver as a module.
 */

static int titsc_probe(struct platform_device *pdev)
{
	struct titsc *ts_dev;
	struct input_dev *input_dev;
	struct ti_tscadc_dev *tscadc_dev = ti_tscadc_dev_get(pdev);
	int err;

	/* Allocate memory for device */
	ts_dev = kzalloc(sizeof(*ts_dev), GFP_KERNEL);
	input_dev = input_allocate_device();
	if (!ts_dev || !input_dev) {
		dev_err(&pdev->dev, "failed to allocate memory.\n");
		err = -ENOMEM;
		goto err_free_mem;
	}

	tscadc_dev->tsc = ts_dev;
	ts_dev->mfd_tscadc = tscadc_dev;
	ts_dev->input = input_dev;
	ts_dev->irq = tscadc_dev->irq;
	ts_dev->dev = &pdev->dev;

	err = titsc_parse_dt(pdev, ts_dev);
	if (err) {
		dev_err(&pdev->dev, "Could not find valid DT data.\n");
		goto err_free_mem;
	}

	err = request_irq(ts_dev->irq, titsc_irq,
			  IRQF_SHARED, pdev->dev.driver->name, ts_dev);
	if (err) {
		dev_err(&pdev->dev, "failed to allocate irq.\n");
		goto err_free_mem;
	}

	device_init_wakeup(&pdev->dev, true);
	err = dev_pm_set_wake_irq(&pdev->dev, ts_dev->irq);
	if (err)
		dev_err(&pdev->dev, "irq wake enable failed.\n");

	titsc_writel(ts_dev, REG_IRQSTATUS, TSC_IRQENB_MASK);
	titsc_writel(ts_dev, REG_IRQENABLE, IRQENB_FIFO0THRES);
	titsc_writel(ts_dev, REG_IRQENABLE, IRQENB_EOS);
	err = titsc_config_wires(ts_dev);
	if (err) {
		dev_err(&pdev->dev, "wrong i/p wire configuration\n");
		goto err_free_irq;
	}
	titsc_step_config(ts_dev);
	titsc_writel(ts_dev, REG_FIFO0THR,
			ts_dev->coordinate_readouts * 2 + 2 - 1);

	input_dev->name = "ti-tsc";
	input_dev->dev.parent = &pdev->dev;

	input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
	input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);

	input_set_abs_params(input_dev, ABS_X, 0, MAX_12BIT, 0, 0);
	input_set_abs_params(input_dev, ABS_Y, 0, MAX_12BIT, 0, 0);
	input_set_abs_params(input_dev, ABS_PRESSURE, 0, MAX_12BIT, 0, 0);

	/* register to the input system */
	err = input_register_device(input_dev);
	if (err)
		goto err_free_irq;

	platform_set_drvdata(pdev, ts_dev);
	return 0;

err_free_irq:
	dev_pm_clear_wake_irq(&pdev->dev);
	device_init_wakeup(&pdev->dev, false);
	free_irq(ts_dev->irq, ts_dev);
err_free_mem:
	input_free_device(input_dev);
	kfree(ts_dev);
	return err;
}

static int titsc_remove(struct platform_device *pdev)
{
	struct titsc *ts_dev = platform_get_drvdata(pdev);
	u32 steps;

	dev_pm_clear_wake_irq(&pdev->dev);
	device_init_wakeup(&pdev->dev, false);
	free_irq(ts_dev->irq, ts_dev);

	/* total steps followed by the enable mask */
	steps = 2 * ts_dev->coordinate_readouts + 2;
	steps = (1 << steps) - 1;
	am335x_tsc_se_clr(ts_dev->mfd_tscadc, steps);

	input_unregister_device(ts_dev->input);

	kfree(ts_dev);
	return 0;
}

static int __maybe_unused titsc_suspend(struct device *dev)
{
	struct titsc *ts_dev = dev_get_drvdata(dev);
	struct ti_tscadc_dev *tscadc_dev;
	unsigned int idle;

	tscadc_dev = ti_tscadc_dev_get(to_platform_device(dev));
	if (device_may_wakeup(dev)) {
		titsc_writel(ts_dev, REG_IRQSTATUS, TSC_IRQENB_MASK);
		idle = titsc_readl(ts_dev, REG_IRQENABLE);
		titsc_writel(ts_dev, REG_IRQENABLE,
				(idle | IRQENB_HW_PEN));
		titsc_writel(ts_dev, REG_IRQWAKEUP, IRQWKUP_ENB);
	}
	return 0;
}

static int __maybe_unused titsc_resume(struct device *dev)
{
	struct titsc *ts_dev = dev_get_drvdata(dev);
	struct ti_tscadc_dev *tscadc_dev;

	tscadc_dev = ti_tscadc_dev_get(to_platform_device(dev));
	if (device_may_wakeup(dev)) {
		titsc_writel(ts_dev, REG_IRQWAKEUP,
				0x00);
		titsc_writel(ts_dev, REG_IRQCLR, IRQENB_HW_PEN);
		pm_relax(dev);
	}
	titsc_step_config(ts_dev);
	titsc_writel(ts_dev, REG_FIFO0THR,
			ts_dev->coordinate_readouts * 2 + 2 - 1);
	return 0;
}

static SIMPLE_DEV_PM_OPS(titsc_pm_ops, titsc_suspend, titsc_resume);

static const struct of_device_id ti_tsc_dt_ids[] = {
	{ .compatible = "ti,am3359-tsc", },
	{ }
};
MODULE_DEVICE_TABLE(of, ti_tsc_dt_ids);

static struct platform_driver ti_tsc_driver = {
	.probe	= titsc_probe,
	.remove	= titsc_remove,
	.driver	= {
		.name   = "TI-am335x-tsc",
		.pm	= &titsc_pm_ops,
		.of_match_table = ti_tsc_dt_ids,
	},
};
module_platform_driver(ti_tsc_driver);

MODULE_DESCRIPTION("TI touchscreen controller driver");
MODULE_AUTHOR("Rachna Patil <rachna@ti.com>");
MODULE_LICENSE("GPL");
Commit	Line	Data
1b8be32e RP	1	/*
	2	* TI Touch Screen driver
	3	*
	4	* Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/
	5	*
	6	* This program is free software; you can redistribute it and/or
	7	* modify it under the terms of the GNU General Public License as
	8	* published by the Free Software Foundation version 2.
	9	*
	10	* This program is distributed "as is" WITHOUT ANY WARRANTY of any
	11	* kind, whether express or implied; without even the implied warranty
	12	* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	13	* GNU General Public License for more details.
	14	*/
	15
	16
1b8be32e RP	17	#include <linux/kernel.h>
	18	#include <linux/err.h>
	19	#include <linux/module.h>
	20	#include <linux/input.h>
	21	#include <linux/slab.h>
	22	#include <linux/interrupt.h>
	23	#include <linux/clk.h>
	24	#include <linux/platform_device.h>
	25	#include <linux/io.h>
1b8be32e	26	#include <linux/delay.h>
0396310b PR	27	#include <linux/of.h>
0396310b PR	28	#include <linux/of_device.h>
83edfdf3	29	#include <linux/sort.h>
7a39915b	30	#include <linux/pm_wakeirq.h>
1b8be32e	31
2b99bafa	32	#include <linux/mfd/ti_am335x_tscadc.h>
33f5cc60 PR	33
33f5cc60 PR	34	#define ADCFSM_STEPID 0x10
1b8be32e	35	#define SEQ_SETTLE 275
1b8be32e	36	#define MAX_12BIT ((1 << 12) - 1)
1b8be32e	37
46850420 GS	38	#define TSC_IRQENB_MASK (IRQENB_FIFO0THRES \| IRQENB_EOS \| IRQENB_HW_PEN)
46850420 GS	39
bb76dc09 PR	40	static const int config_pins[] = {
	41	STEPCONFIG_XPP,
	42	STEPCONFIG_XNN,
	43	STEPCONFIG_YPP,
	44	STEPCONFIG_YNN,
	45	};
	46
55c04de5	47	struct titsc {
1b8be32e	48	struct input_dev *input;
2b99bafa	49	struct ti_tscadc_dev *mfd_tscadc;
333e07ec	50	struct device *dev;
1b8be32e RP	51	unsigned int irq;
	52	unsigned int wires;
	53	unsigned int x_plate_resistance;
	54	bool pen_down;
0396310b	55	int coordinate_readouts;
bb76dc09 PR	56	u32 config_inp[4];
	57	u32 bit_xp, bit_xn, bit_yp, bit_yn;
	58	u32 inp_xp, inp_xn, inp_yp, inp_yn;
baee5399	59	u32 step_mask;
bf223612	60	u32 charge_delay;
1b8be32e RP	61	};
1b8be32e RP	62
55c04de5	63	static unsigned int titsc_readl(struct titsc *ts, unsigned int reg)
1b8be32e	64	{
2b99bafa	65	return readl(ts->mfd_tscadc->tscadc_base + reg);
1b8be32e RP	66	}
1b8be32e RP	67
55c04de5	68	static void titsc_writel(struct titsc *tsc, unsigned int reg,
1b8be32e RP	69	unsigned int val)
1b8be32e RP	70	{
2b99bafa	71	writel(val, tsc->mfd_tscadc->tscadc_base + reg);
1b8be32e RP	72	}
1b8be32e RP	73
bb76dc09 PR	74	static int titsc_config_wires(struct titsc *ts_dev)
	75	{
	76	u32 analog_line[4];
	77	u32 wire_order[4];
	78	int i, bit_cfg;
	79
	80	for (i = 0; i < 4; i++) {
	81	/*
	82	* Get the order in which TSC wires are attached
	83	* w.r.t. each of the analog input lines on the EVM.
	84	*/
	85	analog_line[i] = (ts_dev->config_inp[i] & 0xF0) >> 4;
	86	wire_order[i] = ts_dev->config_inp[i] & 0x0F;
	87	if (WARN_ON(analog_line[i] > 7))
	88	return -EINVAL;
	89	if (WARN_ON(wire_order[i] > ARRAY_SIZE(config_pins)))
	90	return -EINVAL;
	91	}
	92
	93	for (i = 0; i < 4; i++) {
	94	int an_line;
	95	int wi_order;
	96
	97	an_line = analog_line[i];
	98	wi_order = wire_order[i];
	99	bit_cfg = config_pins[wi_order];
	100	if (bit_cfg == 0)
	101	return -EINVAL;
	102	switch (wi_order) {
	103	case 0:
	104	ts_dev->bit_xp = bit_cfg;
	105	ts_dev->inp_xp = an_line;
	106	break;
	107
	108	case 1:
	109	ts_dev->bit_xn = bit_cfg;
	110	ts_dev->inp_xn = an_line;
	111	break;
	112
	113	case 2:
	114	ts_dev->bit_yp = bit_cfg;
	115	ts_dev->inp_yp = an_line;
	116	break;
	117	case 3:
	118	ts_dev->bit_yn = bit_cfg;
	119	ts_dev->inp_yn = an_line;
	120	break;
	121	}
	122	}
	123	return 0;
	124	}
	125
55c04de5	126	static void titsc_step_config(struct titsc *ts_dev)
1b8be32e RP	127	{
1b8be32e RP	128	unsigned int config;
8c896308	129	int i;
3a59684c	130	int end_step, first_step, tsc_steps;
8c896308	131	u32 stepenable;
1b8be32e RP	132
1b8be32e RP	133	config = STEPCONFIG_MODE_HWSYNC \|
bb76dc09	134	STEPCONFIG_AVG_16 \| ts_dev->bit_xp;
1b8be32e RP	135	switch (ts_dev->wires) {
1b8be32e RP	136	case 4:
bb76dc09	137	config \|= STEPCONFIG_INP(ts_dev->inp_yp) \| ts_dev->bit_xn;
1b8be32e RP	138	break;
1b8be32e RP	139	case 5:
bb76dc09 PR	140	config \|= ts_dev->bit_yn \|
	141	STEPCONFIG_INP_AN4 \| ts_dev->bit_xn \|
	142	ts_dev->bit_yp;
1b8be32e RP	143	break;
1b8be32e RP	144	case 8:
bb76dc09	145	config \|= STEPCONFIG_INP(ts_dev->inp_yp) \| ts_dev->bit_xn;
1b8be32e RP	146	break;
	147	}
	148
3a59684c BG	149	tsc_steps = ts_dev->coordinate_readouts * 2 + 2;
	150	first_step = TOTAL_STEPS - tsc_steps;
	151	/* Steps 16 to 16-coordinate_readouts is for X */
	152	end_step = first_step + tsc_steps;
	153	for (i = end_step - ts_dev->coordinate_readouts; i < end_step; i++) {
55c04de5 PR	154	titsc_writel(ts_dev, REG_STEPCONFIG(i), config);
55c04de5 PR	155	titsc_writel(ts_dev, REG_STEPDELAY(i), STEPCONFIG_OPENDLY);
1b8be32e RP	156	}
	157
	158	config = 0;
	159	config = STEPCONFIG_MODE_HWSYNC \|
bb76dc09	160	STEPCONFIG_AVG_16 \| ts_dev->bit_yn \|
8c896308	161	STEPCONFIG_INM_ADCREFM;
1b8be32e RP	162	switch (ts_dev->wires) {
1b8be32e RP	163	case 4:
bb76dc09	164	config \|= ts_dev->bit_yp \| STEPCONFIG_INP(ts_dev->inp_xp);
1b8be32e RP	165	break;
1b8be32e RP	166	case 5:
bb76dc09	167	config \|= ts_dev->bit_xp \| STEPCONFIG_INP_AN4 \|
cf5dd489	168	STEPCONFIG_XNP \| STEPCONFIG_YPN;
1b8be32e RP	169	break;
1b8be32e RP	170	case 8:
bb76dc09	171	config \|= ts_dev->bit_yp \| STEPCONFIG_INP(ts_dev->inp_xp);
1b8be32e RP	172	break;
	173	}
	174
3a59684c BG	175	/* 1 ... coordinate_readouts is for Y */
	176	end_step = first_step + ts_dev->coordinate_readouts;
	177	for (i = first_step; i < end_step; i++) {
55c04de5 PR	178	titsc_writel(ts_dev, REG_STEPCONFIG(i), config);
55c04de5 PR	179	titsc_writel(ts_dev, REG_STEPDELAY(i), STEPCONFIG_OPENDLY);
1b8be32e RP	180	}
1b8be32e RP	181
344d635b	182	/* Make CHARGECONFIG same as IDLECONFIG */
1b8be32e	183
344d635b	184	config = titsc_readl(ts_dev, REG_IDLECONFIG);
55c04de5	185	titsc_writel(ts_dev, REG_CHARGECONFIG, config);
bf223612	186	titsc_writel(ts_dev, REG_CHARGEDELAY, ts_dev->charge_delay);
1b8be32e	187
3a59684c	188	/* coordinate_readouts + 1 ... coordinate_readouts + 2 is for Z */
1b8be32e	189	config = STEPCONFIG_MODE_HWSYNC \|
bb76dc09 PR	190	STEPCONFIG_AVG_16 \| ts_dev->bit_yp \|
	191	ts_dev->bit_xn \| STEPCONFIG_INM_ADCREFM \|
	192	STEPCONFIG_INP(ts_dev->inp_xp);
8c896308 SAS	193	titsc_writel(ts_dev, REG_STEPCONFIG(end_step), config);
8c896308 SAS	194	titsc_writel(ts_dev, REG_STEPDELAY(end_step),
d1fb5743	195	STEPCONFIG_OPENDLY);
1b8be32e	196
8c896308 SAS	197	end_step++;
	198	config \|= STEPCONFIG_INP(ts_dev->inp_yn);
	199	titsc_writel(ts_dev, REG_STEPCONFIG(end_step), config);
	200	titsc_writel(ts_dev, REG_STEPDELAY(end_step),
d1fb5743	201	STEPCONFIG_OPENDLY);
1b8be32e	202
3a59684c BG	203	/* The steps end ... end - readouts * 2 + 2 and bit 0 for TS_Charge */
	204	stepenable = 1;
	205	for (i = 0; i < tsc_steps; i++)
	206	stepenable \|= 1 << (first_step + i + 1);
	207
baee5399	208	ts_dev->step_mask = stepenable;
7e170c6e	209	am335x_tsc_se_set_cache(ts_dev->mfd_tscadc, ts_dev->step_mask);
1b8be32e RP	210	}
1b8be32e RP	211
83edfdf3 V	212	static int titsc_cmp_coord(const void a, const void b)
	213	{
	214	return (int )a - (int )b;
	215	}
	216
55c04de5	217	static void titsc_read_coordinates(struct titsc *ts_dev,
8c896308	218	u32 x, u32 y, u32 z1, u32 z2)
1b8be32e	219	{
83edfdf3 V	220	unsigned int yvals[7], xvals[7];
83edfdf3 V	221	unsigned int i, xsum = 0, ysum = 0;
8c896308	222	unsigned int creads = ts_dev->coordinate_readouts;
1b8be32e	223
83edfdf3 V	224	for (i = 0; i < creads; i++) {
	225	yvals[i] = titsc_readl(ts_dev, REG_FIFO0);
	226	yvals[i] &= 0xfff;
	227	}
1b8be32e	228
83edfdf3 V	229	*z1 = titsc_readl(ts_dev, REG_FIFO0);
	230	*z1 &= 0xfff;
	231	*z2 = titsc_readl(ts_dev, REG_FIFO0);
	232	*z2 &= 0xfff;
3a59684c	233
83edfdf3 V	234	for (i = 0; i < creads; i++) {
	235	xvals[i] = titsc_readl(ts_dev, REG_FIFO0);
	236	xvals[i] &= 0xfff;
	237	}
3a59684c	238
83edfdf3 V	239	/*
	240	* If co-ordinates readouts is less than 4 then
	241	* report the average. In case of 4 or more
	242	* readouts, sort the co-ordinate samples, drop
	243	* min and max values and report the average of
	244	* remaining values.
	245	*/
	246	if (creads <= 3) {
	247	for (i = 0; i < creads; i++) {
	248	ysum += yvals[i];
	249	xsum += xvals[i];
1b8be32e	250	}
83edfdf3 V	251	ysum /= creads;
	252	xsum /= creads;
	253	} else {
	254	sort(yvals, creads, sizeof(unsigned int),
	255	titsc_cmp_coord, NULL);
	256	sort(xvals, creads, sizeof(unsigned int),
	257	titsc_cmp_coord, NULL);
	258	for (i = 1; i < creads - 1; i++) {
	259	ysum += yvals[i];
	260	xsum += xvals[i];
	261	}
	262	ysum /= creads - 2;
	263	xsum /= creads - 2;
1b8be32e	264	}
83edfdf3 V	265	*y = ysum;
83edfdf3 V	266	*x = xsum;
1b8be32e RP	267	}
1b8be32e RP	268
55c04de5	269	static irqreturn_t titsc_irq(int irq, void *dev)
1b8be32e	270	{
55c04de5	271	struct titsc *ts_dev = dev;
1b8be32e	272	struct input_dev *input_dev = ts_dev->input;
344d635b	273	unsigned int fsm, status, irqclr = 0;
1b8be32e RP	274	unsigned int x = 0, y = 0;
1b8be32e RP	275	unsigned int z1, z2, z;
1b8be32e	276
344d635b BG	277	status = titsc_readl(ts_dev, REG_RAWIRQSTATUS);
	278	if (status & IRQENB_HW_PEN) {
	279	ts_dev->pen_down = true;
344d635b	280	irqclr \|= IRQENB_HW_PEN;
333e07ec	281	pm_stay_awake(ts_dev->dev);
344d635b BG	282	}
	283
	284	if (status & IRQENB_PENUP) {
	285	fsm = titsc_readl(ts_dev, REG_ADCFSM);
	286	if (fsm == ADCFSM_STEPID) {
	287	ts_dev->pen_down = false;
	288	input_report_key(input_dev, BTN_TOUCH, 0);
	289	input_report_abs(input_dev, ABS_PRESSURE, 0);
	290	input_sync(input_dev);
333e07ec	291	pm_relax(ts_dev->dev);
344d635b BG	292	} else {
	293	ts_dev->pen_down = true;
	294	}
	295	irqclr \|= IRQENB_PENUP;
	296	}
	297
	298	if (status & IRQENB_EOS)
	299	irqclr \|= IRQENB_EOS;
	300
baee5399 ZL	301	/*
	302	* ADC and touchscreen share the IRQ line.
	303	* FIFO1 interrupts are used by ADC. Handle FIFO0 IRQs here only
	304	*/
30af55f9	305	if (status & IRQENB_FIFO0THRES) {
1b8be32e	306
8c896308	307	titsc_read_coordinates(ts_dev, &x, &y, &z1, &z2);
2b99bafa	308
1b8be32e RP	309	if (ts_dev->pen_down && z1 != 0 && z2 != 0) {
	310	/*
	311	* Calculate pressure using formula
	312	* Resistance(touch) = x plate resistance *
	313	* x postion/4096 * ((z2 / z1) - 1)
	314	*/
8c896308	315	z = z1 - z2;
1b8be32e RP	316	z *= x;
1b8be32e RP	317	z *= ts_dev->x_plate_resistance;
8c896308	318	z /= z2;
1b8be32e RP	319	z = (z + 2047) >> 12;
	320
	321	if (z <= MAX_12BIT) {
	322	input_report_abs(input_dev, ABS_X, x);
	323	input_report_abs(input_dev, ABS_Y, y);
	324	input_report_abs(input_dev, ABS_PRESSURE, z);
	325	input_report_key(input_dev, BTN_TOUCH, 1);
	326	input_sync(input_dev);
	327	}
	328	}
30af55f9	329	irqclr \|= IRQENB_FIFO0THRES;
1b8be32e	330	}
9a28b883 SAS	331	if (irqclr) {
9a28b883 SAS	332	titsc_writel(ts_dev, REG_IRQSTATUS, irqclr);
344d635b BG	333	if (status & IRQENB_EOS)
	334	am335x_tsc_se_set_cache(ts_dev->mfd_tscadc,
	335	ts_dev->step_mask);
9a28b883 SAS	336	return IRQ_HANDLED;
	337	}
	338	return IRQ_NONE;
1b8be32e RP	339	}
1b8be32e RP	340
0396310b PR	341	static int titsc_parse_dt(struct platform_device *pdev,
	342	struct titsc *ts_dev)
	343	{
	344	struct device_node *node = pdev->dev.of_node;
	345	int err;
	346
	347	if (!node)
	348	return -EINVAL;
	349
	350	err = of_property_read_u32(node, "ti,wires", &ts_dev->wires);
	351	if (err < 0)
	352	return err;
	353	switch (ts_dev->wires) {
	354	case 4:
	355	case 5:
	356	case 8:
	357	break;
	358	default:
	359	return -EINVAL;
	360	}
	361
	362	err = of_property_read_u32(node, "ti,x-plate-resistance",
	363	&ts_dev->x_plate_resistance);
	364	if (err < 0)
	365	return err;
	366
c9aeb249 FB	367	/*
	368	* Try with the new binding first. If it fails, try again with
	369	* bogus, miss-spelled version.
	370	*/
	371	err = of_property_read_u32(node, "ti,coordinate-readouts",
0396310b	372	&ts_dev->coordinate_readouts);
31972f6e FB	373	if (err < 0) {
31972f6e FB	374	dev_warn(&pdev->dev, "please use 'ti,coordinate-readouts' instead\n");
c9aeb249 FB	375	err = of_property_read_u32(node, "ti,coordiante-readouts",
c9aeb249 FB	376	&ts_dev->coordinate_readouts);
31972f6e FB	377	}
31972f6e FB	378
0396310b PR	379	if (err < 0)
	380	return err;
	381
83edfdf3 V	382	if (ts_dev->coordinate_readouts <= 0) {
	383	dev_warn(&pdev->dev,
	384	"invalid co-ordinate readouts, resetting it to 5\n");
	385	ts_dev->coordinate_readouts = 5;
	386	}
	387
bf223612 V	388	err = of_property_read_u32(node, "ti,charge-delay",
	389	&ts_dev->charge_delay);
	390	/*
	391	* If ti,charge-delay value is not specified, then use
	392	* CHARGEDLY_OPENDLY as the default value.
	393	*/
	394	if (err < 0) {
	395	ts_dev->charge_delay = CHARGEDLY_OPENDLY;
	396	dev_warn(&pdev->dev, "ti,charge-delay not specified\n");
	397	}
	398
0396310b PR	399	return of_property_read_u32_array(node, "ti,wire-config",
0396310b PR	400	ts_dev->config_inp, ARRAY_SIZE(ts_dev->config_inp));
1b8be32e RP	401	}
	402
	403	/*
	404	* The functions for inserting/removing driver as a module.
	405	*/
	406
31564cbd	407	static int titsc_probe(struct platform_device *pdev)
1b8be32e	408	{
55c04de5	409	struct titsc *ts_dev;
1b8be32e	410	struct input_dev *input_dev;
a9bce1b0	411	struct ti_tscadc_dev *tscadc_dev = ti_tscadc_dev_get(pdev);
1b8be32e	412	int err;
1b8be32e	413
1b8be32e	414	/* Allocate memory for device */
520d8267	415	ts_dev = kzalloc(sizeof(*ts_dev), GFP_KERNEL);
1b8be32e RP	416	input_dev = input_allocate_device();
	417	if (!ts_dev \|\| !input_dev) {
	418	dev_err(&pdev->dev, "failed to allocate memory.\n");
	419	err = -ENOMEM;
	420	goto err_free_mem;
	421	}
	422
2b99bafa PR	423	tscadc_dev->tsc = ts_dev;
2b99bafa PR	424	ts_dev->mfd_tscadc = tscadc_dev;
1b8be32e	425	ts_dev->input = input_dev;
2b99bafa	426	ts_dev->irq = tscadc_dev->irq;
333e07ec	427	ts_dev->dev = &pdev->dev;
0396310b	428
b9194fdf	429	err = titsc_parse_dt(pdev, ts_dev);
0396310b PR	430	if (err) {
	431	dev_err(&pdev->dev, "Could not find valid DT data.\n");
	432	goto err_free_mem;
	433	}
1b8be32e	434
55c04de5	435	err = request_irq(ts_dev->irq, titsc_irq,
baee5399	436	IRQF_SHARED, pdev->dev.driver->name, ts_dev);
1b8be32e RP	437	if (err) {
1b8be32e RP	438	dev_err(&pdev->dev, "failed to allocate irq.\n");
2b99bafa	439	goto err_free_mem;
1b8be32e	440	}
1b8be32e	441
333e07ec	442	device_init_wakeup(&pdev->dev, true);
7a39915b V	443	err = dev_pm_set_wake_irq(&pdev->dev, ts_dev->irq);
	444	if (err)
	445	dev_err(&pdev->dev, "irq wake enable failed.\n");
333e07ec	446
46850420	447	titsc_writel(ts_dev, REG_IRQSTATUS, TSC_IRQENB_MASK);
55c04de5	448	titsc_writel(ts_dev, REG_IRQENABLE, IRQENB_FIFO0THRES);
344d635b	449	titsc_writel(ts_dev, REG_IRQENABLE, IRQENB_EOS);
bb76dc09 PR	450	err = titsc_config_wires(ts_dev);
	451	if (err) {
	452	dev_err(&pdev->dev, "wrong i/p wire configuration\n");
	453	goto err_free_irq;
	454	}
55c04de5	455	titsc_step_config(ts_dev);
8c896308 SAS	456	titsc_writel(ts_dev, REG_FIFO0THR,
8c896308 SAS	457	ts_dev->coordinate_readouts * 2 + 2 - 1);
1b8be32e	458
2b99bafa	459	input_dev->name = "ti-tsc";
1b8be32e RP	460	input_dev->dev.parent = &pdev->dev;
	461
	462	input_dev->evbit[0] = BIT_MASK(EV_KEY) \| BIT_MASK(EV_ABS);
	463	input_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
	464
	465	input_set_abs_params(input_dev, ABS_X, 0, MAX_12BIT, 0, 0);
	466	input_set_abs_params(input_dev, ABS_Y, 0, MAX_12BIT, 0, 0);
	467	input_set_abs_params(input_dev, ABS_PRESSURE, 0, MAX_12BIT, 0, 0);
	468
	469	/* register to the input system */
	470	err = input_register_device(input_dev);
	471	if (err)
2b99bafa	472	goto err_free_irq;
1b8be32e RP	473
	474	platform_set_drvdata(pdev, ts_dev);
	475	return 0;
	476
1b8be32e	477	err_free_irq:
7a39915b	478	dev_pm_clear_wake_irq(&pdev->dev);
333e07ec	479	device_init_wakeup(&pdev->dev, false);
1b8be32e	480	free_irq(ts_dev->irq, ts_dev);
1b8be32e RP	481	err_free_mem:
	482	input_free_device(input_dev);
	483	kfree(ts_dev);
	484	return err;
	485	}
	486
31564cbd	487	static int titsc_remove(struct platform_device *pdev)
1b8be32e	488	{
a9bce1b0 SAS	489	struct titsc *ts_dev = platform_get_drvdata(pdev);
a9bce1b0 SAS	490	u32 steps;
1b8be32e	491
7a39915b	492	dev_pm_clear_wake_irq(&pdev->dev);
333e07ec	493	device_init_wakeup(&pdev->dev, false);
1b8be32e RP	494	free_irq(ts_dev->irq, ts_dev);
1b8be32e RP	495
abeccee4	496	/* total steps followed by the enable mask */
0396310b	497	steps = 2 * ts_dev->coordinate_readouts + 2;
abeccee4 PR	498	steps = (1 << steps) - 1;
	499	am335x_tsc_se_clr(ts_dev->mfd_tscadc, steps);
	500
1b8be32e RP	501	input_unregister_device(ts_dev->input);
1b8be32e RP	502
2b99bafa PR	503	kfree(ts_dev);
	504	return 0;
	505	}
1b8be32e	506
20aa787e	507	static int __maybe_unused titsc_suspend(struct device *dev)
2b99bafa	508	{
a9bce1b0 SAS	509	struct titsc *ts_dev = dev_get_drvdata(dev);
a9bce1b0 SAS	510	struct ti_tscadc_dev *tscadc_dev;
2b99bafa PR	511	unsigned int idle;
2b99bafa PR	512
a9bce1b0	513	tscadc_dev = ti_tscadc_dev_get(to_platform_device(dev));
333e07ec	514	if (device_may_wakeup(dev)) {
46850420	515	titsc_writel(ts_dev, REG_IRQSTATUS, TSC_IRQENB_MASK);
2b99bafa PR	516	idle = titsc_readl(ts_dev, REG_IRQENABLE);
	517	titsc_writel(ts_dev, REG_IRQENABLE,
	518	(idle \| IRQENB_HW_PEN));
	519	titsc_writel(ts_dev, REG_IRQWAKEUP, IRQWKUP_ENB);
	520	}
	521	return 0;
	522	}
1b8be32e	523
20aa787e	524	static int __maybe_unused titsc_resume(struct device *dev)
2b99bafa	525	{
a9bce1b0 SAS	526	struct titsc *ts_dev = dev_get_drvdata(dev);
a9bce1b0 SAS	527	struct ti_tscadc_dev *tscadc_dev;
1b8be32e	528
a9bce1b0	529	tscadc_dev = ti_tscadc_dev_get(to_platform_device(dev));
333e07ec	530	if (device_may_wakeup(dev)) {
2b99bafa PR	531	titsc_writel(ts_dev, REG_IRQWAKEUP,
	532	0x00);
	533	titsc_writel(ts_dev, REG_IRQCLR, IRQENB_HW_PEN);
333e07ec	534	pm_relax(dev);
2b99bafa PR	535	}
	536	titsc_step_config(ts_dev);
	537	titsc_writel(ts_dev, REG_FIFO0THR,
8c896308	538	ts_dev->coordinate_readouts * 2 + 2 - 1);
1b8be32e RP	539	return 0;
	540	}
	541
20aa787e	542	static SIMPLE_DEV_PM_OPS(titsc_pm_ops, titsc_suspend, titsc_resume);
2b99bafa	543
0396310b PR	544	static const struct of_device_id ti_tsc_dt_ids[] = {
	545	{ .compatible = "ti,am3359-tsc", },
	546	{ }
	547	};
	548	MODULE_DEVICE_TABLE(of, ti_tsc_dt_ids);
	549
1b8be32e	550	static struct platform_driver ti_tsc_driver = {
55c04de5	551	.probe = titsc_probe,
31564cbd	552	.remove = titsc_remove,
1b8be32e	553	.driver = {
5f184e63	554	.name = "TI-am335x-tsc",
20aa787e	555	.pm = &titsc_pm_ops,
8e6146bf	556	.of_match_table = ti_tsc_dt_ids,
1b8be32e RP	557	},
	558	};
	559	module_platform_driver(ti_tsc_driver);
	560
	561	MODULE_DESCRIPTION("TI touchscreen controller driver");
	562	MODULE_AUTHOR("Rachna Patil <rachna@ti.com>");
	563	MODULE_LICENSE("GPL");