S3C2440按键驱动

szkyd

S3C2440按键驱动 [复制链接]

1. #include
   
2. #include
   
3. #include
   
4. #include
   
5. #include
   
6. #include
   
7. #include
   
8. #include
   
9. #include
   
10. #include
    
11. //#include
    
12. #include
    
13. #include
    
14. #include
    
15. 
    
16. #define KEYNUM 5
    
17. #define KEY_UP 0
    
18. #define KEY_DOWN 1
    
19. #define KEY_DOWNX 2
    
20. #define MAJOR 255
    
21. #define KEY_TIMER_DELAY (HZ/50)
    
22. #define GPIOG_REG_ADDR 0x56000064//gpio_g data register phys address
    
23. 
    
24. struct b_dev
    
25. {
    
26.   struct cdev b_cdev;
    
27.   char key_state_buf[KEYNUM];//up or down
    
28.   unsigned int irq[KEYNUM];
    
29.   struct timer_list tl;
    
30. };
    
31. 
    
32. struct b_dev *pb_dev;
    
33. int b_open(struct inode * inodep,struct file * filp)
    
34. {
    
35.   return 0;
    
36. }
    
37. int b_release(struct inode * inodep,struct file * filp)
    
38. {
    
39.   return 0;
    
40. }
    
41. int b_read(struct file * filp,char * buf,size_t size,loff_t offset)
    
42. {
    
43.   if(!access_ok(VERIFY_WRITE,buf,size))
    
44.   {
    
45.     printk(KERN_INFO "buf can't write\n");
    
46.     return -EFAULT;
    
47.   }
    
48.   int key_num,count=0;
    
49.   for(key_num=0;key_num!=KEYNUM;key_num++)
    
50.   {
    
51.     if(pb_dev->key_state_buf[key_num]==KEY_DOWNX && count
52.     {
    
53.       put_user('0'+key_num,buf+count);
    
54.       pb_dev->key_state_buf[key_num]=KEY_UP;
    
55.       count++;
    
56.     }
    
57.   }
    
58.   return count;
    
59. }
    
60. struct file_operations f_ops=
    
61. {
    
62.   .open=b_open,
    
63.   .read=b_read,
    
64.   .release=b_release,
    
65.   .owner=THIS_MODULE,
    
66. };
    
67. 
    
68. void timer_handler(unsigned long sleep_time)
    
69. {
    
70.   unsigned int *p_gpiog=__va(GPIOG_REG_ADDR);//phys address to virtual address
    
71.   unsigned int gpio_g=*p_gpiog;
    
72.   if(gpio_g & 0x0001  && pb_dev->key_state_buf[0] == KEY_DOWN){
    
73.     //button 1
    
74.     pb_dev->key_state_buf[0]=KEY_DOWNX;
    
75.   }
    
76.   else if(gpio_g & 0x0008 && pb_dev->key_state_buf[1] == KEY_DOWN){
    
77.     //button 2
    
78.     pb_dev->key_state_buf[1]=KEY_DOWNX;
    
79.   }
    
80.   else if(gpio_g & 0x0020 && pb_dev->key_state_buf[2] == KEY_DOWN){
    
81.     //button 3
    
82.     pb_dev->key_state_buf[2]=KEY_DOWNX;
    
83.   }
    
84.   else if(gpio_g & 0x0040 && pb_dev->key_state_buf[3] == KEY_DOWN){
    
85.     //button 4
    
86.     pb_dev->key_state_buf[3]=KEY_DOWNX;
    
87.   }
    
88.   else if(gpio_g & 0x0080 && pb_dev->key_state_buf[4] == KEY_DOWN){
    
89.     //button 5
    
90.     pb_dev->key_state_buf[4]=KEY_DOWNX;
    
91.   }
    
92.   else if(gpio_g & 0x0800 && pb_dev->key_state_buf[5] == KEY_DOWN){
    
93.     //button 6
    
94.     pb_dev->key_state_buf[5]=KEY_DOWNX;
    
95.   }
    
96.   printk(KERN_INFO "timer\n");
    
97. }
    
98. void irq_handler(int irq,void *dev_id,struct pt_regs *regs)
    
99. {
    
100.   pb_dev->tl.expires=jiffies+KEY_TIMER_DELAY;
     
101.   add_timer(&pb_dev->tl);
     
102.   switch(irq)
     
103.   {
     
104.     case 16+36:
     
105.       pb_dev->key_state_buf[0]=KEY_DOWN;
     
106.       break;
     
107.     case 16+39:
     
108.       pb_dev->key_state_buf[1]=KEY_DOWN;
     
109.       break;
     
110.     case 16+41:
     
111.       pb_dev->key_state_buf[2]=KEY_DOWN;
     
112.       break;
     
113.     case 16+42:
     
114.       pb_dev->key_state_buf[3]=KEY_DOWN;
     
115.       break;
     
116.     case 16+43:
     
117.       pb_dev->key_state_buf[4]=KEY_DOWN;
     
118.       break;
     
119.     case 16+47:
     
120.       pb_dev->key_state_buf[5]=KEY_DOWN;
     
121.       break;
     
122.     default:
     
123.       break;
     
124.   }
     
125.   printk(KERN_INFO "IRQ\n");
     
126. }
     
127. 
     
128. void init_irqs()
     
129. {
     
130.   pb_dev->irq[0]=16+36;
     
131.   pb_dev->irq[1]=16+39;
     
132.   pb_dev->irq[2]=16+41;
     
133.   pb_dev->irq[3]=16+42;
     
134.   pb_dev->irq[4]=16+43;
     
135.   pb_dev->irq[5]=16+47;
     
136.   int key_num;
     
137.   for(key_num=0;key_num
138.   {
     
139.     request_irq(pb_dev->irq[key_num],irq_handler,SA_SHIRQ,"buttons",pb_dev);
     
140.     set_irq_type(pb_dev->irq[key_num],IRQ_TYPE_EDGE_FALLING);
     
141.   }
     
142. }
     
143. static int b_init(void)
     
144. {
     
145.   pb_dev=kmalloc(sizeof(struct b_dev),GFP_KERNEL);
     
146.   memset(pb_dev,0,sizeof(struct b_dev));
     
147.   int key_num;
     
148.   for(key_num=0;key_num
149.   {
     
150.     pb_dev->key_state_buf[key_num]=KEY_UP;
     
151.   }
     
152.   dev_t devno;
     
153.   devno=MKDEV(MAJOR,0);
     
154.   cdev_init(&pb_dev->b_cdev,&f_ops);
     
155.   pb_dev->b_cdev.owner=THIS_MODULE;
     
156.   pb_dev->b_cdev.ops=&f_ops;
     
157.   int err=cdev_add(&pb_dev->b_cdev,devno,1);
     
158.   if(err)
     
159.     printk(KERN_NOTICE "Error %d\n",err);
     
160.   setup_timer(&pb_dev->tl,timer_handler,20);
     
161.   init_irqs();
     
162.   printk(KERN_INFO "init over\n");
     
163. }
     
164. 
     
165. static void b_exit(void)
     
166. {
     
167.   int key_num;
     
168.   for(key_num=0;key_num
169.   {
     
170.     free_irq(pb_dev->irq[key_num],pb_dev);
     
171.   }
     
172.   cdev_del(&pb_dev->b_cdev);
     
173.   kfree(pb_dev);
     
174.   unregister_chrdev_region(MKDEV(MAJOR,0),1);
     
175. }
     
176. 
     
177. MODULE_AUTHOR("scy");
     
178. MODULE_LICENSE("Dual BSD/GPL");
     
179. 
     
180. module_init(b_init);
     
181. module_exit(b_exit);
     

复制代码

当有按键时，系统就会报错
[root@FriendlyARM /]# IRQ
irq event 59: bogus return value 7
[] (dump_stack+0x0/0x14) from [] (__report_bad_irq+0x28/0x94
)
[] (__report_bad_irq+0x0/0x94) from [] (note_interrupt+0x174
/0x1f0)
r5:c03d5be0 r4:c03d5be0
[] (note_interrupt+0x0/0x1f0) from [] (handle_edge_irq+0xc0/
0x160)
[] (handle_edge_irq+0x0/0x160) from [] (s3c_irq_demux_extint
8+0x9c/0xa8)
r7:c03ff284 r6:00000001 r5:00000000 r4:0000003b
[] (s3c_irq_demux_extint8+0x0/0xa8) from [] (__exception_tex
t_start+0x44/0x70)
r7:c03ff284 r6:00000000 r5:c0425474 r4:00000015
[] (__exception_text_start+0x0/0x70) from [] (__irq_svc+0x24
/0xa0)
Exception stack(0xc03cdf40 to 0xc03cdf88)
df40: f4100000 00000032 f4100000 60000013 c0029edc c03cc000 c0029edc c03ff284
df60: 3001c920 41129200 3001c8ec c03cdf94 c03cdf98 c03cdf88 c002a4f8 c0029f3c
df80: 60000013 ffffffff
r7:c03ff284 r6:00000020 r5:f4000000 r4:ffffffff
[] (default_idle+0x0/0xac) from [] (cpu_idle+0x4c/0x68)
[] (cpu_idle+0x0/0x68) from [] (rest_init+0x5c/0x70)
r7:c03d0440 r6:c001e000 r5:c03ff240 r4:c0423264
[] (rest_init+0x0/0x70) from [] (start_kernel+0x200/0x268)
[] (start_kernel+0x0/0x268) from [<30008034>] (0x30008034)
r6:c001ed34 r5:c03ff35c r4:c0007175
handlers:
[] (irq_handler+0x0/0x130 [my_bdri])
Unable to handle kernel paging request at virtual address e6000064
pgd = c3acc000
[e6000064] *pgd=00000000
Internal error: Oops: 5 [#1]
Modules linked in: my_bdri
CPU: 0    Not tainted  (2.6.29.4-FriendlyARM #2)
PC is at timer_handler+0x10/0x118 [my_bdri]
LR is at run_timer_softirq+0x1b0/0x230
pc : []    lr : []    psr: 20000013
sp : c03cde80  ip : c03cde90  fp : c03cde8c
r10: c04211c8  r9 : c03d4140  r8 : c03cc000
r7 : bf0000bc  r6 : c03cdea0  r5 : 00000100  r4 : c04209c0
r3 : e6000000  r2 : c03cdea0  r1 : c3a612dc  r0 : 00000014
Flags: nzCv  IRQs on  FIQs on  Mode SVC_32  ISA ARM  Segment kernel
Control: c000717f  Table: 33acc000  DAC: 00000017
Process swapper (pid: 0, stack limit = 0xc03cc268)
Stack: (0xc03cde80 to 0xc03ce000)
de80: c03cded4 c03cde90 c0044c80 bf0000cc c03cdeb4 c04217c8 c04215c8 c04213c8
dea0: c03cdea0 c03cdea0 c03cdecc 00000004 00000001 00000100 c03cc000 c04207e0
dec0: 00000001 0000000a c03cdf0c c03cded8 c0040204 c0044ae0 c03d5514 c03d2c58
dee0: 0000001e 0000001e c0425474 00000000 c03ff284 3001c920 41129200 3001c8ec
df00: c03cdf1c c03cdf10 c00402cc c0040198 c03cdf3c c03cdf20 c0028048 c0040294
df20: ffffffff f4000000 00004000 c03ff284 c03cdf94 c03cdf40 c0028a44 c0028010
df40: f4100000 00000032 f4100000 60000013 c0029edc c03cc000 c0029edc c03ff284
df60: 3001c920 41129200 3001c8ec c03cdf94 c03cdf98 c03cdf88 c002a4f8 c0029f3c
df80: 60000013 ffffffff c03cdfb4 c03cdf98 c002a4f8 c0029eec c0423264 c03ff240
dfa0: c001e000 c03d0440 c03cdfc4 c03cdfb8 c02d2124 c002a4bc c03cdff4 c03cdfc8
dfc0: c0008930 c02d20d8 c0008470 00000000 00000000 c001ed38 00000000 c0007175
dfe0: c03ff35c c001ed34 00000000 c03cdff8 30008034 c0008740 00000000 00000000
Backtrace:
[] (timer_handler+0x0/0x118 [my_bdri]) from [] (run_timer_so
ftirq+0x1b0/0x230)
[] (run_timer_softirq+0x0/0x230) from [] (__do_softirq+0x7c/
0xfc)
[] (__do_softirq+0x0/0xfc) from [] (irq_exit+0x48/0x50)
[] (irq_exit+0x0/0x50) from [] (__exception_text_start+0x48/
0x70)
[] (__exception_text_start+0x0/0x70) from [] (__irq_svc+0x24
/0xa0)
Exception stack(0xc03cdf40 to 0xc03cdf88)
df40: f4100000 00000032 f4100000 60000013 c0029edc c03cc000 c0029edc c03ff284
df60: 3001c920 41129200 3001c8ec c03cdf94 c03cdf98 c03cdf88 c002a4f8 c0029f3c
df80: 60000013 ffffffff
r7:c03ff284 r6:00004000 r5:f4000000 r4:ffffffff
[] (default_idle+0x0/0xac) from [] (cpu_idle+0x4c/0x68)
[] (cpu_idle+0x0/0x68) from [] (rest_init+0x5c/0x70)
r7:c03d0440 r6:c001e000 r5:c03ff240 r4:c0423264
[] (rest_init+0x0/0x70) from [] (start_kernel+0x200/0x268)
[] (start_kernel+0x0/0x268) from [<30008034>] (0x30008034)
r6:c001ed34 r5:c03ff35c r4:c0007175
Code: e1a0c00d e92dd800 e24cb004 e3a034e6 (e5931064)
Kernel panic - not syncing: Fatal exception in interrupt
==================================================================================
求高手帮助解决。。

usbabc

oops,使用了非法的地址

mooddog

典型的非法指针错误