diff options
author | Jim Cromie <jim.cromie@gmail.com> | 2006-06-27 05:54:14 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@g5.osdl.org> | 2006-06-27 20:32:42 -0400 |
commit | 979b5ec3a7055d35b212f657e80257ec1346aa0e (patch) | |
tree | 41c47b988d6302218fa71a7d8ca7f21b9fa95826 /drivers/char/scx200_gpio.c | |
parent | 7d7f212661d68d231fdfaead03dda0dd44d5bbbb (diff) |
[PATCH] chardev: GPIO for SCx200 & PC-8736x: add platforn_device for use w dev_dbg
Add a platform-device to scx200_gpio, and use its struct device dev member
(ie: devp) in dev_dbg() once.
There are 2 alternatives here (Im soliciting guidance/commentary):
- use isa_device, if/when its added to the kernel.
- alter scx200.c to EXPORT_GPL its private devp so that both scx200_gpio,
and the (to be added) nsc_gpio module can use it. Since the available devp
is in 'grandparent', this seems like too much 'action at a distance'.
Signed-off-by: Jim Cromie <jim.cromie@gmail.com>
Cc: Greg KH <greg@kroah.com>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Linus Torvalds <torvalds@osdl.org>
Diffstat (limited to 'drivers/char/scx200_gpio.c')
-rw-r--r-- | drivers/char/scx200_gpio.c | 53 |
1 files changed, 36 insertions, 17 deletions
diff --git a/drivers/char/scx200_gpio.c b/drivers/char/scx200_gpio.c index 507a5bf567cb..e6e52c48697b 100644 --- a/drivers/char/scx200_gpio.c +++ b/drivers/char/scx200_gpio.c | |||
@@ -6,11 +6,13 @@ | |||
6 | Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com> */ | 6 | Copyright (c) 2001,2002 Christer Weinigel <wingel@nano-system.com> */ |
7 | 7 | ||
8 | #include <linux/config.h> | 8 | #include <linux/config.h> |
9 | #include <linux/device.h> | ||
9 | #include <linux/fs.h> | 10 | #include <linux/fs.h> |
10 | #include <linux/module.h> | 11 | #include <linux/module.h> |
11 | #include <linux/errno.h> | 12 | #include <linux/errno.h> |
12 | #include <linux/kernel.h> | 13 | #include <linux/kernel.h> |
13 | #include <linux/init.h> | 14 | #include <linux/init.h> |
15 | #include <linux/platform_device.h> | ||
14 | #include <asm/uaccess.h> | 16 | #include <asm/uaccess.h> |
15 | #include <asm/io.h> | 17 | #include <asm/io.h> |
16 | 18 | ||
@@ -20,6 +22,9 @@ | |||
20 | #include <linux/scx200_gpio.h> | 22 | #include <linux/scx200_gpio.h> |
21 | 23 | ||
22 | #define NAME "scx200_gpio" | 24 | #define NAME "scx200_gpio" |
25 | #define DEVNAME NAME | ||
26 | |||
27 | static struct platform_device *pdev; | ||
23 | 28 | ||
24 | MODULE_AUTHOR("Christer Weinigel <wingel@nano-system.com>"); | 29 | MODULE_AUTHOR("Christer Weinigel <wingel@nano-system.com>"); |
25 | MODULE_DESCRIPTION("NatSemi SCx200 GPIO Pin Driver"); | 30 | MODULE_DESCRIPTION("NatSemi SCx200 GPIO Pin Driver"); |
@@ -114,56 +119,70 @@ static struct file_operations scx200_gpio_fops = { | |||
114 | }; | 119 | }; |
115 | 120 | ||
116 | struct cdev *scx200_devices; | 121 | struct cdev *scx200_devices; |
117 | int num_devs = 32; | 122 | static int num_pins = 32; |
118 | 123 | ||
119 | static int __init scx200_gpio_init(void) | 124 | static int __init scx200_gpio_init(void) |
120 | { | 125 | { |
121 | int rc, i; | 126 | int rc, i; |
122 | dev_t dev = MKDEV(major, 0); | 127 | dev_t dev = MKDEV(major, 0); |
123 | 128 | ||
124 | printk(KERN_DEBUG NAME ": NatSemi SCx200 GPIO Driver\n"); | ||
125 | |||
126 | if (!scx200_gpio_present()) { | 129 | if (!scx200_gpio_present()) { |
127 | printk(KERN_ERR NAME ": no SCx200 gpio present\n"); | 130 | printk(KERN_ERR NAME ": no SCx200 gpio present\n"); |
128 | return -ENODEV; | 131 | return -ENODEV; |
129 | } | 132 | } |
133 | |||
134 | /* support dev_dbg() with pdev->dev */ | ||
135 | pdev = platform_device_alloc(DEVNAME, 0); | ||
136 | if (!pdev) | ||
137 | return -ENOMEM; | ||
138 | |||
139 | rc = platform_device_add(pdev); | ||
140 | if (rc) | ||
141 | goto undo_malloc; | ||
142 | |||
130 | if (major) | 143 | if (major) |
131 | rc = register_chrdev_region(dev, num_devs, "scx200_gpio"); | 144 | rc = register_chrdev_region(dev, num_pins, "scx200_gpio"); |
132 | else { | 145 | else { |
133 | rc = alloc_chrdev_region(&dev, 0, num_devs, "scx200_gpio"); | 146 | rc = alloc_chrdev_region(&dev, 0, num_pins, "scx200_gpio"); |
134 | major = MAJOR(dev); | 147 | major = MAJOR(dev); |
135 | } | 148 | } |
136 | if (rc < 0) { | 149 | if (rc < 0) { |
137 | printk(KERN_ERR NAME ": SCx200 chrdev_region: %d\n", rc); | 150 | dev_err(&pdev->dev, "SCx200 chrdev_region err: %d\n", rc); |
138 | return rc; | 151 | goto undo_platform_device_add; |
139 | } | 152 | } |
140 | scx200_devices = kzalloc(num_devs * sizeof(struct cdev), GFP_KERNEL); | 153 | scx200_devices = kzalloc(num_pins * sizeof(struct cdev), GFP_KERNEL); |
141 | if (!scx200_devices) { | 154 | if (!scx200_devices) { |
142 | rc = -ENOMEM; | 155 | rc = -ENOMEM; |
143 | goto fail_malloc; | 156 | goto undo_chrdev_region; |
144 | } | 157 | } |
145 | for (i = 0; i < num_devs; i++) { | 158 | for (i = 0; i < num_pins; i++) { |
146 | struct cdev *cdev = &scx200_devices[i]; | 159 | struct cdev *cdev = &scx200_devices[i]; |
147 | cdev_init(cdev, &scx200_gpio_fops); | 160 | cdev_init(cdev, &scx200_gpio_fops); |
148 | cdev->owner = THIS_MODULE; | 161 | cdev->owner = THIS_MODULE; |
149 | cdev->ops = &scx200_gpio_fops; | ||
150 | rc = cdev_add(cdev, MKDEV(major, i), 1); | 162 | rc = cdev_add(cdev, MKDEV(major, i), 1); |
151 | /* Fail gracefully if need be */ | 163 | /* tolerate 'minor' errors */ |
152 | if (rc) | 164 | if (rc) |
153 | printk(KERN_ERR NAME "Error %d on minor %d", rc, i); | 165 | dev_err(&pdev->dev, "Error %d on minor %d", rc, i); |
154 | } | 166 | } |
155 | 167 | ||
156 | return 0; /* succeed */ | 168 | return 0; /* succeed */ |
157 | 169 | ||
158 | fail_malloc: | 170 | undo_chrdev_region: |
159 | unregister_chrdev_region(dev, num_devs); | 171 | unregister_chrdev_region(dev, num_pins); |
172 | undo_platform_device_add: | ||
173 | platform_device_put(pdev); | ||
174 | undo_malloc: | ||
175 | kfree(pdev); | ||
160 | return rc; | 176 | return rc; |
161 | } | 177 | } |
162 | 178 | ||
163 | static void __exit scx200_gpio_cleanup(void) | 179 | static void __exit scx200_gpio_cleanup(void) |
164 | { | 180 | { |
165 | kfree(scx200_devices); | 181 | kfree(scx200_devices); |
166 | unregister_chrdev_region(MKDEV(major, 0), num_devs); | 182 | unregister_chrdev_region(MKDEV(major, 0), num_pins); |
183 | platform_device_put(pdev); | ||
184 | platform_device_unregister(pdev); | ||
185 | /* kfree(pdev); */ | ||
167 | } | 186 | } |
168 | 187 | ||
169 | module_init(scx200_gpio_init); | 188 | module_init(scx200_gpio_init); |