1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/init.h>
24#include <linux/pnp.h>
25#include <linux/err.h>
26#include <linux/platform_device.h>
27#include <linux/moduleparam.h>
28#include <sound/core.h>
29#include <sound/mpu401.h>
30#include <sound/initval.h>
31
32MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
33MODULE_DESCRIPTION("MPU-401 UART");
34MODULE_LICENSE("GPL");
35
36static int index[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = -2};
37static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
38static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE;
39#ifdef CONFIG_PNP
40static int pnp[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1};
41#endif
42static long port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT;
43static int irq[SNDRV_CARDS] = SNDRV_DEFAULT_IRQ;
44static int uart_enter[SNDRV_CARDS] = {[0 ... (SNDRV_CARDS - 1)] = 1};
45
46module_param_array(index, int, NULL, 0444);
47MODULE_PARM_DESC(index, "Index value for MPU-401 device.");
48module_param_array(id, charp, NULL, 0444);
49MODULE_PARM_DESC(id, "ID string for MPU-401 device.");
50module_param_array(enable, bool, NULL, 0444);
51MODULE_PARM_DESC(enable, "Enable MPU-401 device.");
52#ifdef CONFIG_PNP
53module_param_array(pnp, bool, NULL, 0444);
54MODULE_PARM_DESC(pnp, "PnP detection for MPU-401 device.");
55#endif
56module_param_array(port, long, NULL, 0444);
57MODULE_PARM_DESC(port, "Port # for MPU-401 device.");
58module_param_array(irq, int, NULL, 0444);
59MODULE_PARM_DESC(irq, "IRQ # for MPU-401 device.");
60module_param_array(uart_enter, bool, NULL, 0444);
61MODULE_PARM_DESC(uart_enter, "Issue UART_ENTER command at open.");
62
63static struct platform_device *platform_devices[SNDRV_CARDS];
64static int pnp_registered;
65static unsigned int snd_mpu401_devices;
66
67static int snd_mpu401_create(int dev, struct snd_card **rcard)
68{
69 struct snd_card *card;
70 int err;
71
72 if (!uart_enter[dev])
73 snd_printk(KERN_ERR "the uart_enter option is obsolete; remove it\n");
74
75 *rcard = NULL;
76 err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
77 if (err < 0)
78 return err;
79 strcpy(card->driver, "MPU-401 UART");
80 strcpy(card->shortname, card->driver);
81 sprintf(card->longname, "%s at %#lx, ", card->shortname, port[dev]);
82 if (irq[dev] >= 0) {
83 sprintf(card->longname + strlen(card->longname), "irq %d", irq[dev]);
84 } else {
85 strcat(card->longname, "polled");
86 }
87
88 err = snd_mpu401_uart_new(card, 0, MPU401_HW_MPU401, port[dev], 0,
89 irq[dev], irq[dev] >= 0 ? IRQF_DISABLED : 0,
90 NULL);
91 if (err < 0) {
92 printk(KERN_ERR "MPU401 not detected at 0x%lx\n", port[dev]);
93 goto _err;
94 }
95
96 *rcard = card;
97 return 0;
98
99 _err:
100 snd_card_free(card);
101 return err;
102}
103
104static int __devinit snd_mpu401_probe(struct platform_device *devptr)
105{
106 int dev = devptr->id;
107 int err;
108 struct snd_card *card;
109
110 if (port[dev] == SNDRV_AUTO_PORT) {
111 snd_printk(KERN_ERR "specify port\n");
112 return -EINVAL;
113 }
114 if (irq[dev] == SNDRV_AUTO_IRQ) {
115 snd_printk(KERN_ERR "specify or disable IRQ\n");
116 return -EINVAL;
117 }
118 err = snd_mpu401_create(dev, &card);
119 if (err < 0)
120 return err;
121 snd_card_set_dev(card, &devptr->dev);
122 if ((err = snd_card_register(card)) < 0) {
123 snd_card_free(card);
124 return err;
125 }
126 platform_set_drvdata(devptr, card);
127 return 0;
128}
129
130static int __devexit snd_mpu401_remove(struct platform_device *devptr)
131{
132 snd_card_free(platform_get_drvdata(devptr));
133 platform_set_drvdata(devptr, NULL);
134 return 0;
135}
136
137#define SND_MPU401_DRIVER "snd_mpu401"
138
139static struct platform_driver snd_mpu401_driver = {
140 .probe = snd_mpu401_probe,
141 .remove = __devexit_p(snd_mpu401_remove),
142 .driver = {
143 .name = SND_MPU401_DRIVER
144 },
145};
146
147
148#ifdef CONFIG_PNP
149
150#define IO_EXTENT 2
151
152static struct pnp_device_id snd_mpu401_pnpids[] = {
153 { .id = "PNPb006" },
154 { .id = "" }
155};
156
157MODULE_DEVICE_TABLE(pnp, snd_mpu401_pnpids);
158
159static int __devinit snd_mpu401_pnp(int dev, struct pnp_dev *device,
160 const struct pnp_device_id *id)
161{
162 if (!pnp_port_valid(device, 0) ||
163 pnp_port_flags(device, 0) & IORESOURCE_DISABLED) {
164 snd_printk(KERN_ERR "no PnP port\n");
165 return -ENODEV;
166 }
167 if (pnp_port_len(device, 0) < IO_EXTENT) {
168 snd_printk(KERN_ERR "PnP port length is %llu, expected %d\n",
169 (unsigned long long)pnp_port_len(device, 0),
170 IO_EXTENT);
171 return -ENODEV;
172 }
173 port[dev] = pnp_port_start(device, 0);
174
175 if (!pnp_irq_valid(device, 0) ||
176 pnp_irq_flags(device, 0) & IORESOURCE_DISABLED) {
177 snd_printk(KERN_WARNING "no PnP irq, using polling\n");
178 irq[dev] = -1;
179 } else {
180 irq[dev] = pnp_irq(device, 0);
181 }
182 return 0;
183}
184
185static int __devinit snd_mpu401_pnp_probe(struct pnp_dev *pnp_dev,
186 const struct pnp_device_id *id)
187{
188 static int dev;
189 struct snd_card *card;
190 int err;
191
192 for ( ; dev < SNDRV_CARDS; ++dev) {
193 if (!enable[dev] || !pnp[dev])
194 continue;
195 err = snd_mpu401_pnp(dev, pnp_dev, id);
196 if (err < 0)
197 return err;
198 err = snd_mpu401_create(dev, &card);
199 if (err < 0)
200 return err;
201 if ((err = snd_card_register(card)) < 0) {
202 snd_card_free(card);
203 return err;
204 }
205 snd_card_set_dev(card, &pnp_dev->dev);
206 pnp_set_drvdata(pnp_dev, card);
207 snd_mpu401_devices++;
208 ++dev;
209 return 0;
210 }
211 return -ENODEV;
212}
213
214static void __devexit snd_mpu401_pnp_remove(struct pnp_dev *dev)
215{
216 struct snd_card *card = (struct snd_card *) pnp_get_drvdata(dev);
217
218 snd_card_disconnect(card);
219 snd_card_free_when_closed(card);
220}
221
222static struct pnp_driver snd_mpu401_pnp_driver = {
223 .name = "mpu401",
224 .id_table = snd_mpu401_pnpids,
225 .probe = snd_mpu401_pnp_probe,
226 .remove = __devexit_p(snd_mpu401_pnp_remove),
227};
228#else
229static struct pnp_driver snd_mpu401_pnp_driver;
230#endif
231
232static void snd_mpu401_unregister_all(void)
233{
234 int i;
235
236 if (pnp_registered)
237 pnp_unregister_driver(&snd_mpu401_pnp_driver);
238 for (i = 0; i < ARRAY_SIZE(platform_devices); ++i)
239 platform_device_unregister(platform_devices[i]);
240 platform_driver_unregister(&snd_mpu401_driver);
241}
242
243static int __init alsa_card_mpu401_init(void)
244{
245 int i, err;
246
247 if ((err = platform_driver_register(&snd_mpu401_driver)) < 0)
248 return err;
249
250 for (i = 0; i < SNDRV_CARDS; i++) {
251 struct platform_device *device;
252 if (! enable[i])
253 continue;
254#ifdef CONFIG_PNP
255 if (pnp[i])
256 continue;
257#endif
258 device = platform_device_register_simple(SND_MPU401_DRIVER,
259 i, NULL, 0);
260 if (IS_ERR(device))
261 continue;
262 if (!platform_get_drvdata(device)) {
263 platform_device_unregister(device);
264 continue;
265 }
266 platform_devices[i] = device;
267 snd_mpu401_devices++;
268 }
269 err = pnp_register_driver(&snd_mpu401_pnp_driver);
270 if (!err)
271 pnp_registered = 1;
272
273 if (!snd_mpu401_devices) {
274#ifdef MODULE
275 printk(KERN_ERR "MPU-401 device not found or device busy\n");
276#endif
277 snd_mpu401_unregister_all();
278 return -ENODEV;
279 }
280 return 0;
281}
282
283static void __exit alsa_card_mpu401_exit(void)
284{
285 snd_mpu401_unregister_all();
286}
287
288module_init(alsa_card_mpu401_init)
289module_exit(alsa_card_mpu401_exit)
290
