]>
Commit | Line | Data |
---|---|---|
cf40a310 RH |
1 | /* |
2 | * AdLib FM card driver. | |
3 | */ | |
4 | ||
5 | #include <sound/driver.h> | |
6 | #include <linux/kernel.h> | |
7 | #include <linux/module.h> | |
8 | #include <linux/platform_device.h> | |
9 | #include <sound/core.h> | |
10 | #include <sound/initval.h> | |
11 | #include <sound/opl3.h> | |
12 | ||
13 | #define CRD_NAME "AdLib FM" | |
14 | #define DRV_NAME "snd_adlib" | |
15 | ||
16 | MODULE_DESCRIPTION(CRD_NAME); | |
17 | MODULE_AUTHOR("Rene Herman"); | |
18 | MODULE_LICENSE("GPL"); | |
19 | ||
20 | static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; | |
21 | static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; | |
22 | static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE; | |
23 | static long port[SNDRV_CARDS] = SNDRV_DEFAULT_PORT; | |
24 | ||
25 | module_param_array(index, int, NULL, 0444); | |
26 | MODULE_PARM_DESC(index, "Index value for " CRD_NAME " soundcard."); | |
27 | module_param_array(id, charp, NULL, 0444); | |
28 | MODULE_PARM_DESC(id, "ID string for " CRD_NAME " soundcard."); | |
29 | module_param_array(enable, bool, NULL, 0444); | |
30 | MODULE_PARM_DESC(enable, "Enable " CRD_NAME " soundcard."); | |
31 | module_param_array(port, long, NULL, 0444); | |
32 | MODULE_PARM_DESC(port, "Port # for " CRD_NAME " driver."); | |
33 | ||
34 | static struct platform_device *devices[SNDRV_CARDS]; | |
35 | ||
36 | static void snd_adlib_free(struct snd_card *card) | |
37 | { | |
38 | release_and_free_resource(card->private_data); | |
39 | } | |
40 | ||
41 | static int __devinit snd_adlib_probe(struct platform_device *device) | |
42 | { | |
43 | struct snd_card *card; | |
44 | struct snd_opl3 *opl3; | |
45 | ||
46 | int error; | |
47 | int i = device->id; | |
48 | ||
49 | if (port[i] == SNDRV_AUTO_PORT) { | |
50 | snd_printk(KERN_ERR DRV_NAME ": please specify port\n"); | |
51 | error = -EINVAL; | |
52 | goto out0; | |
53 | } | |
54 | ||
55 | card = snd_card_new(index[i], id[i], THIS_MODULE, 0); | |
56 | if (!card) { | |
57 | snd_printk(KERN_ERR DRV_NAME ": could not create card\n"); | |
58 | error = -EINVAL; | |
59 | goto out0; | |
60 | } | |
61 | ||
62 | card->private_data = request_region(port[i], 4, CRD_NAME); | |
63 | if (!card->private_data) { | |
64 | snd_printk(KERN_ERR DRV_NAME ": could not grab ports\n"); | |
65 | error = -EBUSY; | |
66 | goto out1; | |
67 | } | |
68 | card->private_free = snd_adlib_free; | |
69 | ||
70 | error = snd_opl3_create(card, port[i], port[i] + 2, OPL3_HW_AUTO, 1, &opl3); | |
71 | if (error < 0) { | |
72 | snd_printk(KERN_ERR DRV_NAME ": could not create OPL\n"); | |
73 | goto out1; | |
74 | } | |
75 | ||
76 | error = snd_opl3_hwdep_new(opl3, 0, 0, NULL); | |
77 | if (error < 0) { | |
78 | snd_printk(KERN_ERR DRV_NAME ": could not create FM\n"); | |
79 | goto out1; | |
80 | } | |
81 | ||
82 | strcpy(card->driver, DRV_NAME); | |
83 | strcpy(card->shortname, CRD_NAME); | |
84 | sprintf(card->longname, CRD_NAME " at %#lx", port[i]); | |
85 | ||
86 | snd_card_set_dev(card, &device->dev); | |
87 | ||
88 | error = snd_card_register(card); | |
89 | if (error < 0) { | |
90 | snd_printk(KERN_ERR DRV_NAME ": could not register card\n"); | |
91 | goto out1; | |
92 | } | |
93 | ||
94 | platform_set_drvdata(device, card); | |
95 | return 0; | |
96 | ||
97 | out1: snd_card_free(card); | |
98 | out0: error = -EINVAL; /* FIXME: should be the original error code */ | |
99 | return error; | |
100 | } | |
101 | ||
102 | static int __devexit snd_adlib_remove(struct platform_device *device) | |
103 | { | |
104 | snd_card_free(platform_get_drvdata(device)); | |
105 | platform_set_drvdata(device, NULL); | |
106 | return 0; | |
107 | } | |
108 | ||
109 | static struct platform_driver snd_adlib_driver = { | |
110 | .probe = snd_adlib_probe, | |
111 | .remove = __devexit_p(snd_adlib_remove), | |
112 | ||
113 | .driver = { | |
114 | .name = DRV_NAME | |
115 | } | |
116 | }; | |
117 | ||
118 | static int __init alsa_card_adlib_init(void) | |
119 | { | |
120 | int i, cards; | |
121 | ||
122 | if (platform_driver_register(&snd_adlib_driver) < 0) { | |
123 | snd_printk(KERN_ERR DRV_NAME ": could not register driver\n"); | |
124 | return -ENODEV; | |
125 | } | |
126 | ||
127 | for (cards = 0, i = 0; i < SNDRV_CARDS; i++) { | |
128 | struct platform_device *device; | |
129 | ||
130 | if (!enable[i]) | |
131 | continue; | |
132 | ||
133 | device = platform_device_register_simple(DRV_NAME, i, NULL, 0); | |
134 | if (IS_ERR(device)) | |
135 | continue; | |
136 | ||
137 | devices[i] = device; | |
138 | cards++; | |
139 | } | |
140 | ||
141 | if (!cards) { | |
142 | #ifdef MODULE | |
143 | printk(KERN_ERR CRD_NAME " soundcard not found or device busy\n"); | |
144 | #endif | |
145 | platform_driver_unregister(&snd_adlib_driver); | |
146 | return -ENODEV; | |
147 | } | |
148 | return 0; | |
149 | } | |
150 | ||
151 | static void __exit alsa_card_adlib_exit(void) | |
152 | { | |
153 | int i; | |
154 | ||
155 | for (i = 0; i < SNDRV_CARDS; i++) | |
156 | platform_device_unregister(devices[i]); | |
157 | platform_driver_unregister(&snd_adlib_driver); | |
158 | } | |
159 | ||
160 | module_init(alsa_card_adlib_init); | |
161 | module_exit(alsa_card_adlib_exit); |