2 * arch/sh/boards/landisk/gio.c - driver for landisk
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.
7 * Copylight (C) 2006 kogiidena
8 * Copylight (C) 2002 Atom Create Engineering Co., Ltd. *
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
15 #include <linux/module.h>
16 #include <linux/init.h>
17 #include <linux/kdev_t.h>
18 #include <linux/cdev.h>
21 #include <asm/uaccess.h>
22 #include <mach-landisk/mach/gio.h>
23 #include <mach-landisk/mach/iodata_landisk.h>
26 #define GIO_MINOR 2 /* GIO minor no. */
29 static struct cdev *cdev_p;
32 static int gio_open(struct inode *inode, struct file *filp)
38 minor = MINOR(inode->i_rdev);
39 if (minor < DEVCOUNT) {
51 static int gio_close(struct inode *inode, struct file *filp)
55 minor = MINOR(inode->i_rdev);
56 if (minor < DEVCOUNT) {
62 static long gio_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
65 static unsigned int addr = 0;
67 if (cmd & 0x01) { /* write */
68 if (copy_from_user(&data, (int *)arg, sizeof(int))) {
74 case GIODRV_IOCSGIOSETADDR: /* address set */
78 case GIODRV_IOCSGIODATA1: /* write byte */
79 __raw_writeb((unsigned char)(0x0ff & data), addr);
82 case GIODRV_IOCSGIODATA2: /* write word */
86 __raw_writew((unsigned short int)(0x0ffff & data), addr);
89 case GIODRV_IOCSGIODATA4: /* write long */
93 __raw_writel(data, addr);
96 case GIODRV_IOCGGIODATA1: /* read byte */
97 data = __raw_readb(addr);
100 case GIODRV_IOCGGIODATA2: /* read word */
104 data = __raw_readw(addr);
107 case GIODRV_IOCGGIODATA4: /* read long */
111 data = __raw_readl(addr);
118 if ((cmd & 0x01) == 0) { /* read */
119 if (copy_to_user((int *)arg, &data, sizeof(int))) {
126 static const struct file_operations gio_fops = {
127 .owner = THIS_MODULE,
128 .open = gio_open, /* open */
129 .release = gio_close, /* release */
130 .unlocked_ioctl = gio_ioctl,
131 .llseek = noop_llseek,
134 static int __init gio_init(void)
138 printk(KERN_INFO "gio: driver initialized\n");
142 if ((error = alloc_chrdev_region(&dev, 0, DEVCOUNT, "gio")) < 0) {
144 "gio: Couldn't alloc_chrdev_region, error=%d\n",
149 cdev_p = cdev_alloc();
150 cdev_p->ops = &gio_fops;
151 error = cdev_add(cdev_p, dev, DEVCOUNT);
154 "gio: Couldn't cdev_add, error=%d\n", error);
161 static void __exit gio_exit(void)
164 unregister_chrdev_region(dev, DEVCOUNT);
167 module_init(gio_init);
168 module_exit(gio_exit);
170 MODULE_LICENSE("GPL");