1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/io.h>
20#include <linux/init.h>
21#include <linux/time.h>
22#include <linux/wait.h>
23#include <linux/slab.h>
24#include <linux/module.h>
25#include <linux/firmware.h>
26#include <sound/core.h>
27#include <sound/snd_wavefront.h>
28#include <sound/initval.h>
29
30
31
32
33#define FX_LSB_TRANSFER 0x01
34#define FX_MSB_TRANSFER 0x02
35#define FX_AUTO_INCR 0x04
36
37#define WAIT_IDLE 0xff
38
39static int
40wavefront_fx_idle (snd_wavefront_t *dev)
41
42{
43 int i;
44 unsigned int x = 0x80;
45
46 for (i = 0; i < 1000; i++) {
47 x = inb (dev->fx_status);
48 if ((x & 0x80) == 0) {
49 break;
50 }
51 }
52
53 if (x & 0x80) {
54 snd_printk ("FX device never idle.\n");
55 return 0;
56 }
57
58 return (1);
59}
60
61static void
62wavefront_fx_mute (snd_wavefront_t *dev, int onoff)
63
64{
65 if (!wavefront_fx_idle(dev)) {
66 return;
67 }
68
69 outb (onoff ? 0x02 : 0x00, dev->fx_op);
70}
71
72static int
73wavefront_fx_memset (snd_wavefront_t *dev,
74 int page,
75 int addr,
76 int cnt,
77 unsigned short *data)
78{
79 if (page < 0 || page > 7) {
80 snd_printk ("FX memset: "
81 "page must be >= 0 and <= 7\n");
82 return -EINVAL;
83 }
84
85 if (addr < 0 || addr > 0x7f) {
86 snd_printk ("FX memset: "
87 "addr must be >= 0 and <= 7f\n");
88 return -EINVAL;
89 }
90
91 if (cnt == 1) {
92
93 outb (FX_LSB_TRANSFER, dev->fx_lcr);
94 outb (page, dev->fx_dsp_page);
95 outb (addr, dev->fx_dsp_addr);
96 outb ((data[0] >> 8), dev->fx_dsp_msb);
97 outb ((data[0] & 0xff), dev->fx_dsp_lsb);
98
99 snd_printk ("FX: addr %d:%x set to 0x%x\n",
100 page, addr, data[0]);
101
102 } else {
103 int i;
104
105 outb (FX_AUTO_INCR|FX_LSB_TRANSFER, dev->fx_lcr);
106 outb (page, dev->fx_dsp_page);
107 outb (addr, dev->fx_dsp_addr);
108
109 for (i = 0; i < cnt; i++) {
110 outb ((data[i] >> 8), dev->fx_dsp_msb);
111 outb ((data[i] & 0xff), dev->fx_dsp_lsb);
112 if (!wavefront_fx_idle (dev)) {
113 break;
114 }
115 }
116
117 if (i != cnt) {
118 snd_printk ("FX memset "
119 "(0x%x, 0x%x, 0x%lx, %d) incomplete\n",
120 page, addr, (unsigned long) data, cnt);
121 return -EIO;
122 }
123 }
124
125 return 0;
126}
127
128int
129snd_wavefront_fx_detect (snd_wavefront_t *dev)
130
131{
132
133
134
135
136
137
138 if (inb (dev->fx_status) & 0x80) {
139 snd_printk ("Hmm, probably a Maui or Tropez.\n");
140 return -1;
141 }
142
143 return 0;
144}
145
146int
147snd_wavefront_fx_open (struct snd_hwdep *hw, struct file *file)
148
149{
150 if (!try_module_get(hw->card->module))
151 return -EFAULT;
152 file->private_data = hw;
153 return 0;
154}
155
156int
157snd_wavefront_fx_release (struct snd_hwdep *hw, struct file *file)
158
159{
160 module_put(hw->card->module);
161 return 0;
162}
163
164int
165snd_wavefront_fx_ioctl (struct snd_hwdep *sdev, struct file *file,
166 unsigned int cmd, unsigned long arg)
167
168{
169 struct snd_card *card;
170 snd_wavefront_card_t *acard;
171 snd_wavefront_t *dev;
172 wavefront_fx_info r;
173 unsigned short *page_data = NULL;
174 unsigned short *pd;
175 int err = 0;
176
177 card = sdev->card;
178 if (snd_BUG_ON(!card))
179 return -ENODEV;
180 if (snd_BUG_ON(!card->private_data))
181 return -ENODEV;
182
183 acard = card->private_data;
184 dev = &acard->wavefront;
185
186 if (copy_from_user (&r, (void __user *)arg, sizeof (wavefront_fx_info)))
187 return -EFAULT;
188
189 switch (r.request) {
190 case WFFX_MUTE:
191 wavefront_fx_mute (dev, r.data[0]);
192 return -EIO;
193
194 case WFFX_MEMSET:
195 if (r.data[2] <= 0) {
196 snd_printk ("cannot write "
197 "<= 0 bytes to FX\n");
198 return -EIO;
199 } else if (r.data[2] == 1) {
200 pd = (unsigned short *) &r.data[3];
201 } else {
202 if (r.data[2] > 256) {
203 snd_printk ("cannot write "
204 "> 512 bytes to FX\n");
205 return -EIO;
206 }
207 page_data = memdup_user((unsigned char __user *)
208 r.data[3],
209 r.data[2] * sizeof(short));
210 if (IS_ERR(page_data))
211 return PTR_ERR(page_data);
212 pd = page_data;
213 }
214
215 err = wavefront_fx_memset (dev,
216 r.data[0],
217 r.data[1],
218 r.data[2],
219 pd);
220 kfree(page_data);
221 break;
222
223 default:
224 snd_printk ("FX: ioctl %d not yet supported\n",
225 r.request);
226 return -ENOTTY;
227 }
228 return err;
229}
230
231
232
233
234
235
236
237
238
239
240
241
242
243int
244snd_wavefront_fx_start (snd_wavefront_t *dev)
245{
246 unsigned int i;
247 int err;
248 const struct firmware *firmware = NULL;
249
250 if (dev->fx_initialized)
251 return 0;
252
253 err = request_firmware(&firmware, "yamaha/yss225_registers.bin",
254 dev->card->dev);
255 if (err < 0) {
256 err = -1;
257 goto out;
258 }
259
260 for (i = 0; i + 1 < firmware->size; i += 2) {
261 if (firmware->data[i] >= 8 && firmware->data[i] < 16) {
262 outb(firmware->data[i + 1],
263 dev->base + firmware->data[i]);
264 } else if (firmware->data[i] == WAIT_IDLE) {
265 if (!wavefront_fx_idle(dev)) {
266 err = -1;
267 goto out;
268 }
269 } else {
270 snd_printk(KERN_ERR "invalid address"
271 " in register data\n");
272 err = -1;
273 goto out;
274 }
275 }
276
277 dev->fx_initialized = 1;
278 err = 0;
279
280out:
281 release_firmware(firmware);
282 return err;
283}
284
285MODULE_FIRMWARE("yamaha/yss225_registers.bin");
286