forked from Minki/linux
1da177e4c3
Initial git repository build. I'm not bothering with the full history, even though we have it. We can create a separate "historical" git archive of that later if we want to, and in the meantime it's about 3.2GB when imported into git - space that would just make the early git days unnecessarily complicated, when we don't have a lot of good infrastructure for it. Let it rip!
381 lines
9.4 KiB
C
381 lines
9.4 KiB
C
/*
|
|
* Touchscreen driver for Sharp Corgi models (SL-C7xx)
|
|
*
|
|
* Copyright (c) 2004-2005 Richard Purdie
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
*/
|
|
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/device.h>
|
|
#include <linux/init.h>
|
|
#include <linux/input.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <asm/irq.h>
|
|
|
|
#include <asm/arch/corgi.h>
|
|
#include <asm/arch/hardware.h>
|
|
#include <asm/arch/pxa-regs.h>
|
|
|
|
|
|
#define PWR_MODE_ACTIVE 0
|
|
#define PWR_MODE_SUSPEND 1
|
|
|
|
#define X_AXIS_MAX 3830
|
|
#define X_AXIS_MIN 150
|
|
#define Y_AXIS_MAX 3830
|
|
#define Y_AXIS_MIN 190
|
|
#define PRESSURE_MIN 0
|
|
#define PRESSURE_MAX 15000
|
|
|
|
struct ts_event {
|
|
short pressure;
|
|
short x;
|
|
short y;
|
|
};
|
|
|
|
struct corgi_ts {
|
|
char phys[32];
|
|
struct input_dev input;
|
|
struct timer_list timer;
|
|
struct ts_event tc;
|
|
int pendown;
|
|
int power_mode;
|
|
};
|
|
|
|
#define STATUS_HSYNC (GPLR(CORGI_GPIO_HSYNC) & GPIO_bit(CORGI_GPIO_HSYNC))
|
|
|
|
#define SyncHS() while((STATUS_HSYNC) == 0); while((STATUS_HSYNC) != 0);
|
|
#define CCNT(a) asm volatile ("mrc p14, 0, %0, C1, C0, 0" : "=r"(a))
|
|
#define CCNT_ON() {int pmnc = 1; asm volatile ("mcr p14, 0, %0, C0, C0, 0" : : "r"(pmnc));}
|
|
#define CCNT_OFF() {int pmnc = 0; asm volatile ("mcr p14, 0, %0, C0, C0, 0" : : "r"(pmnc));}
|
|
|
|
#define WAIT_HS_400_VGA 7013U // 17.615us
|
|
#define WAIT_HS_400_QVGA 16622U // 41.750us
|
|
|
|
|
|
/* ADS7846 Touch Screen Controller bit definitions */
|
|
#define ADSCTRL_PD0 (1u << 0) /* PD0 */
|
|
#define ADSCTRL_PD1 (1u << 1) /* PD1 */
|
|
#define ADSCTRL_DFR (1u << 2) /* SER/DFR */
|
|
#define ADSCTRL_MOD (1u << 3) /* Mode */
|
|
#define ADSCTRL_ADR_SH 4 /* Address setting */
|
|
#define ADSCTRL_STS (1u << 7) /* Start Bit */
|
|
|
|
/* External Functions */
|
|
extern int w100fb_get_xres(void);
|
|
extern int w100fb_get_blanking(void);
|
|
extern int w100fb_get_fastsysclk(void);
|
|
extern unsigned int get_clk_frequency_khz(int info);
|
|
|
|
static unsigned long calc_waittime(void)
|
|
{
|
|
int w100fb_xres = w100fb_get_xres();
|
|
unsigned int waittime = 0;
|
|
|
|
if (w100fb_xres == 480 || w100fb_xres == 640) {
|
|
waittime = WAIT_HS_400_VGA * get_clk_frequency_khz(0) / 398131U;
|
|
|
|
if (w100fb_get_fastsysclk() == 100)
|
|
waittime = waittime * 75 / 100;
|
|
|
|
if (w100fb_xres == 640)
|
|
waittime *= 3;
|
|
|
|
return waittime;
|
|
}
|
|
|
|
return WAIT_HS_400_QVGA * get_clk_frequency_khz(0) / 398131U;
|
|
}
|
|
|
|
static int sync_receive_data_send_cmd(int doRecive, int doSend, unsigned int address, unsigned long wait_time)
|
|
{
|
|
int pos = 0;
|
|
unsigned long timer1 = 0, timer2;
|
|
int dosleep;
|
|
|
|
dosleep = !w100fb_get_blanking();
|
|
|
|
if (dosleep && doSend) {
|
|
CCNT_ON();
|
|
/* polling HSync */
|
|
SyncHS();
|
|
/* get CCNT */
|
|
CCNT(timer1);
|
|
}
|
|
|
|
if (doRecive)
|
|
pos = corgi_ssp_ads7846_get();
|
|
|
|
if (doSend) {
|
|
int cmd = ADSCTRL_PD0 | ADSCTRL_PD1 | (address << ADSCTRL_ADR_SH) | ADSCTRL_STS;
|
|
/* dummy command */
|
|
corgi_ssp_ads7846_put(cmd);
|
|
corgi_ssp_ads7846_get();
|
|
|
|
if (dosleep) {
|
|
/* Wait after HSync */
|
|
CCNT(timer2);
|
|
if (timer2-timer1 > wait_time) {
|
|
/* timeout */
|
|
SyncHS();
|
|
/* get OSCR */
|
|
CCNT(timer1);
|
|
/* Wait after HSync */
|
|
CCNT(timer2);
|
|
}
|
|
while (timer2 - timer1 < wait_time)
|
|
CCNT(timer2);
|
|
}
|
|
corgi_ssp_ads7846_put(cmd);
|
|
if (dosleep)
|
|
CCNT_OFF();
|
|
}
|
|
return pos;
|
|
}
|
|
|
|
static int read_xydata(struct corgi_ts *corgi_ts)
|
|
{
|
|
unsigned int x, y, z1, z2;
|
|
unsigned long flags, wait_time;
|
|
|
|
/* critical section */
|
|
local_irq_save(flags);
|
|
corgi_ssp_ads7846_lock();
|
|
wait_time=calc_waittime();
|
|
|
|
/* Y-axis */
|
|
sync_receive_data_send_cmd(0, 1, 1u, wait_time);
|
|
|
|
/* Y-axis */
|
|
sync_receive_data_send_cmd(1, 1, 1u, wait_time);
|
|
|
|
/* X-axis */
|
|
y = sync_receive_data_send_cmd(1, 1, 5u, wait_time);
|
|
|
|
/* Z1 */
|
|
x = sync_receive_data_send_cmd(1, 1, 3u, wait_time);
|
|
|
|
/* Z2 */
|
|
z1 = sync_receive_data_send_cmd(1, 1, 4u, wait_time);
|
|
z2 = sync_receive_data_send_cmd(1, 0, 4u, wait_time);
|
|
|
|
/* Power-Down Enable */
|
|
corgi_ssp_ads7846_put((1u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
|
|
corgi_ssp_ads7846_get();
|
|
|
|
corgi_ssp_ads7846_unlock();
|
|
local_irq_restore(flags);
|
|
|
|
if (x== 0 || y == 0 || z1 == 0 || (x * (z2 - z1) / z1) >= 15000) {
|
|
corgi_ts->tc.pressure = 0;
|
|
return 0;
|
|
}
|
|
|
|
corgi_ts->tc.x = x;
|
|
corgi_ts->tc.y = y;
|
|
corgi_ts->tc.pressure = (x * (z2 - z1)) / z1;
|
|
return 1;
|
|
}
|
|
|
|
static void new_data(struct corgi_ts *corgi_ts, struct pt_regs *regs)
|
|
{
|
|
if (corgi_ts->power_mode != PWR_MODE_ACTIVE)
|
|
return;
|
|
|
|
if (!corgi_ts->tc.pressure && corgi_ts->pendown == 0)
|
|
return;
|
|
|
|
if (regs)
|
|
input_regs(&corgi_ts->input, regs);
|
|
|
|
input_report_abs(&corgi_ts->input, ABS_X, corgi_ts->tc.x);
|
|
input_report_abs(&corgi_ts->input, ABS_Y, corgi_ts->tc.y);
|
|
input_report_abs(&corgi_ts->input, ABS_PRESSURE, corgi_ts->tc.pressure);
|
|
input_report_key(&corgi_ts->input, BTN_TOUCH, (corgi_ts->pendown != 0));
|
|
input_sync(&corgi_ts->input);
|
|
}
|
|
|
|
static void ts_interrupt_main(struct corgi_ts *corgi_ts, int isTimer, struct pt_regs *regs)
|
|
{
|
|
if ((GPLR(CORGI_GPIO_TP_INT) & GPIO_bit(CORGI_GPIO_TP_INT)) == 0) {
|
|
/* Disable Interrupt */
|
|
set_irq_type(CORGI_IRQ_GPIO_TP_INT, IRQT_NOEDGE);
|
|
if (read_xydata(corgi_ts)) {
|
|
corgi_ts->pendown = 1;
|
|
new_data(corgi_ts, regs);
|
|
}
|
|
mod_timer(&corgi_ts->timer, jiffies + HZ / 100);
|
|
} else {
|
|
if (corgi_ts->pendown == 1 || corgi_ts->pendown == 2) {
|
|
mod_timer(&corgi_ts->timer, jiffies + HZ / 100);
|
|
corgi_ts->pendown++;
|
|
return;
|
|
}
|
|
|
|
if (corgi_ts->pendown) {
|
|
corgi_ts->tc.pressure = 0;
|
|
new_data(corgi_ts, regs);
|
|
}
|
|
|
|
/* Enable Falling Edge */
|
|
set_irq_type(CORGI_IRQ_GPIO_TP_INT, IRQT_FALLING);
|
|
corgi_ts->pendown = 0;
|
|
}
|
|
}
|
|
|
|
static void corgi_ts_timer(unsigned long data)
|
|
{
|
|
struct corgi_ts *corgits_data = (struct corgi_ts *) data;
|
|
ts_interrupt_main(corgits_data, 1, NULL);
|
|
}
|
|
|
|
static irqreturn_t ts_interrupt(int irq, void *dev_id, struct pt_regs *regs)
|
|
{
|
|
struct corgi_ts *corgits_data = dev_id;
|
|
ts_interrupt_main(corgits_data, 0, regs);
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int corgits_suspend(struct device *dev, uint32_t state, uint32_t level)
|
|
{
|
|
if (level == SUSPEND_POWER_DOWN) {
|
|
struct corgi_ts *corgi_ts = dev_get_drvdata(dev);
|
|
|
|
if (corgi_ts->pendown) {
|
|
del_timer_sync(&corgi_ts->timer);
|
|
corgi_ts->tc.pressure = 0;
|
|
new_data(corgi_ts, NULL);
|
|
corgi_ts->pendown = 0;
|
|
}
|
|
corgi_ts->power_mode = PWR_MODE_SUSPEND;
|
|
|
|
corgi_ssp_ads7846_putget((1u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int corgits_resume(struct device *dev, uint32_t level)
|
|
{
|
|
if (level == RESUME_POWER_ON) {
|
|
struct corgi_ts *corgi_ts = dev_get_drvdata(dev);
|
|
|
|
corgi_ssp_ads7846_putget((4u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
|
|
/* Enable Falling Edge */
|
|
set_irq_type(CORGI_IRQ_GPIO_TP_INT, IRQT_FALLING);
|
|
corgi_ts->power_mode = PWR_MODE_ACTIVE;
|
|
}
|
|
return 0;
|
|
}
|
|
#else
|
|
#define corgits_suspend NULL
|
|
#define corgits_resume NULL
|
|
#endif
|
|
|
|
static int __init corgits_probe(struct device *dev)
|
|
{
|
|
struct corgi_ts *corgi_ts;
|
|
|
|
if (!(corgi_ts = kmalloc(sizeof(struct corgi_ts), GFP_KERNEL)))
|
|
return -ENOMEM;
|
|
|
|
dev_set_drvdata(dev, corgi_ts);
|
|
|
|
memset(corgi_ts, 0, sizeof(struct corgi_ts));
|
|
|
|
init_input_dev(&corgi_ts->input);
|
|
corgi_ts->input.evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
|
|
corgi_ts->input.keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH);
|
|
input_set_abs_params(&corgi_ts->input, ABS_X, X_AXIS_MIN, X_AXIS_MAX, 0, 0);
|
|
input_set_abs_params(&corgi_ts->input, ABS_Y, Y_AXIS_MIN, Y_AXIS_MAX, 0, 0);
|
|
input_set_abs_params(&corgi_ts->input, ABS_PRESSURE, PRESSURE_MIN, PRESSURE_MAX, 0, 0);
|
|
|
|
strcpy(corgi_ts->phys, "corgits/input0");
|
|
|
|
corgi_ts->input.private = corgi_ts;
|
|
corgi_ts->input.name = "Corgi Touchscreen";
|
|
corgi_ts->input.dev = dev;
|
|
corgi_ts->input.phys = corgi_ts->phys;
|
|
corgi_ts->input.id.bustype = BUS_HOST;
|
|
corgi_ts->input.id.vendor = 0x0001;
|
|
corgi_ts->input.id.product = 0x0002;
|
|
corgi_ts->input.id.version = 0x0100;
|
|
|
|
pxa_gpio_mode(CORGI_GPIO_TP_INT | GPIO_IN);
|
|
pxa_gpio_mode(CORGI_GPIO_HSYNC | GPIO_IN);
|
|
|
|
/* Initiaize ADS7846 Difference Reference mode */
|
|
corgi_ssp_ads7846_putget((1u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
|
|
mdelay(5);
|
|
corgi_ssp_ads7846_putget((3u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
|
|
mdelay(5);
|
|
corgi_ssp_ads7846_putget((4u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
|
|
mdelay(5);
|
|
corgi_ssp_ads7846_putget((5u << ADSCTRL_ADR_SH) | ADSCTRL_STS);
|
|
mdelay(5);
|
|
|
|
init_timer(&corgi_ts->timer);
|
|
corgi_ts->timer.data = (unsigned long) corgi_ts;
|
|
corgi_ts->timer.function = corgi_ts_timer;
|
|
|
|
input_register_device(&corgi_ts->input);
|
|
corgi_ts->power_mode = PWR_MODE_ACTIVE;
|
|
|
|
if (request_irq(CORGI_IRQ_GPIO_TP_INT, ts_interrupt, SA_INTERRUPT, "ts", corgi_ts)) {
|
|
input_unregister_device(&corgi_ts->input);
|
|
kfree(corgi_ts);
|
|
return -EBUSY;
|
|
}
|
|
|
|
/* Enable Falling Edge */
|
|
set_irq_type(CORGI_IRQ_GPIO_TP_INT, IRQT_FALLING);
|
|
|
|
printk(KERN_INFO "input: Corgi Touchscreen Registered\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int corgits_remove(struct device *dev)
|
|
{
|
|
struct corgi_ts *corgi_ts = dev_get_drvdata(dev);
|
|
|
|
free_irq(CORGI_IRQ_GPIO_TP_INT, NULL);
|
|
del_timer_sync(&corgi_ts->timer);
|
|
input_unregister_device(&corgi_ts->input);
|
|
kfree(corgi_ts);
|
|
return 0;
|
|
}
|
|
|
|
static struct device_driver corgits_driver = {
|
|
.name = "corgi-ts",
|
|
.bus = &platform_bus_type,
|
|
.probe = corgits_probe,
|
|
.remove = corgits_remove,
|
|
.suspend = corgits_suspend,
|
|
.resume = corgits_resume,
|
|
};
|
|
|
|
static int __devinit corgits_init(void)
|
|
{
|
|
return driver_register(&corgits_driver);
|
|
}
|
|
|
|
static void __exit corgits_exit(void)
|
|
{
|
|
driver_unregister(&corgits_driver);
|
|
}
|
|
|
|
module_init(corgits_init);
|
|
module_exit(corgits_exit);
|
|
|
|
MODULE_AUTHOR("Richard Purdie <rpurdie@rpsys.net>");
|
|
MODULE_DESCRIPTION("Corgi TouchScreen Driver");
|
|
MODULE_LICENSE("GPL");
|