1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33#include <linux/module.h>
34#include <linux/types.h>
35#include <linux/kernel.h>
36#include <linux/miscdevice.h>
37#include <linux/init.h>
38#include <linux/ioport.h>
39#include <asm/uaccess.h>
40#include <asm/addrspace.h>
41#include <asm/it8172/it8172_int.h>
42#include <linux/sched.h>
43#include <linux/ite_gpio.h>
44
45#define ite_gpio_base 0x14013800
46
47#define ITE_GPADR (*(volatile __u8 *)(0x14013800 + KSEG1))
48#define ITE_GPBDR (*(volatile __u8 *)(0x14013808 + KSEG1))
49#define ITE_GPCDR (*(volatile __u8 *)(0x14013810 + KSEG1))
50#define ITE_GPACR (*(volatile __u16 *)(0x14013802 + KSEG1))
51#define ITE_GPBCR (*(volatile __u16 *)(0x1401380a + KSEG1))
52#define ITE_GPCCR (*(volatile __u16 *)(0x14013812 + KSEG1))
53#define ITE_GPAICR (*(volatile __u16 *)(0x14013804 + KSEG1))
54#define ITE_GPBICR (*(volatile __u16 *)(0x1401380c + KSEG1))
55#define ITE_GPCICR (*(volatile __u16 *)(0x14013814 + KSEG1))
56#define ITE_GPAISR (*(volatile __u8 *)(0x14013806 + KSEG1))
57#define ITE_GPBISR (*(volatile __u8 *)(0x1401380e + KSEG1))
58#define ITE_GPCISR (*(volatile __u8 *)(0x14013816 + KSEG1))
59#define ITE_GCR (*(volatile __u8 *)(0x14013818 + KSEG1))
60
61#define MAX_GPIO_LINE 21
62static int ite_gpio_irq=IT8172_GPIO_IRQ;
63
64static long ite_irq_counter[MAX_GPIO_LINE];
65wait_queue_head_t ite_gpio_wait[MAX_GPIO_LINE];
66static int ite_gpio_irq_pending[MAX_GPIO_LINE];
67
68static int ite_gpio_debug=0;
69#define DEB(x) if (ite_gpio_debug>=1) x
70
71int ite_gpio_in(__u32 device, __u32 mask, volatile __u32 *data)
72{
73 DEB(printk("ite_gpio_in mask=0x%x\n",mask));
74
75 switch (device) {
76 case ITE_GPIO_PORTA:
77 ITE_GPACR = (__u16)mask;
78 *data = ITE_GPADR;
79 break;
80 case ITE_GPIO_PORTB:
81 ITE_GPBCR = (__u16)mask;
82 *data = ITE_GPBDR;
83 break;
84 case ITE_GPIO_PORTC:
85 ITE_GPCCR = (__u16)mask;
86 *data = ITE_GPCDR;
87 break;
88 default:
89 return -EFAULT;
90 }
91
92 return 0;
93}
94
95
96int ite_gpio_out(__u32 device, __u32 mask, __u32 data)
97{
98 switch (device) {
99 case ITE_GPIO_PORTA:
100 ITE_GPACR = (__u16)mask;
101 ITE_GPADR = (__u8)data;
102 break;
103 case ITE_GPIO_PORTB:
104 ITE_GPBCR = (__u16)mask;
105 ITE_GPBDR = (__u8)data;
106 break;
107 case ITE_GPIO_PORTC:
108 ITE_GPCCR = (__u16)mask;
109 ITE_GPCDR = (__u8)data;
110 break;
111 default:
112 return -EFAULT;
113 }
114
115 return 0;
116}
117
118int ite_gpio_int_ctrl(__u32 device, __u32 mask, __u32 data)
119{
120 switch (device) {
121 case ITE_GPIO_PORTA:
122 ITE_GPAICR = (ITE_GPAICR & ~mask) | (data & mask);
123 break;
124 case ITE_GPIO_PORTB:
125 ITE_GPBICR = (ITE_GPBICR & ~mask) | (data & mask);
126 break;
127 case ITE_GPIO_PORTC:
128 ITE_GPCICR = (ITE_GPCICR & ~mask) | (data & mask);
129 break;
130 default:
131 return -EFAULT;
132 }
133
134 return 0;
135}
136
137int ite_gpio_in_status(__u32 device, __u32 mask, volatile __u32 *data)
138{
139 int ret=-1;
140
141 if (MAX_GPIO_LINE > *data >= 0)
142 ret=ite_gpio_irq_pending[*data];
143
144 DEB(printk("ite_gpio_in_status %d ret=%d\n",*data, ret));
145
146 switch (device) {
147 case ITE_GPIO_PORTA:
148 *data = ITE_GPAISR & mask;
149 break;
150 case ITE_GPIO_PORTB:
151 *data = ITE_GPBISR & mask;
152 break;
153 case ITE_GPIO_PORTC:
154 *data = ITE_GPCISR & mask;
155 break;
156 default:
157 return -EFAULT;
158 }
159
160 return ret;
161}
162
163int ite_gpio_out_status(__u32 device, __u32 mask, __u32 data)
164{
165 switch (device) {
166 case ITE_GPIO_PORTA:
167 ITE_GPAISR = (ITE_GPAISR & ~mask) | (data & mask);
168 break;
169 case ITE_GPIO_PORTB:
170 ITE_GPBISR = (ITE_GPBISR & ~mask) | (data & mask);
171 break;
172 case ITE_GPIO_PORTC:
173 ITE_GPCISR = (ITE_GPCISR & ~mask) | (data & mask);
174 break;
175 default:
176 return -EFAULT;
177 }
178
179 return 0;
180}
181
182int ite_gpio_gen_ctrl(__u32 device, __u32 mask, __u32 data)
183{
184 ITE_GCR = (ITE_GCR & ~mask) | (data & mask);
185
186 return 0;
187}
188
189int ite_gpio_int_wait (__u32 device, __u32 mask, __u32 data)
190{
191 int i,line=0, ret=0;
192 unsigned long flags;
193
194 switch (device) {
195 case ITE_GPIO_PORTA:
196 line = data & mask;
197 break;
198 case ITE_GPIO_PORTB:
199 line = (data & mask) <<8;
200 break;
201 case ITE_GPIO_PORTC:
202 line = (data & mask) <<16;
203 break;
204 }
205 for (i=MAX_GPIO_LINE-1; i >= 0; i--) {
206 if ( (line) & (1 << i))
207 break;
208 }
209
210 DEB(printk("wait device=0x%d mask=0x%x data=0x%x index %d\n",
211 device, mask, data, i));
212
213 if (line & ~(1<<i))
214 return -EFAULT;
215
216 if (ite_gpio_irq_pending[i]==1)
217 return -EFAULT;
218
219 save_flags (flags);
220 cli();
221 ite_gpio_irq_pending[i] = 1;
222 ret = interruptible_sleep_on_timeout(&ite_gpio_wait[i], 3*HZ);
223 restore_flags (flags);
224 ite_gpio_irq_pending[i] = 0;
225
226 return ret;
227}
228
229EXPORT_SYMBOL(ite_gpio_in);
230EXPORT_SYMBOL(ite_gpio_out);
231EXPORT_SYMBOL(ite_gpio_int_ctrl);
232EXPORT_SYMBOL(ite_gpio_in_status);
233EXPORT_SYMBOL(ite_gpio_out_status);
234EXPORT_SYMBOL(ite_gpio_gen_ctrl);
235EXPORT_SYMBOL(ite_gpio_int_wait);
236
237static int ite_gpio_open(struct inode *inode, struct file *file)
238{
239#ifdef MODULE
240 MOD_INC_USE_COUNT;
241#endif
242
243 return 0;
244}
245
246
247static int ite_gpio_release(struct inode *inode, struct file *file)
248{
249#ifdef MODULE
250 MOD_DEC_USE_COUNT;
251#endif
252
253 return 0;
254}
255
256
257static int ite_gpio_ioctl(struct inode *inode, struct file *file,
258 unsigned int cmd, unsigned long arg)
259{
260 static struct ite_gpio_ioctl_data ioctl_data;
261
262 if (copy_from_user(&ioctl_data, (struct ite_gpio_ioctl_data *)arg,
263 sizeof(ioctl_data)))
264 return -EFAULT;
265 if ((ioctl_data.device < ITE_GPIO_PORTA) ||
266 (ioctl_data.device > ITE_GPIO_PORTC) )
267 return -EFAULT;
268
269 switch(cmd) {
270 case ITE_GPIO_IN:
271 if (ite_gpio_in(ioctl_data.device, ioctl_data.mask,
272 &ioctl_data.data))
273 return -EFAULT;
274
275 if (copy_to_user((struct ite_gpio_ioctl_data *)arg,
276 &ioctl_data, sizeof(ioctl_data)))
277 return -EFAULT;
278 break;
279
280 case ITE_GPIO_OUT:
281 return ite_gpio_out(ioctl_data.device,
282 ioctl_data.mask, ioctl_data.data);
283 break;
284
285 case ITE_GPIO_INT_CTRL:
286 return ite_gpio_int_ctrl(ioctl_data.device,
287 ioctl_data.mask, ioctl_data.data);
288 break;
289
290 case ITE_GPIO_IN_STATUS:
291 if (ite_gpio_in_status(ioctl_data.device, ioctl_data.mask,
292 &ioctl_data.data))
293 return -EFAULT;
294 if (copy_to_user((struct ite_gpio_ioctl_data *)arg,
295 &ioctl_data, sizeof(ioctl_data)))
296 return -EFAULT;
297 break;
298
299 case ITE_GPIO_OUT_STATUS:
300 return ite_gpio_out_status(ioctl_data.device,
301 ioctl_data.mask, ioctl_data.data);
302 break;
303
304 case ITE_GPIO_GEN_CTRL:
305 return ite_gpio_gen_ctrl(ioctl_data.device,
306 ioctl_data.mask, ioctl_data.data);
307 break;
308
309 case ITE_GPIO_INT_WAIT:
310 return ite_gpio_int_wait(ioctl_data.device,
311 ioctl_data.mask, ioctl_data.data);
312 break;
313
314 default:
315 return -ENOIOCTLCMD;
316
317 }
318 return 0;
319}
320
321static void ite_gpio_irq_handler(int this_irq, void *dev_id,
322 struct pt_regs *regs)
323{
324 int i,line;
325
326 line = ITE_GPCISR & 0x1f;
327 for (i=4; i >=0; i--) {
328 if ( line & (1 << i)) {
329 ++ite_irq_counter[i+16];
330 ite_gpio_irq_pending[i+16] = 2;
331 wake_up_interruptible(&ite_gpio_wait[i+16]);
332
333DEB(printk("interrupt 0x%x %d\n", &ite_gpio_wait[i+16], i+16));
334
335 ITE_GPCISR = ITE_GPCISR & (1<<i);
336 return;
337 }
338 }
339 line = ITE_GPBISR;
340 for (i=7; i >= 0; i--) {
341 if ( line & (1 << i)) {
342 ++ite_irq_counter[i+8];
343 ite_gpio_irq_pending[i+8] = 2;
344 wake_up_interruptible(&ite_gpio_wait[i+8]);
345
346DEB(printk("interrupt 0x%x %d\n",ITE_GPBISR, i+8));
347
348 ITE_GPBISR = ITE_GPBISR & (1<<i);
349 return;
350 }
351 }
352 line = ITE_GPAISR;
353 for (i=7; i >= 0; i--) {
354 if ( line & (1 << i)) {
355 ++ite_irq_counter[i];
356 ite_gpio_irq_pending[i] = 2;
357 wake_up_interruptible(&ite_gpio_wait[i]);
358
359DEB(printk("interrupt 0x%x %d\n",ITE_GPAISR, i));
360
361 ITE_GPAISR = ITE_GPAISR & (1<<i);
362 return;
363 }
364 }
365}
366
367static struct file_operations ite_gpio_fops = {
368 owner: THIS_MODULE,
369 ioctl: ite_gpio_ioctl,
370 open: ite_gpio_open,
371 release: ite_gpio_release,
372};
373
374static struct miscdevice ite_gpio_miscdev = {
375 MISC_DYNAMIC_MINOR,
376 "ite_gpio",
377 &ite_gpio_fops
378};
379
380static int __init ite_gpio_init(void)
381{
382 int i;
383
384 misc_register(&ite_gpio_miscdev);
385
386 if (check_region(ite_gpio_base, 0x1c) < 0 ) {
387 return -ENODEV;
388 } else {
389 request_region(ite_gpio_base, 0x1c, "ITE GPIO");
390 }
391
392
393 ITE_GPACR = 0xffff;
394 ITE_GPBCR = 0xffff;
395 ITE_GPCCR = 0xffff;
396 ITE_GPAICR = 0x00ff;
397 ITE_GPBICR = 0x00ff;
398 ITE_GPCICR = 0x00ff;
399 ITE_GCR = 0;
400
401 for (i = 0; i < MAX_GPIO_LINE; i++) {
402 ite_gpio_irq_pending[i]=0;
403 init_waitqueue_head(&ite_gpio_wait[i]);
404 }
405 if (request_irq(ite_gpio_irq, ite_gpio_irq_handler, SA_SHIRQ, "gpio", 0) < 0)
406 return 0;
407 printk("GPIO at 0x%x (irq = %d)\n", ite_gpio_base, ite_gpio_irq);
408
409 return 0;
410}
411
412static void __exit ite_gpio_exit(void)
413{
414 misc_deregister(&ite_gpio_miscdev);
415}
416
417module_init(ite_gpio_init);
418module_exit(ite_gpio_exit);
419
420MODULE_LICENSE("GPL");
421
