S3C2410触摸屏问题

Question

小弟最近在我的友善之臂2410开发板上想将其升级到2.6.14的kernel。前段时间费劲周折将kernel移植搞定了，现在在忙着移植一些驱动了。我的触摸屏是s3c2410的，在2.6.14的KERNEL源码树中是没有被包含的。
    于是，我在网上找了一些资料，找到了牛人们贴出来的s3c2410触摸屏的驱动程序（参考http://www.cnitblog.com/luofuchong/archive/2007/08/22/32177.html）。我把它移植于我的开发板中，经过一些周折，可以正常RUN起来了，而且，当我触摸屏幕的时候，在超级终端中会打印出时间和X，Y坐标的值。然后，我想编一个应用程序去读驱动返回的坐标值，结果发现应用程序读到的坐标值和驱动程序里面（调试模式下）打印出来的坐标值不相同，验证过好多次都这样的。这是为什么呢，是我的驱动程序本身的问题，还是我写的应用程序的问题呢。希望大虾们能够指点指点啊，小弟已经弄这个小问题已经搞了好几天了，已经没有思路了。。。。。谢谢了！
    这是终端打印出来的数据：
T: 440013, X: 533, Y: 623
value,x is: 124,y is: 194,dir is: 1
T: 445047, X: 530, Y: 625
value,x is: 124,y is: 195,dir is: 1
T: 455035, X: 534, Y: 643
value,x is: 125,y is: 199,dir is: 1
T: 460034, X: 535, Y: 643
value,x is: 125,y is: 200,dir is: 1
T: 465034, X: 534, Y: 635
value,x is: 125,y is: 200,dir is: 1
value,x is: 125,y is: 198,dir is: 1
value,x is: 125,y is: 198,dir is: 0

其中，T: 440013, X: 533, Y: 623是驱动程序打印出来的，value,x is: 124,y is: 194,dir is: 1是应用程序打印出来的。
       

以下是我的源码：
(1).我写的应用程序源码：ts_test.c

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <signal.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/select.h>
#include <sys/time.h>
#include <errno.h>

#define TOUCHSCREEN "/dev/input/ts0"

struct TS_RET {
        short pressure;
        short x;
        short y;
        short millisecs;
};
int main()
{
        int fd;
        struct TS_RET buf;
       
        struct timeval tv;
       

        tv.tv_sec = 0;
        tv.tv_usec = 100;
        fd = open(TOUCHSCREEN,O_RDONLY);

        if( fd<0 )
        {
                printf("open TOUCHSCREEN error\n");
                return -1;
        }

        while(1)
        {
                int ret;       
                fd_set set;
                FD_ZERO(&set);
                FD_SET(fd,&set);

                ret = select(fd+1,&set,NULL,NULL,NULL);
                if (ret < 0)
                {
                        perror("select");
                        exit(1);
                }
               
                if (ret == 0)
                {
                        printf("Timeout.\n");
                }
                else if (FD_ISSET(fd, &set))
                {
                        int ret = read( fd,&buf,sizeof(struct TS_RET) );

                        if (ret != sizeof(struct TS_RET))
                        {
                                if (errno != EAGAIN)
                                        perror("read TOUCHSCREEN\n");
                                continue;
                        }
                        else
                        {
                                printf("value,x is: %d,y is: %d,dir is: %d,time:%d\n", buf.x,buf.y,buf.pressure,buf.millisecs);
                        }
                }       

        }
        close(fd);
        return 0;
}

（2）网上搜索到的S3C2410触摸屏驱动程序：s3c2410_ts.c

#include <linux/config.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/input.h>
#include <linux/init.h>
#include <linux/serio.h>
#include <linux/delay.h>

#include <asm/io.h>
#include <asm/irq.h>
#include <asm/arch/regs-adc.h>
#include <asm/arch/regs-gpio.h>
#include <asm/arch/s3c2410_ts.h>
#include <asm/hardware/clock.h>

/* For ts.dev.id.version */
#define S3C2410TSVERSION 0x0101

#define WAIT4INT(x)  (((x)<<8) | S3C2410_ADCTSC_YM_SEN | S3C2410_ADCTSC_YP_SEN | S3C2410_ADCTSC_XP_SEN | S3C2410_ADCTSC_XY_PST(3))
#define AUTOPST (S3C2410_ADCTSC_YM_SEN | S3C2410_ADCTSC_YP_SEN | S3C2410_ADCTSC_XP_SEN | S3C2410_ADCTSC_AUTO_PST | S3C2410_ADCTSC_XY_PST(0))

//added by Yaopf, for debug
#define CONFIG_TOUCHSCREEN_S3C2410_DEBUG
//add end;

//#define DEBUG_LVL KERN_DEBUG
#define DEBUG_LVL KERN_ALERT

MODULE_AUTHOR("Arnaud Patard ");
MODULE_DESCRIPTION("s3c2410 touchscreen driver");
MODULE_LICENSE("GPL");

/*
* Definitions & global arrays.
*/

static char *s3c2410ts_name = "s3c2410 TouchScreen";

/*
* Per-touchscreen data.
*/

struct s3c2410ts {
        struct input_dev dev;
        long xp;
        long yp;
        int count;
        int shift;
        char phys[32];
};

static struct s3c2410ts ts;
static void __iomem *base_addr;

static inline void s3c2410_ts_connect(void)
{
        s3c2410_gpio_cfgpin(S3C2410_GPG12, S3C2410_GPG12_XMON);
        s3c2410_gpio_cfgpin(S3C2410_GPG13, S3C2410_GPG13_nXPON);
        s3c2410_gpio_cfgpin(S3C2410_GPG14, S3C2410_GPG14_YMON);
        s3c2410_gpio_cfgpin(S3C2410_GPG15, S3C2410_GPG15_nYPON);
}

static void touch_timer_fire(unsigned long data)
{
        unsigned long data0;
        unsigned long data1;
        int updown;
        data0 = readl(base_addr+S3C2410_ADCDAT0);
        data1 = readl(base_addr+S3C2410_ADCDAT1);

        updown = (!(data0 & S3C2410_ADCDAT0_UPDOWN)) && (!(data1 & S3C2410_ADCDAT1_UPDOWN));

        if (updown) {
                if (ts.count != 0) {
                ts.xp >>= ts.shift;
                ts.yp >>= ts.shift;

#ifdef CONFIG_TOUCHSCREEN_S3C2410_DEBUG

                {

                struct timeval tv;
                do_gettimeofday(&tv);
                printk(DEBUG_LVL "T: %06d, X: %03ld, Y: %03ld\n", (int)tv.tv_usec, ts.xp, ts.yp);
                }

#endif

                input_report_abs(&ts.dev, ABS_X, ts.xp);
                input_report_abs(&ts.dev, ABS_Y, ts.yp);

                input_report_key(&ts.dev, BTN_TOUCH, 1);
                input_report_abs(&ts.dev, ABS_PRESSURE, 1);
                input_sync(&ts.dev);
                }

                ts.xp = 0;
                ts.yp = 0;
                ts.count = 0;
       
                writel((S3C2410_ADCTSC_PULL_UP_DISABLE | AUTOPST), base_addr+S3C2410_ADCTSC);
                writel(readl(base_addr+S3C2410_ADCCON) | S3C2410_ADCCON_ENABLE_START, base_addr+S3C2410_ADCCON);
        }
        else {
                ts.count = 0;

                input_report_key(&ts.dev, BTN_TOUCH, 0);
                input_report_abs(&ts.dev, ABS_PRESSURE, 0);
                input_sync(&ts.dev);

                writel(WAIT4INT(0),base_addr+S3C2410_ADCTSC);
        }
}

static struct timer_list touch_timer = TIMER_INITIALIZER(touch_timer_fire, 0, 0);

static irqreturn_t stylus_updown(int irq, void *dev_id, struct pt_regs *regs)
{
        unsigned long data0;
        unsigned long data1;
        int updown;

        data0 = readl(base_addr+S3C2410_ADCDAT0);
        data1 = readl(base_addr+S3C2410_ADCDAT1);

        updown = (!(data0 & S3C2410_ADCDAT0_UPDOWN)) && (!(data1 & S3C2410_ADCDAT1_UPDOWN));

/* TODO we should never get an interrupt with updown set while
* the timer is running, but maybe we ought to verify that the
* timer isn't running anyways. */

        if (updown)
                touch_timer_fire(0);
        return IRQ_HANDLED;
}

static irqreturn_t stylus_action(int irq, void *dev_id, struct pt_regs *regs)
{
        unsigned long data0;
        unsigned long data1;

        data0 = readl(base_addr+S3C2410_ADCDAT0);
        data1 = readl(base_addr+S3C2410_ADCDAT1);

        ts.xp += data0 & S3C2410_ADCDAT0_XPDATA_MASK;
        ts.yp += data1 & S3C2410_ADCDAT1_YPDATA_MASK;
        ts.count++ ;
        if (ts.count < (1<<ts.shift))
        {
                writel(S3C2410_ADCTSC_PULL_UP_DISABLE | AUTOPST, base_addr+S3C2410_ADCTSC);
                writel(readl(base_addr+S3C2410_ADCCON) | S3C2410_ADCCON_ENABLE_START, base_addr+S3C2410_ADCCON);
        }         
        else
        {
                mod_timer(&touch_timer, jiffies+1);
                writel(WAIT4INT(1), base_addr+S3C2410_ADCTSC);
        }

        return IRQ_HANDLED;
}

static struct clk *adc_clock;

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

static int __init s3c2410ts_probe(struct device *dev)
{
        struct s3c2410_ts_mach_info *info;

        info = ( struct s3c2410_ts_mach_info *)dev->platform_data;

        if (!info)
        {
                printk(KERN_ERR "Hm... too bad : no platform data for ts\n");
                return -EINVAL;
        }

#ifdef CONFIG_TOUCHSCREEN_S3C2410_DEBUG
        printk(DEBUG_LVL "Entering s3c2410ts_init\n");
#endif

        adc_clock = clk_get(NULL, "adc");
        if (!adc_clock)
        {
                printk(KERN_ERR "failed to get adc clock source\n");
                return -ENOENT;
        }
        clk_use(adc_clock);
        clk_enable(adc_clock);

#ifdef CONFIG_TOUCHSCREEN_S3C2410_DEBUG
        printk(DEBUG_LVL "got and enabled clock\n");
#endif

        base_addr=ioremap(S3C2410_PA_ADC,0x20);

        if (base_addr == NULL)
        {
                printk(KERN_ERR "Failed to remap register block\n");
                return -ENOMEM;
        }

/* Configure GPIOs */

        s3c2410_ts_connect();

        if ((info->presc&0xff) > 0)
                writel(S3C2410_ADCCON_PRSCEN | S3C2410_ADCCON_PRSCVL(info->presc&0xFF),base_addr+S3C2410_ADCCON);
        else
                writel(0,base_addr+S3C2410_ADCCON);

/* Initialise registers */

        if ((info->delay&0xffff) > 0)
        writel(info->delay & 0xffff, base_addr+S3C2410_ADCDLY);
        writel(WAIT4INT(0), base_addr+S3C2410_ADCTSC);

/* Initialise input stuff */

        memset(&ts, 0, sizeof(struct s3c2410ts));
        init_input_dev(&ts.dev);
        ts.dev.evbit[0] = ts.dev.evbit[0] = BIT(EV_SYN) | BIT(EV_KEY) | BIT(EV_ABS);
        ts.dev.keybit[LONG(BTN_TOUCH)] = BIT(BTN_TOUCH);
        input_set_abs_params(&ts.dev, ABS_X, 0, 0x3FF, 0, 0);
        input_set_abs_params(&ts.dev, ABS_Y, 0, 0x3FF, 0, 0);
        input_set_abs_params(&ts.dev, ABS_PRESSURE, 0, 1, 0, 0);

        sprintf(ts.phys, "ts0");

        ts.dev.private = &ts;
        ts.dev.name = s3c2410ts_name;
        ts.dev.phys = ts.phys;
        ts.dev.id.bustype = BUS_RS232;
        ts.dev.id.vendor = 0xDEAD;
        ts.dev.id.product = 0xBEEF;
        ts.dev.id.version = S3C2410TSVERSION;
        ts.shift = info->oversampling_shift;

/* Get irqs */

        if (request_irq(IRQ_ADC, stylus_action, SA_SAMPLE_RANDOM,"s3c2410_action", &ts.dev))
        {
                printk(KERN_ERR "s3c2410_ts.c: Could not allocate ts IRQ_ADC !\n");
                iounmap(base_addr);
                return -EIO;
        }

        if (request_irq(IRQ_TC, stylus_updown, SA_SAMPLE_RANDOM,"s3c2410_updown", &ts.dev))
        {
                printk(KERN_ERR "s3c2410_ts.c: Could not allocate ts IRQ_TC !\n");
                iounmap(base_addr);
                return -EIO;
        }

        printk(KERN_INFO "%s successfully loaded\n", s3c2410ts_name);

/* All went ok, so register to the input system */
        input_register_device(&ts.dev);

        return 0;
}

static int s3c2410ts_remove(struct device *dev)
{
        disable_irq(IRQ_ADC);
        disable_irq(IRQ_TC);
        free_irq(IRQ_TC,&ts.dev);
        free_irq(IRQ_ADC,&ts.dev);

        if (adc_clock)
        {
                clk_disable(adc_clock);
                clk_unuse(adc_clock);
                clk_put(adc_clock);
                adc_clock = NULL;
        }

        input_unregister_device(&ts.dev);
        iounmap(base_addr);

        return 0;
}

static struct device_driver s3c2410ts_driver = {
          .name = "s3c2410-ts",
          .bus = &platform_bus_type,
          .probe = s3c2410ts_probe,
          .remove = s3c2410ts_remove
};

int __init s3c2410ts_init(void)
{
        return driver_register(&s3c2410ts_driver);
}

void __exit s3c2410ts_exit(void)
{
        driver_unregister(&s3c2410ts_driver);
}

module_init(s3c2410ts_init);
module_exit(s3c2410ts_exit);

[ 本帖最后由 dreamice 于 2008-12-29 16:41 编辑 ]

Answer 1

不懂，帮顶

Answer 2

应该是应用程序的问题.