From 5e8c7c54a9b297dae0081dd19a7bb94e23040a3d Mon Sep 17 00:00:00 2001 From: Joshua Lock Date: Tue, 18 May 2010 14:51:13 +0100 Subject: linux-moblin: add 2.6.33.2 kernel from MeeGo 1.0 Signed-off-by: Joshua Lock --- ...inux-2.6.34-moorestown-touchscreen-driver.patch | 996 +++++++++++++++++++++ 1 file changed, 996 insertions(+) create mode 100644 meta-moblin/packages/linux/linux-moblin-2.6.33.2/linux-2.6.34-moorestown-touchscreen-driver.patch (limited to 'meta-moblin/packages/linux/linux-moblin-2.6.33.2/linux-2.6.34-moorestown-touchscreen-driver.patch') diff --git a/meta-moblin/packages/linux/linux-moblin-2.6.33.2/linux-2.6.34-moorestown-touchscreen-driver.patch b/meta-moblin/packages/linux/linux-moblin-2.6.33.2/linux-2.6.34-moorestown-touchscreen-driver.patch new file mode 100644 index 000000000..1b11cd352 --- /dev/null +++ b/meta-moblin/packages/linux/linux-moblin-2.6.33.2/linux-2.6.34-moorestown-touchscreen-driver.patch @@ -0,0 +1,996 @@ +From f7ba5de3af0c7d3abd7624676e07752e5d8b7ebd Mon Sep 17 00:00:00 2001 +From: Jacob Pan +Date: Fri, 4 Dec 2009 10:57:07 -0800 +Subject: [PATCH 040/104] MRST: touch screen driver + +--- + drivers/input/touchscreen/Kconfig | 9 + + drivers/input/touchscreen/Makefile | 2 + + drivers/input/touchscreen/mrstouch.c | 947 ++++++++++++++++++++++++++++++++++ + 3 files changed, 958 insertions(+), 0 deletions(-) + create mode 100644 drivers/input/touchscreen/mrstouch.c + +diff --git a/drivers/input/touchscreen/Kconfig b/drivers/input/touchscreen/Kconfig +index dfafc76..6dd2674 100644 +--- a/drivers/input/touchscreen/Kconfig ++++ b/drivers/input/touchscreen/Kconfig +@@ -577,4 +577,13 @@ config TOUCHSCREEN_PCAP + + To compile this driver as a module, choose M here: the + module will be called pcap_ts. ++ ++config TOUCHSCREEN_MRSTOUCH ++ tristate "Intel Moorstown Resistive touchscreen" ++ depends on LNW_IPC ++ default y ++ help ++ Say Y here if you have a Intel Moorstown based Touchscreen ++ If unsure, say N. ++ + endif +diff --git a/drivers/input/touchscreen/Makefile b/drivers/input/touchscreen/Makefile +index d61a3b4..15ad257 100644 +--- a/drivers/input/touchscreen/Makefile ++++ b/drivers/input/touchscreen/Makefile +@@ -45,3 +45,5 @@ obj-$(CONFIG_TOUCHSCREEN_WM97XX_ATMEL) += atmel-wm97xx.o + obj-$(CONFIG_TOUCHSCREEN_WM97XX_MAINSTONE) += mainstone-wm97xx.o + obj-$(CONFIG_TOUCHSCREEN_WM97XX_ZYLONITE) += zylonite-wm97xx.o + obj-$(CONFIG_TOUCHSCREEN_W90X900) += w90p910_ts.o ++obj-$(CONFIG_TOUCHSCREEN_MRSTOUCH) += mrstouch.o ++ +diff --git a/drivers/input/touchscreen/mrstouch.c b/drivers/input/touchscreen/mrstouch.c +new file mode 100644 +index 0000000..f6aba7d +--- /dev/null ++++ b/drivers/input/touchscreen/mrstouch.c +@@ -0,0 +1,947 @@ ++/* ++ * mrstouch.c - Intel Moorestown Resistive Touch Screen Driver ++ * ++ * Copyright (C) 2008 Intel Corp ++ * ++ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ ++ * ++ * 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 of the License. ++ * ++ * This program is distributed in the hope that it will be useful, but ++ * WITHOUT ANY WARRANTY; without even the implied warranty of ++ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU ++ * General Public License for more details. ++ * ++ * You should have received a copy of the GNU General Public License along ++ * with this program; ifnot, write to the Free Software Foundation, Inc., ++ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. ++ * ++ * Questions/Comments/Bug fixes to Sreedhara (sreedhara.ds@intel.com) ++ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ ++ */ ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++#include ++ ++MODULE_AUTHOR("Sreedhara Murthy. D.S, sreedhara.ds@intel.com"); ++MODULE_DESCRIPTION("Intel Moorestown Resistive Touch Screen Driver"); ++MODULE_LICENSE("GPL"); ++ ++#if defined(MRSTOUCH_DEBUG) ++#define mrstouch_debug(fmt, args...)\ ++ do { \ ++ printk(KERN_DEBUG "\n[MRSTOUCH(%d)] - ", __LINE__); \ ++ printk(KERN_DEBUG fmt, ##args); \ ++ } while (0); ++#else ++#define mrstouch_debug(fmt, args...) ++#endif ++ ++#define mrstouch_error(fmt, args...)\ ++ do { \ ++ printk(KERN_ERR "\n[MRSTOUCH(%d)] - ", __LINE__); \ ++ printk(KERN_ERR fmt, ##args); \ ++ } while (0); ++ ++/* PMIC Interrupt registers */ ++#define PMIC_REG_ID1 0x00 /*PMIC ID1 register */ ++ ++/* PMIC Interrupt registers */ ++#define PMIC_REG_INT 0x04 /*PMIC interrupt register */ ++#define PMIC_REG_MINT 0x05 /*PMIC interrupt mask register */ ++ ++/* ADC Interrupt registers */ ++#define PMIC_REG_ADCINT 0x5F /*ADC interrupt register */ ++#define PMIC_REG_MADCINT 0x60 /*ADC interrupt mask register */ ++ ++/* ADC Control registers */ ++#define PMIC_REG_ADCCNTL1 0x61 /*ADC control register */ ++ ++/* ADC Channel Selection registers */ ++#define PMICADDR0 0xA4 ++#define END_OF_CHANNEL 0x1F ++ ++/* ADC Result register */ ++#define PMIC_REG_ADCSNS0H 0x64 ++ ++/* ADC channels for touch screen */ ++#define MRST_TS_CHAN10 0xA /* Touch screen X+ connection */ ++#define MRST_TS_CHAN11 0xB /* Touch screen X- connection */ ++#define MRST_TS_CHAN12 0xC /* Touch screen Y+ connection */ ++#define MRST_TS_CHAN13 0xD /* Touch screen Y- connection */ ++ ++/* Touch screen coordinate constants */ ++#define TOUCH_PRESSURE 5 ++#define TOUCH_PRESSURE_FS 100 ++ ++#define XMOVE_LIMIT 5 ++#define YMOVE_LIMIT 5 ++#define XYMOVE_CNT 3 ++ ++#define MAX_10BIT ((1<<10)-1) ++ ++/* Touch screen channel BIAS constants */ ++#define XBIAS 0x20 ++#define YBIAS 0x40 ++#define ZBIAS 0x80 ++ ++/* Touch screen coordinates */ ++#define MIN_X 10 ++#define MAX_X 1024 ++#define MIN_Y 10 ++#define MAX_Y 1024 ++#define WAIT_ADC_COMPLETION 10 ++ ++/* PMIC ADC round robin delays */ ++#define ADC_LOOP_DELAY0 0x0 /* Continuous loop */ ++#define ADC_LOOP_DELAY1 0x1 /* 4.5 ms approximate */ ++ ++/* PMIC Vendor Identifiers */ ++#define PMIC_VENDOR_FS 0 /* PMIC vendor FreeScale */ ++#define PMIC_VENDOR_MAXIM 1 /* PMIC vendor MAXIM */ ++#define PMIC_VENDOR_NEC 2 /* PMIC vendor NEC */ ++#define MRSTOUCH_MAX_CHANNELS 32 /* Maximum ADC channels */ ++ ++/* Touch screen device structure */ ++struct mrstouch_dev { ++ struct spi_device *spi; /* SPI device associated with touch screen */ ++ struct input_dev *input; /* input device for touchscreen*/ ++ char phys[32]; /* Device name */ ++ struct task_struct *pendet_thrd; /* PENDET interrupt handler */ ++ struct semaphore lock; /* Sync between interrupt and PENDET handler */ ++ bool busy; /* Busy flag */ ++ u16 asr; /* Address selection register */ ++ int irq; /* Touch screen IRQ # */ ++ uint vendor; /* PMIC vendor */ ++ uint rev; /* PMIC revision */ ++ bool suspended; /* Device suspended status */ ++ bool disabled; /* Device disabled status */ ++ u16 x; /* X coordinate */ ++ u16 y; /* Y coordinate */ ++ bool pendown; /* PEN position */ ++} ; ++ ++ ++/* Global Pointer to Touch screen device */ ++static struct mrstouch_dev *mrstouchdevp; ++ ++/* Utility to read PMIC ID */ ++static int mrstouch_pmic_id(uint *vendor, uint *rev) ++{ ++ int err; ++ struct ipc_pmic_reg_data ipcbuf; ++ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 1; ++ ipcbuf.pmic_reg_data[0].register_address = PMIC_REG_ID1; ++ ++ err = ipc_pmic_register_read(&ipcbuf); ++ if (err) ++ return -1; ++ ++ *vendor = (ipcbuf.pmic_reg_data[0].value) & 0x7; ++ *rev = (ipcbuf.pmic_reg_data[0].value >> 3) & 0x7; ++ ++ return 0; ++} ++ ++/* ++ * Parse ADC channels to find end of the channel configured by other ADC user ++ * NEC and MAXIM requires 4 channels and FreeScale needs 18 channels ++ */ ++static int mrstouch_chan_parse(void) ++{ ++ int err, i, j, chan, found; ++ struct ipc_pmic_reg_data ipcbuf; ++ ++ ipcbuf.ioc = 1; ++ ++ found = -1; ++ ipcbuf.num_entries = 4; ++ ++ for (i = 0; i < MRSTOUCH_MAX_CHANNELS; i++) { ++ if (found >= 0) ++ break; ++ ++ for (j = 0; j <= 3; j++) ++ ipcbuf.pmic_reg_data[j].register_address = PMICADDR0+i; ++ ++ err = ipc_pmic_register_read(&ipcbuf); ++ if (err) ++ return -1; ++ ++ for (j = 0; j < ipcbuf.num_entries; j++) { ++ chan = ipcbuf.pmic_reg_data[j].value; ++ if (chan == END_OF_CHANNEL) { ++ found = i; ++ break; ++ } ++ } ++ } ++ ++ if (found < 0) ++ return 0; ++ ++ if (mrstouchdevp->vendor == PMIC_VENDOR_FS) { ++ if (found && found > (MRSTOUCH_MAX_CHANNELS - 18)) ++ return -1; ++ } else { ++ if (found && found > (MRSTOUCH_MAX_CHANNELS - 4)) ++ return -1; ++ } ++ return found; ++} ++ ++/* Utility to enable/disable pendet. ++ * pendet set to true enables PENDET interrupt ++ * pendet set to false disables PENDET interrupt ++ * Also clears RND mask bit ++*/ ++static void pendet_enable(bool pendet) ++{ ++ u8 adccntrl1 = 0; ++ u8 pendet_enabled = 0; ++ int retry = 0; ++ struct ipc_pmic_reg_data ipcbuf; ++ ++ ipcbuf.ioc = 1; ++ ++ ipcbuf.num_entries = 1; ++ ipcbuf.pmic_reg_data[0].register_address = PMIC_REG_ADCCNTL1; ++ ipc_pmic_register_read(&ipcbuf); ++ adccntrl1 = ipcbuf.pmic_reg_data[0].value; ++ ++ if (pendet) ++ adccntrl1 |= 0x20; /* Enable pendet */ ++ else ++ adccntrl1 &= 0xDF; /* Disable pendet */ ++ ++ ipcbuf.num_entries = 2; ++ ipcbuf.pmic_reg_data[0].register_address = PMIC_REG_MADCINT; ++ ipcbuf.pmic_reg_data[0].value = 0x0; ++ ipcbuf.pmic_reg_data[1].register_address = PMIC_REG_ADCCNTL1; ++ ipcbuf.pmic_reg_data[1].value = adccntrl1; ++ ipc_pmic_register_write(&ipcbuf, 1); ++ ++ if (!pendet) ++ return; ++ ++ ++ /* ++ * Sometimes even after ipc_pmic_register_write success ++ * the PMIC register value is not updated. Retry few iterations ++ * to enable pendet. ++ */ ++ ipcbuf.num_entries = 1; ++ ipcbuf.pmic_reg_data[0].register_address = PMIC_REG_ADCCNTL1; ++ ipc_pmic_register_read(&ipcbuf); ++ pendet_enabled = (ipcbuf.pmic_reg_data[0].value >> 5) & 0x01; ++ ++ retry = 0; ++ while (!pendet_enabled) { ++ retry++; ++ msleep(10); ++ ipcbuf.pmic_reg_data[0].register_address = PMIC_REG_ADCCNTL1; ++ ipcbuf.pmic_reg_data[0].value = adccntrl1; ++ ipc_pmic_register_write(&ipcbuf, 1); ++ ++ ipcbuf.pmic_reg_data[0].register_address = PMIC_REG_ADCCNTL1; ++ ipc_pmic_register_read(&ipcbuf); ++ pendet_enabled = (ipcbuf.pmic_reg_data[0].value >> 5) & 0x01; ++ if (retry >= 10) { ++ printk(KERN_ERR "Touch screen disabled\n"); ++ break; ++ } ++ } ++} ++ ++ ++/* To read PMIC ADC touch screen result ++ * Reads ADC storage registers for higher 7 and lower 3 bits ++ * converts the two readings to single value and turns off gain bit ++ */ ++static int mrstouch_ts_chan_read(u16 offset, u16 chan, u16 *vp, u16 *vm) ++{ ++ int err, count; ++ u16 result; ++ struct ipc_pmic_reg_data ipcbuf; ++ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 4; ++ ++ result = PMIC_REG_ADCSNS0H + offset; ++ ++ if (chan == MRST_TS_CHAN12) ++ result += 4; ++ ++ for (count = 0; count <= 3; count++) ++ ipcbuf.pmic_reg_data[count].register_address = result++; ++ ++ err = ipc_pmic_register_read(&ipcbuf); ++ if (err) ++ return -1; ++ ++ *vp = ipcbuf.pmic_reg_data[0].value << 3; /* Higher 7 bits */ ++ *vp |= ipcbuf.pmic_reg_data[1].value & 0x7; /* Lower 3 bits */ ++ *vp &= 0x3FF; ++ ++ *vm = ipcbuf.pmic_reg_data[2].value << 3; /* Higher 7 bits */ ++ *vm |= ipcbuf.pmic_reg_data[3].value & 0x7; /* Lower 3 bits */ ++ *vm &= 0x3FF; ++ ++ return 0; ++} ++ ++/* To configure touch screen channels ++ * Writes touch screen channels to ADC address selection registers ++ */ ++static int mrstouch_ts_chan_set(uint offset) ++{ ++ int err, count; ++ u16 chan; ++ struct ipc_pmic_reg_data ipcbuf; ++ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 5; ++ ++ chan = PMICADDR0 + offset; ++ for (count = 0; count <= 3; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = MRST_TS_CHAN10 + count; ++ } ++ ipcbuf.pmic_reg_data[count].register_address = chan; ++ ipcbuf.pmic_reg_data[count].value = END_OF_CHANNEL; ++ ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ return -1; ++ ++ return 0; ++} ++ ++/* Initialize ADC */ ++static int mrstouch_adc_init(struct mrstouch_dev *tsdev) ++{ ++ int err, start; ++ struct ipc_pmic_mod_reg_data ipcbuf; ++ ++ err = mrstouch_pmic_id(&tsdev->vendor, &tsdev->rev); ++ if (err) { ++ printk(KERN_ERR "Error in reading PMIC Id"); ++ return err; ++ } ++ ++ start = mrstouch_chan_parse(); ++ if (start == -1) { ++ printk(KERN_ERR "Error in parse channels"); ++ return start; ++ } ++ ++ tsdev->asr = start; ++ ++ mrstouch_debug("Channel offset(%d): 0x%X\n", tsdev->asr, tsdev->vendor); ++ ++ /* ADC power on, start, enable PENDET and set loop delay ++ * ADC loop delay is set to 4.5 ms approximately ++ * Loop delay more than this results in jitter in adc readings ++ * Setting loop delay to 0 (continous loop) in MAXIM stops PENDET ++ * interrupt generation sometimes. ++ */ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 2; ++ ipcbuf.pmic_mod_reg_data[0].register_address = PMIC_REG_ADCCNTL1; ++ ipcbuf.pmic_mod_reg_data[0].bit_map = 0xE7; ++ ++ ipcbuf.pmic_mod_reg_data[1].register_address = PMIC_REG_MADCINT; ++ ipcbuf.pmic_mod_reg_data[1].bit_map = 0x03; ++ ++ if (tsdev->vendor == PMIC_VENDOR_FS) { ++ ipcbuf.pmic_mod_reg_data[0].value = 0xE0 | ADC_LOOP_DELAY0; ++ ipcbuf.pmic_mod_reg_data[1].value = 0x5; ++ } else { ++ /* NEC and MAXIm not consistent with loop delay 0 */ ++ ipcbuf.pmic_mod_reg_data[0].value = 0xE0 | ADC_LOOP_DELAY1; ++ ipcbuf.pmic_mod_reg_data[1].value = 0x0; ++ ++ /* configure touch screen channels */ ++ err = mrstouch_ts_chan_set(tsdev->asr); ++ if (err) ++ return err; ++ } ++ ++ err = ipc_pmic_register_read_modify(&ipcbuf); ++ ++ return err; ++} ++ ++/* Reports x,y coordinates to event subsystem */ ++static void mrstouch_report_xy(u16 x, u16 y, u16 z) ++{ ++ int xdiff, ydiff; ++ ++ if (mrstouchdevp->pendown && z <= TOUCH_PRESSURE) { ++ /* Pen removed, report button release */ ++ mrstouch_debug("BTN REL(%d)", z); ++ input_report_key(mrstouchdevp->input, BTN_TOUCH, 0); ++ mrstouchdevp->pendown = false; ++ } ++ ++ xdiff = abs(x - mrstouchdevp->x); ++ ydiff = abs(y - mrstouchdevp->y); ++ ++ /* ++ if x and y values changes for XYMOVE_CNT readings it is considered ++ as stylus is moving. This is required to differentiate between stylus ++ movement and jitter ++ */ ++ if (x < MIN_X || x > MAX_X || y < MIN_Y || y > MAX_Y) { ++ /* Spurious values, release button if touched and return */ ++ if (mrstouchdevp->pendown) { ++ mrstouch_debug("BTN REL(%d)", z); ++ input_report_key(mrstouchdevp->input, BTN_TOUCH, 0); ++ mrstouchdevp->pendown = false; ++ } ++ return; ++ } else if (xdiff >= XMOVE_LIMIT || ydiff >= YMOVE_LIMIT) { ++ mrstouchdevp->x = x; ++ mrstouchdevp->y = y; ++ ++ input_report_abs(mrstouchdevp->input, ABS_X, x); ++ input_report_abs(mrstouchdevp->input, ABS_Y, y); ++ input_sync(mrstouchdevp->input); ++ } ++ ++ ++ if (!mrstouchdevp->pendown && z > TOUCH_PRESSURE) { ++ /* Pen touched, report button touch */ ++ mrstouch_debug("BTN TCH(%d, %d, %d)", x, y, z); ++ input_report_key(mrstouchdevp->input, BTN_TOUCH, 1); ++ mrstouchdevp->pendown = true; ++ } ++} ++ ++ ++/* Utility to start ADC, used by freescale handler */ ++static int pendet_mask(void) ++{ ++ int err = 0; ++ struct ipc_pmic_mod_reg_data ipcbuf; ++ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 1; ++ ipcbuf.pmic_mod_reg_data[1].register_address = PMIC_REG_MADCINT; ++ ipcbuf.pmic_mod_reg_data[1].bit_map = 0x02; ++ ipcbuf.pmic_mod_reg_data[1].value = 0x01; ++ ++ err = ipc_pmic_register_read_modify(&ipcbuf); ++ ++ return err; ++} ++ ++/* Utility to stop ADC, used by freescale handler */ ++static int pendet_umask(void) ++{ ++ int err = 0; ++ struct ipc_pmic_mod_reg_data ipcbuf; ++ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 1; ++ ipcbuf.pmic_mod_reg_data[1].register_address = PMIC_REG_MADCINT; ++ ipcbuf.pmic_mod_reg_data[1].bit_map = 0x02; ++ ipcbuf.pmic_mod_reg_data[1].value = 0x0; ++ ++ err = ipc_pmic_register_read_modify(&ipcbuf); ++ ++ return err; ++} ++ ++/* Utility to read ADC, used by freescale handler */ ++static int mrstouch_pmic_fs_adc_read(struct mrstouch_dev *tsdev) ++{ ++ int err; ++ u16 x, y, z, result; ++ struct ipc_pmic_reg_data ipcbuf; ++ ++ result = PMIC_REG_ADCSNS0H + tsdev->asr; ++ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 4; ++ ipcbuf.pmic_reg_data[0].register_address = result + 4; ++ ipcbuf.pmic_reg_data[1].register_address = result + 5; ++ ipcbuf.pmic_reg_data[2].register_address = result + 16; ++ ipcbuf.pmic_reg_data[3].register_address = result + 17; ++ ++ err = ipc_pmic_register_read(&ipcbuf); ++ if (err) ++ goto ipc_error; ++ ++ x = ipcbuf.pmic_reg_data[0].value << 3; /* Higher 7 bits */ ++ x |= ipcbuf.pmic_reg_data[1].value & 0x7; /* Lower 3 bits */ ++ x &= 0x3FF; ++ ++ y = ipcbuf.pmic_reg_data[2].value << 3; /* Higher 7 bits */ ++ y |= ipcbuf.pmic_reg_data[3].value & 0x7; /* Lower 3 bits */ ++ y &= 0x3FF; ++ ++ /* Read Z value */ ++ ipcbuf.num_entries = 2; ++ ipcbuf.pmic_reg_data[0].register_address = result + 28; ++ ipcbuf.pmic_reg_data[1].register_address = result + 29; ++ ++ err = ipc_pmic_register_read(&ipcbuf); ++ if (err) ++ goto ipc_error; ++ ++ z = ipcbuf.pmic_reg_data[0].value << 3; /* Higher 7 bits */ ++ z |= ipcbuf.pmic_reg_data[1].value & 0x7; /* Lower 3 bits */ ++ z &= 0x3FF; ++ ++#if defined(MRSTOUCH_PRINT_XYZP) ++ mrstouch_debug("X: %d, Y: %d, Z: %d", x, y, z); ++#endif ++ ++ if (z >= TOUCH_PRESSURE_FS) { ++ mrstouch_report_xy(x, y, TOUCH_PRESSURE - 1); /* Pen Removed */ ++ return TOUCH_PRESSURE - 1; ++ } else { ++ mrstouch_report_xy(x, y, TOUCH_PRESSURE + 1); /* Pen Touched */ ++ return TOUCH_PRESSURE + 1; ++ } ++ ++ return 0; ++ ++ipc_error: ++ printk(KERN_ERR "IPC Error: %s", __func__); ++ return -1; ++} ++ ++/* To handle free scale pmic pendet interrupt */ ++static int pmic0_pendet(void *data) ++{ ++ int err, count; ++ u16 chan; ++ unsigned int touched; ++ struct ipc_pmic_reg_data ipcbuf; ++ struct mrstouch_dev *tsdev = (struct mrstouch_dev *)data; ++ ++ chan = PMICADDR0 + tsdev->asr; ++ ++ ipcbuf.ioc = 1; ++ /* Set X BIAS */ ++ ipcbuf.num_entries = 5; ++ for (count = 0; count <= 3; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = 0x2A; ++ } ++ ipcbuf.pmic_reg_data[count].register_address = chan++; /* Dummy */ ++ ipcbuf.pmic_reg_data[count].value = 0; ++ ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ goto ipc_error; ++ ++ msleep(WAIT_ADC_COMPLETION); ++ ++ /* Set Y BIAS */ ++ ipcbuf.num_entries = 5; ++ for (count = 0; count <= 3; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = 0x4A; ++ } ++ ipcbuf.pmic_reg_data[count].register_address = chan++; /* Dummy */ ++ ipcbuf.pmic_reg_data[count].value = 0; ++ ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ goto ipc_error; ++ ++ msleep(WAIT_ADC_COMPLETION); ++ ++ /* Set Z BIAS */ ++ chan += 2; ++ ipcbuf.num_entries = 4; ++ for (count = 0; count <= 3; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = 0x8A; ++ } ++ ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ goto ipc_error; ++ ++ msleep(WAIT_ADC_COMPLETION); ++ ++ /*Read touch screen channels till pen removed ++ * Freescale reports constant value of z for all points ++ * z is high when screen is not touched and low when touched ++ * Map high z value to not touched and low z value to pen touched ++ */ ++ touched = mrstouch_pmic_fs_adc_read(tsdev); ++ while (touched > TOUCH_PRESSURE) { ++ touched = mrstouch_pmic_fs_adc_read(tsdev); ++ msleep(WAIT_ADC_COMPLETION); ++ } ++ ++ /* Clear all TS channels */ ++ chan = PMICADDR0 + tsdev->asr; ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 5; ++ for (count = 0; count <= 4; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = 0x0; ++ } ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ goto ipc_error; ++ ++ for (count = 0; count <= 4; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = 0x0; ++ } ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ goto ipc_error; ++ ++ chan += 2; ++ for (count = 0; count <= 4; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = 0x0; ++ } ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ goto ipc_error; ++ ++ return 0; ++ ++ipc_error: ++ printk(KERN_ERR "IPC Error: %s", __func__); ++ return -1; ++} ++ ++ ++/* To enable X, Y and Z bias values ++ * Enables YPYM for X channels and XPXM for Y channels ++ */ ++static int mrstouch_ts_bias_set(uint offset, uint bias) ++{ ++ int err, count; ++ u16 chan, start; ++ struct ipc_pmic_reg_data ipcbuf; ++ ++ chan = PMICADDR0 + offset; ++ start = MRST_TS_CHAN10; ++ ++ ipcbuf.ioc = 1; ++ ipcbuf.num_entries = 4; ++ ++ for (count = 0; count <= 3; count++) { ++ ipcbuf.pmic_reg_data[count].register_address = chan++; ++ ipcbuf.pmic_reg_data[count].value = bias | (start + count); ++ } ++ ++ err = ipc_pmic_register_write(&ipcbuf, 1); ++ if (err) ++ return -1; ++ ++ return 0; ++} ++ ++/* To read touch screen channel values */ ++static int mrstouch_adc_read(struct mrstouch_dev *tsdev) ++{ ++ int err; ++ u16 xp, xm, yp, ym, zp, zm; ++ ++ /* configure Y bias for X channels */ ++ err = mrstouch_ts_bias_set(tsdev->asr, YBIAS); ++ if (err) ++ goto ipc_error; ++ ++ msleep(WAIT_ADC_COMPLETION); ++ ++ /* read x+ and x- channels */ ++ err = mrstouch_ts_chan_read(tsdev->asr, MRST_TS_CHAN10, &xp, &xm); ++ if (err) ++ goto ipc_error; ++ ++ /* configure x bias for y channels */ ++ err = mrstouch_ts_bias_set(tsdev->asr, XBIAS); ++ if (err) ++ goto ipc_error; ++ ++ msleep(WAIT_ADC_COMPLETION); ++ ++ /* read y+ and y- channels */ ++ err = mrstouch_ts_chan_read(tsdev->asr, MRST_TS_CHAN12, &yp, &ym); ++ if (err) ++ goto ipc_error; ++ ++ /* configure z bias for x and y channels */ ++ err = mrstouch_ts_bias_set(tsdev->asr, ZBIAS); ++ if (err) ++ goto ipc_error; ++ ++ msleep(WAIT_ADC_COMPLETION); ++ ++ /* read z+ and z- channels */ ++ err = mrstouch_ts_chan_read(tsdev->asr, MRST_TS_CHAN10, &zp, &zm); ++ if (err) ++ goto ipc_error; ++ ++#if defined(MRSTOUCH_PRINT_XYZP) ++ printk(KERN_INFO "X+: %d, Y+: %d, Z+: %d\n", xp, yp, zp); ++#endif ++ ++#if defined(MRSTOUCH_PRINT_XYZM) ++ printk(KERN_INFO "X-: %d, Y-: %d, Z-: %d\n", xm, ym, zm); ++#endif ++ ++ mrstouch_report_xy(xp, yp, zp); /* report x and y to eventX */ ++ ++ return zp; ++ ++ipc_error: ++ printk(KERN_ERR "IPC Error: %s", __func__); ++ return -1; ++} ++ ++/* PENDET interrupt handler function for NEC and MAXIM */ ++static void pmic12_pendet(void *data) ++{ ++ unsigned int touched; ++ struct mrstouch_dev *tsdev = (struct mrstouch_dev *)data; ++ ++ /* read touch screen channels till pen removed */ ++ touched = mrstouch_adc_read(tsdev); ++ while (touched > TOUCH_PRESSURE) { ++ msleep(WAIT_ADC_COMPLETION); ++ touched = mrstouch_adc_read(tsdev); ++ } ++} ++ ++/* Handler to process PENDET interrupt */ ++int mrstouch_pendet(void *data) ++{ ++ struct mrstouch_dev *tsdev = (struct mrstouch_dev *)data; ++ while (1) { ++ /* Wait for PENDET interrupt */ ++ if (down_interruptible(&tsdev->lock)) { ++ msleep(WAIT_ADC_COMPLETION); ++ continue; ++ } ++ ++ if (tsdev->busy) ++ return 0; ++ ++ tsdev->busy = true; ++ ++ if (mrstouchdevp->vendor == PMIC_VENDOR_NEC || ++ mrstouchdevp->vendor == PMIC_VENDOR_MAXIM) { ++ /* PENDET must be disabled in NEC before reading ADC */ ++ pendet_enable(false); /* Disbale PENDET */ ++ pmic12_pendet(mrstouchdevp); ++ pendet_enable(true); /*Enable PENDET */ ++ } else if (mrstouchdevp->vendor == PMIC_VENDOR_FS) { ++ pendet_umask(); /* Stop ADC */ ++ pmic0_pendet(mrstouchdevp); ++ pendet_mask(); /* Stop ADC */ ++ } else ++ printk(KERN_ERR "Unknown PMIC, Not supported\n"); ++ ++ tsdev->busy = false; ++ ++ } ++ return 0; ++} ++ ++/* PENDET interrupt handler */ ++static irqreturn_t pendet_intr_handler(int irq, void *handle) ++{ ++ struct mrstouch_dev *tsdev = (struct mrstouch_dev *)handle; ++ ++ up(&tsdev->lock); ++ return IRQ_HANDLED; ++} ++ ++/* Intializes input device and registers with input subsystem */ ++static int ts_input_dev_init(struct mrstouch_dev *tsdev, struct spi_device *spi) ++{ ++ int err = 0; ++ ++ mrstouch_debug("%s", __func__); ++ ++ tsdev->input = input_allocate_device(); ++ if (!tsdev->input) { ++ mrstouch_error("%s", "Input dev allocation failed"); ++ return -1; ++ } ++ ++ tsdev->input->name = "mrst_touchscreen"; ++ snprintf(tsdev->phys, sizeof(tsdev->phys), ++ "%s/input0", dev_name(&spi->dev)); ++ tsdev->input->phys = tsdev->phys; ++ tsdev->input->dev.parent = &spi->dev; ++ ++ tsdev->input->id.vendor = tsdev->vendor; ++ tsdev->input->id.version = tsdev->rev; ++ ++ tsdev->input->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); ++ tsdev->input->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH); ++ ++ input_set_abs_params(tsdev->input, ABS_X, MIN_X, MIN_Y, 0, 0); ++ input_set_abs_params(tsdev->input, ABS_Y, MIN_X, MIN_Y, 0, 0); ++ ++ err = input_register_device(tsdev->input); ++ if (err) { ++ mrstouch_error("%s", "Input dev registration failed"); ++ input_free_device(tsdev->input); ++ return -1; ++ } ++ ++ mrstouch_debug("%s", "mrstouch initialized"); ++ ++ return 0; ++ ++} ++ ++/* Probe function for touch screen driver */ ++static int __devinit mrstouch_probe(struct spi_device *mrstouch_spi) ++{ ++ int err; ++ unsigned int myirq; ++ struct mrstouch_dev *tsdev; ++ ++ mrstouch_debug("%s(%p)", __func__, mrstouch_spi); ++ ++ mrstouchdevp = NULL; ++ myirq = mrstouch_spi->irq; ++ ++ if (!mrstouch_spi->irq) { ++ mrstouch_error("%s(%d)", "No IRQ", myirq); ++ return -1; ++ } ++ ++ tsdev = kzalloc(sizeof(struct mrstouch_dev), GFP_KERNEL); ++ if (!tsdev) { ++ mrstouch_error("%s", "ERROR: Memory failure"); ++ return -ENOMEM; ++ } ++ ++ tsdev->irq = myirq; ++ mrstouchdevp = tsdev; ++ ++ if (mrstouch_adc_init(tsdev) != 0) { ++ mrstouch_error("%s", "ADC init failed"); ++ goto mrstouch_err_free_mem; ++ } ++ ++ dev_set_drvdata(&mrstouch_spi->dev, tsdev); ++ tsdev->spi = mrstouch_spi; ++ ++ err = ts_input_dev_init(tsdev, mrstouch_spi); ++ if (err != 0) { ++ mrstouch_error("%s", "ts_input_dev_init failed"); ++ goto mrstouch_err_free_mem; ++ } ++ ++ sema_init(&tsdev->lock, 1); ++ if (down_interruptible(&tsdev->lock)) { ++ mrstouch_error("%s", "tsdev->lock Error"); ++ goto mrstouch_err_free_mem; ++ } ++ ++ mrstouch_debug("Requesting IRQ-%d", myirq); ++ err = request_irq(myirq, pendet_intr_handler, ++ 0, "mrstouch", tsdev); ++ if (err) { ++ mrstouch_error("IRQ Request Failed - %d", err); ++ goto mrstouch_err_free_mem; ++ } ++ ++ tsdev->pendet_thrd = kthread_run(mrstouch_pendet, ++ (void *)tsdev, "pendet handler"); ++ if (IS_ERR(tsdev->pendet_thrd)) { ++ dev_err(&tsdev->spi->dev, "kthread_run failed \n"); ++ goto mrstouch_err_free_mem; ++ } ++ ++ mrstouch_debug("%s", "Driver initialized"); ++ ++ return 0; ++ ++ mrstouch_err_free_mem: ++ kfree(tsdev); ++ return -1; ++} ++ ++static int mrstouch_suspend(struct spi_device *spi, pm_message_t msg) ++{ ++ mrstouch_debug("%s", __func__); ++ mrstouchdevp->suspended = 1; ++ return 0; ++} ++ ++static int mrstouch_resume(struct spi_device *spi) ++{ ++ mrstouch_debug("%s", __func__); ++ mrstouchdevp->suspended = 0; ++ return 0; ++} ++ ++static int mrstouch_remove(struct spi_device *spi) ++{ ++ mrstouch_debug("%s", __func__); ++ free_irq(mrstouchdevp->irq, mrstouchdevp); ++ input_unregister_device(mrstouchdevp->input); ++ input_free_device(mrstouchdevp->input); ++ kfree(mrstouchdevp); ++ if (mrstouchdevp->pendet_thrd) ++ kthread_stop(mrstouchdevp->pendet_thrd); ++ return 0; ++} ++ ++static struct spi_driver mrstouch_driver = { ++ .driver = { ++ .name = "pmic_touch", ++ .bus = &spi_bus_type, ++ .owner = THIS_MODULE, ++ }, ++ .probe = mrstouch_probe, ++ .suspend = mrstouch_suspend, ++ .resume = mrstouch_resume, ++ .remove = mrstouch_remove, ++}; ++ ++static int __init mrstouch_module_init(void) ++{ ++ int err; ++ ++ mrstouch_debug("%s", __func__); ++ err = spi_register_driver(&mrstouch_driver); ++ if (err) { ++ mrstouch_debug("%s(%d)", "SPI PENDET failed", err); ++ return -1; ++ } ++ ++ return 0; ++} ++ ++static void __exit mrstouch_module_exit(void) ++{ ++ mrstouch_debug("%s", __func__); ++ spi_unregister_driver(&mrstouch_driver); ++ return; ++} ++ ++module_init(mrstouch_module_init); ++module_exit(mrstouch_module_exit); +-- +1.6.2.5 + -- cgit v1.2.3