s3c2410触摸屏驱动

最近时间比较紧，因为板子的LCD驱动出了些问题，未能做完全测试，但保证按下触摸屏时会有调试信息输出，问题应该不大


下面是驱动代码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/ts.h>            // 自己添加
#include <asm/hardware/clock.h>
#include <asm/arch/regs-clock.h>

MODULE_AUTHOR("Arnaud Patard <[email protected]>");
MODULE_DESCRIPTION("s3c2410 touchscreen driver");
MODULE_LICENSE("GPL");

/* 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))

#define DEBUG_LVL    KERN_INFO

#ifdef CONFIG_TOUCHSCREEN_S3C2410_DEBUG
#define DBG(x...)       printk(KERN_INFO x)
#else
#define DBG(x...)       do { } while (0)
#endif

/*
* 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_ADCDAT0_UPDOWN));

    DBG(" data0 = %x, data1 = %x updown = %d %s : %s : line = %d/n", data0, data1, updown,
                __FUNCTION__, __FILE__, __LINE__);

    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_ADCDAT0_UPDOWN));

    DBG("/n data0 = %x, data1 = %x updown = %d %s : %s : line = %d/n", data0, data1, updown,
            __FUNCTION__, __FILE__, __LINE__);

/* 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
    {
        DBG(" data0 = %x, data1 = %x, %s : %s : line = %d/n", data0, data1, __FUNCTION__, __FILE__, __LINE__);
        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;
    }

    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] = 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");
        disable_irq(IRQ_ADC);
        free_irq(IRQ_ADC, &ts.dev);
        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);


然后是头文件ts.h

/* linux/include/asm/arch-s3c2410/ts.h
*
* Copyright (c) 2005 Arnaud Patard <[email protected]>
*
*
* 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.
*
*
* Changelog:
*     24-Mar-2005     RTP     Created file
*     03-Aug-2005     RTP     Renamed to ts.h
*/

#ifndef __ASM_ARM_TS_H
#define __ASM_ARM_TS_H

struct s3c2410_ts_mach_info {
       int             delay;
       int             presc;
       int             oversampling_shift;
};

void __init set_s3c2410ts_info(struct s3c2410_ts_mach_info *hard_s3c2410ts_info);

#endif /* __ASM_ARM_TS_H */

其他修改无非是在内核中添加配置选项，在平台初始化时加载驱动等，待会儿转贴一篇以作备忘