Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 #include <linux/input.h>
  2 #include <linux/module.h>
  3 #include <linux/init.h>
  4 #include <linux/interrupt.h>
  5 #include <asm/io.h>
  6 #include <asm/delay.h>
  7 #include <asm/adc.h>
  8 #include <asm/hp6xx.h>
  9 
 10 #define MODNAME "hp680_ts_input"
 11 
 12 #define HP680_TS_ABS_X_MIN      40
 13 #define HP680_TS_ABS_X_MAX      950
 14 #define HP680_TS_ABS_Y_MIN      80
 15 #define HP680_TS_ABS_Y_MAX      910
 16 
 17 #define PHDR    0xa400012e
 18 #define SCPDR   0xa4000136
 19 
 20 static void do_softint(struct work_struct *work);
 21 
 22 static struct input_dev *hp680_ts_dev;
 23 static DECLARE_DELAYED_WORK(work, do_softint);
 24 
 25 static void do_softint(struct work_struct *work)
 26 {
 27         int absx = 0, absy = 0;
 28         u8 scpdr;
 29         int touched = 0;
 30 
 31         if (ctrl_inb(PHDR) & PHDR_TS_PEN_DOWN) {
 32                 scpdr = ctrl_inb(SCPDR);
 33                 scpdr |= SCPDR_TS_SCAN_ENABLE;
 34                 scpdr &= ~SCPDR_TS_SCAN_Y;
 35                 ctrl_outb(scpdr, SCPDR);
 36                 udelay(30);
 37 
 38                 absy = adc_single(ADC_CHANNEL_TS_Y);
 39 
 40                 scpdr = ctrl_inb(SCPDR);
 41                 scpdr |= SCPDR_TS_SCAN_Y;
 42                 scpdr &= ~SCPDR_TS_SCAN_X;
 43                 ctrl_outb(scpdr, SCPDR);
 44                 udelay(30);
 45 
 46                 absx = adc_single(ADC_CHANNEL_TS_X);
 47 
 48                 scpdr = ctrl_inb(SCPDR);
 49                 scpdr |= SCPDR_TS_SCAN_X;
 50                 scpdr &= ~SCPDR_TS_SCAN_ENABLE;
 51                 ctrl_outb(scpdr, SCPDR);
 52                 udelay(100);
 53                 touched = ctrl_inb(PHDR) & PHDR_TS_PEN_DOWN;
 54         }
 55 
 56         if (touched) {
 57                 input_report_key(hp680_ts_dev, BTN_TOUCH, 1);
 58                 input_report_abs(hp680_ts_dev, ABS_X, absx);
 59                 input_report_abs(hp680_ts_dev, ABS_Y, absy);
 60         } else {
 61                 input_report_key(hp680_ts_dev, BTN_TOUCH, 0);
 62         }
 63 
 64         input_sync(hp680_ts_dev);
 65         enable_irq(HP680_TS_IRQ);
 66 }
 67 
 68 static irqreturn_t hp680_ts_interrupt(int irq, void *dev)
 69 {
 70         disable_irq_nosync(irq);
 71         schedule_delayed_work(&work, HZ / 20);
 72 
 73         return IRQ_HANDLED;
 74 }
 75 
 76 static int __init hp680_ts_init(void)
 77 {
 78         int err;
 79 
 80         hp680_ts_dev = input_allocate_device();
 81         if (!hp680_ts_dev)
 82                 return -ENOMEM;
 83 
 84         hp680_ts_dev->evbit[0] = BIT_MASK(EV_ABS) | BIT_MASK(EV_KEY);
 85         hp680_ts_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
 86 
 87         input_set_abs_params(hp680_ts_dev, ABS_X,
 88                 HP680_TS_ABS_X_MIN, HP680_TS_ABS_X_MAX, 0, 0);
 89         input_set_abs_params(hp680_ts_dev, ABS_Y,
 90                 HP680_TS_ABS_Y_MIN, HP680_TS_ABS_Y_MAX, 0, 0);
 91 
 92         hp680_ts_dev->name = "HP Jornada touchscreen";
 93         hp680_ts_dev->phys = "hp680_ts/input0";
 94 
 95         if (request_irq(HP680_TS_IRQ, hp680_ts_interrupt,
 96                         IRQF_DISABLED, MODNAME, 0) < 0) {
 97                 printk(KERN_ERR "hp680_touchscreen.c: Can't allocate irq %d\n",
 98                        HP680_TS_IRQ);
 99                 err = -EBUSY;
100                 goto fail1;
101         }
102 
103         err = input_register_device(hp680_ts_dev);
104         if (err)
105                 goto fail2;
106 
107         return 0;
108 
109  fail2: free_irq(HP680_TS_IRQ, NULL);
110         cancel_delayed_work(&work);
111         flush_scheduled_work();
112  fail1: input_free_device(hp680_ts_dev);
113         return err;
114 }
115 
116 static void __exit hp680_ts_exit(void)
117 {
118         free_irq(HP680_TS_IRQ, NULL);
119         cancel_delayed_work(&work);
120         flush_scheduled_work();
121         input_unregister_device(hp680_ts_dev);
122 }
123 
124 module_init(hp680_ts_init);
125 module_exit(hp680_ts_exit);
126 
127 MODULE_AUTHOR("Andriy Skulysh, askulysh@image.kiev.ua");
128 MODULE_DESCRIPTION("HP Jornada 680 touchscreen driver");
129 MODULE_LICENSE("GPL");
130 
  This page was automatically generated by the LXR engine.