Gitiles
Code Review Sign In
review.evervolv.com / android_kernel_htc_msm8960 / e868d61272caa648214046a096e5a6bfc068dc8c / . / arch / sh / boards / landisk / gio.c
blob: a37643d002b2bb09c8ee51a42d82fd6078d5209c [file] [log] [blame]
kogiidena00e8c492007-03-19 16:24:12 +0900[diff] [blame]1/*
2 * arch/sh/boards/landisk/gio.c - driver for landisk
3 *
4 * This driver will also support the I-O DATA Device, Inc. LANDISK Board.
5 * LANDISK and USL-5P Button, LED and GIO driver drive function.
6 *
7 * Copylight (C) 2006 kogiidena
8 * Copylight (C) 2002 Atom Create Engineering Co., Ltd. *
9 *
10 * This file is subject to the terms and conditions of the GNU General Public
11 * License. See the file "COPYING" in the main directory of this archive
12 * for more details.
13 *
14 */
15#include <linux/module.h>
16#include <linux/init.h>
17#include <linux/kdev_t.h>
18#include <linux/cdev.h>
19#include <linux/fs.h>
20#include <asm/io.h>
21#include <asm/uaccess.h>
22#include <asm/landisk/gio.h>
23#include <asm/landisk/iodata_landisk.h>
24
25#define DEVCOUNT 4
26#define GIO_MINOR 2 /* GIO minor no. */
27
28static dev_t dev;
29static struct cdev *cdev_p;
30static int openCnt;
31
32static int gio_open(struct inode *inode, struct file *filp)
33{
34 int minor;
35
36 minor = MINOR(inode->i_rdev);
37 if (minor < DEVCOUNT) {
38 if (openCnt > 0) {
39 return -EALREADY;
40 } else {
41 openCnt++;
42 return 0;
43 }
44 }
45 return -ENOENT;
46}
47
48static int gio_close(struct inode *inode, struct file *filp)
49{
50 int minor;
51
52 minor = MINOR(inode->i_rdev);
53 if (minor < DEVCOUNT) {
54 openCnt--;
55 }
56 return 0;
57}
58
59static int gio_ioctl(struct inode *inode, struct file *filp,
60 unsigned int cmd, unsigned long arg)
61{
62 unsigned int data;
63 static unsigned int addr = 0;
64
65 if (cmd & 0x01) { /* write */
66 if (copy_from_user(&data, (int *)arg, sizeof(int))) {
67 return -EFAULT;
68 }
69 }
70
71 switch (cmd) {
Simon Arlotte868d612007-05-14 08:15:10 +0900[diff] [blame^]72 case GIODRV_IOCSGIOSETADDR: /* address set */
kogiidena00e8c492007-03-19 16:24:12 +0900[diff] [blame]73 addr = data;
74 break;
75
76 case GIODRV_IOCSGIODATA1: /* write byte */
77 ctrl_outb((unsigned char)(0x0ff & data), addr);
78 break;
79
80 case GIODRV_IOCSGIODATA2: /* write word */
81 if (addr & 0x01) {
82 return -EFAULT;
83 }
84 ctrl_outw((unsigned short int)(0x0ffff & data), addr);
85 break;
86
87 case GIODRV_IOCSGIODATA4: /* write long */
88 if (addr & 0x03) {
89 return -EFAULT;
90 }
91 ctrl_outl(data, addr);
92 break;
93
94 case GIODRV_IOCGGIODATA1: /* read byte */
95 data = ctrl_inb(addr);
96 break;
97
98 case GIODRV_IOCGGIODATA2: /* read word */
99 if (addr & 0x01) {
100 return -EFAULT;
101 }
102 data = ctrl_inw(addr);
103 break;
104
105 case GIODRV_IOCGGIODATA4: /* read long */
106 if (addr & 0x03) {
107 return -EFAULT;
108 }
109 data = ctrl_inl(addr);
110 break;
111 default:
112 return -EFAULT;
113 break;
114 }
115
116 if ((cmd & 0x01) == 0) { /* read */
117 if (copy_to_user((int *)arg, &data, sizeof(int))) {
118 return -EFAULT;
119 }
120 }
121 return 0;
122}
123
124static struct file_operations gio_fops = {
125 .owner = THIS_MODULE,
126 .open = gio_open, /* open */
127 .release = gio_close, /* release */
128 .ioctl = gio_ioctl, /* ioctl */
129};
130
131static int __init gio_init(void)
132{
133 int error;
134
135 printk(KERN_INFO "gio: driver initialized\n");
136
137 openCnt = 0;
138
139 if ((error = alloc_chrdev_region(&dev, 0, DEVCOUNT, "gio")) < 0) {
140 printk(KERN_ERR
141 "gio: Couldn't alloc_chrdev_region, error=%d\n",
142 error);
143 return 1;
144 }
145
146 cdev_p = cdev_alloc();
147 cdev_p->ops = &gio_fops;
148 error = cdev_add(cdev_p, dev, DEVCOUNT);
149 if (error) {
150 printk(KERN_ERR
151 "gio: Couldn't cdev_add, error=%d\n", error);
152 return 1;
153 }
154
155 return 0;
156}
157
158static void __exit gio_exit(void)
159{
160 cdev_del(cdev_p);
161 unregister_chrdev_region(dev, DEVCOUNT);
162}
163
164module_init(gio_init);
165module_exit(gio_exit);
166
167MODULE_LICENSE("GPL");