net: dsa: mt7530: set CPU port to fallback mode
[linux/fpc-iii.git] / sound / pci / emu10k1 / emu10k1_callback.c
blobaa2cc27b849166be87c533efb4b66b15ce96fe31
1 /*
2 * synth callback routines for Emu10k1
4 * Copyright (C) 2000 Takashi Iwai <tiwai@suse.de>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 #include <linux/export.h>
22 #include "emu10k1_synth_local.h"
23 #include <sound/asoundef.h>
25 /* voice status */
26 enum {
27 V_FREE=0, V_OFF, V_RELEASED, V_PLAYING, V_END
30 /* Keeps track of what we are finding */
31 struct best_voice {
32 unsigned int time;
33 int voice;
37 * prototypes
39 static void lookup_voices(struct snd_emux *emux, struct snd_emu10k1 *hw,
40 struct best_voice *best, int active_only);
41 static struct snd_emux_voice *get_voice(struct snd_emux *emux,
42 struct snd_emux_port *port);
43 static int start_voice(struct snd_emux_voice *vp);
44 static void trigger_voice(struct snd_emux_voice *vp);
45 static void release_voice(struct snd_emux_voice *vp);
46 static void update_voice(struct snd_emux_voice *vp, int update);
47 static void terminate_voice(struct snd_emux_voice *vp);
48 static void free_voice(struct snd_emux_voice *vp);
49 static void set_fmmod(struct snd_emu10k1 *hw, struct snd_emux_voice *vp);
50 static void set_fm2frq2(struct snd_emu10k1 *hw, struct snd_emux_voice *vp);
51 static void set_filterQ(struct snd_emu10k1 *hw, struct snd_emux_voice *vp);
54 * Ensure a value is between two points
55 * macro evaluates its args more than once, so changed to upper-case.
57 #define LIMITVALUE(x, a, b) do { if ((x) < (a)) (x) = (a); else if ((x) > (b)) (x) = (b); } while (0)
58 #define LIMITMAX(x, a) do {if ((x) > (a)) (x) = (a); } while (0)
62 * set up operators
64 static const struct snd_emux_operators emu10k1_ops = {
65 .owner = THIS_MODULE,
66 .get_voice = get_voice,
67 .prepare = start_voice,
68 .trigger = trigger_voice,
69 .release = release_voice,
70 .update = update_voice,
71 .terminate = terminate_voice,
72 .free_voice = free_voice,
73 .sample_new = snd_emu10k1_sample_new,
74 .sample_free = snd_emu10k1_sample_free,
77 void
78 snd_emu10k1_ops_setup(struct snd_emux *emux)
80 emux->ops = emu10k1_ops;
85 * get more voice for pcm
87 * terminate most inactive voice and give it as a pcm voice.
89 * voice_lock is already held.
91 int
92 snd_emu10k1_synth_get_voice(struct snd_emu10k1 *hw)
94 struct snd_emux *emu;
95 struct snd_emux_voice *vp;
96 struct best_voice best[V_END];
97 int i;
99 emu = hw->synth;
101 lookup_voices(emu, hw, best, 1); /* no OFF voices */
102 for (i = 0; i < V_END; i++) {
103 if (best[i].voice >= 0) {
104 int ch;
105 vp = &emu->voices[best[i].voice];
106 if ((ch = vp->ch) < 0) {
108 dev_warn(emu->card->dev,
109 "synth_get_voice: ch < 0 (%d) ??", i);
111 continue;
113 vp->emu->num_voices--;
114 vp->ch = -1;
115 vp->state = SNDRV_EMUX_ST_OFF;
116 return ch;
120 /* not found */
121 return -ENOMEM;
126 * turn off the voice (not terminated)
128 static void
129 release_voice(struct snd_emux_voice *vp)
131 int dcysusv;
132 struct snd_emu10k1 *hw;
134 hw = vp->hw;
135 dcysusv = 0x8000 | (unsigned char)vp->reg.parm.modrelease;
136 snd_emu10k1_ptr_write(hw, DCYSUSM, vp->ch, dcysusv);
137 dcysusv = 0x8000 | (unsigned char)vp->reg.parm.volrelease | DCYSUSV_CHANNELENABLE_MASK;
138 snd_emu10k1_ptr_write(hw, DCYSUSV, vp->ch, dcysusv);
143 * terminate the voice
145 static void
146 terminate_voice(struct snd_emux_voice *vp)
148 struct snd_emu10k1 *hw;
150 if (snd_BUG_ON(!vp))
151 return;
152 hw = vp->hw;
153 snd_emu10k1_ptr_write(hw, DCYSUSV, vp->ch, 0x807f | DCYSUSV_CHANNELENABLE_MASK);
154 if (vp->block) {
155 struct snd_emu10k1_memblk *emem;
156 emem = (struct snd_emu10k1_memblk *)vp->block;
157 if (emem->map_locked > 0)
158 emem->map_locked--;
163 * release the voice to system
165 static void
166 free_voice(struct snd_emux_voice *vp)
168 struct snd_emu10k1 *hw;
170 hw = vp->hw;
171 /* FIXME: emu10k1_synth is broken. */
172 /* This can get called with hw == 0 */
173 /* Problem apparent on plug, unplug then plug */
174 /* on the Audigy 2 ZS Notebook. */
175 if (hw && (vp->ch >= 0)) {
176 snd_emu10k1_ptr_write(hw, IFATN, vp->ch, 0xff00);
177 snd_emu10k1_ptr_write(hw, DCYSUSV, vp->ch, 0x807f | DCYSUSV_CHANNELENABLE_MASK);
178 // snd_emu10k1_ptr_write(hw, DCYSUSV, vp->ch, 0);
179 snd_emu10k1_ptr_write(hw, VTFT, vp->ch, 0xffff);
180 snd_emu10k1_ptr_write(hw, CVCF, vp->ch, 0xffff);
181 snd_emu10k1_voice_free(hw, &hw->voices[vp->ch]);
182 vp->emu->num_voices--;
183 vp->ch = -1;
189 * update registers
191 static void
192 update_voice(struct snd_emux_voice *vp, int update)
194 struct snd_emu10k1 *hw;
196 hw = vp->hw;
197 if (update & SNDRV_EMUX_UPDATE_VOLUME)
198 snd_emu10k1_ptr_write(hw, IFATN_ATTENUATION, vp->ch, vp->avol);
199 if (update & SNDRV_EMUX_UPDATE_PITCH)
200 snd_emu10k1_ptr_write(hw, IP, vp->ch, vp->apitch);
201 if (update & SNDRV_EMUX_UPDATE_PAN) {
202 snd_emu10k1_ptr_write(hw, PTRX_FXSENDAMOUNT_A, vp->ch, vp->apan);
203 snd_emu10k1_ptr_write(hw, PTRX_FXSENDAMOUNT_B, vp->ch, vp->aaux);
205 if (update & SNDRV_EMUX_UPDATE_FMMOD)
206 set_fmmod(hw, vp);
207 if (update & SNDRV_EMUX_UPDATE_TREMFREQ)
208 snd_emu10k1_ptr_write(hw, TREMFRQ, vp->ch, vp->reg.parm.tremfrq);
209 if (update & SNDRV_EMUX_UPDATE_FM2FRQ2)
210 set_fm2frq2(hw, vp);
211 if (update & SNDRV_EMUX_UPDATE_Q)
212 set_filterQ(hw, vp);
217 * look up voice table - get the best voice in order of preference
219 /* spinlock held! */
220 static void
221 lookup_voices(struct snd_emux *emu, struct snd_emu10k1 *hw,
222 struct best_voice *best, int active_only)
224 struct snd_emux_voice *vp;
225 struct best_voice *bp;
226 int i;
228 for (i = 0; i < V_END; i++) {
229 best[i].time = (unsigned int)-1; /* XXX MAX_?INT really */
230 best[i].voice = -1;
234 * Go through them all and get a best one to use.
235 * NOTE: could also look at volume and pick the quietest one.
237 for (i = 0; i < emu->max_voices; i++) {
238 int state, val;
240 vp = &emu->voices[i];
241 state = vp->state;
242 if (state == SNDRV_EMUX_ST_OFF) {
243 if (vp->ch < 0) {
244 if (active_only)
245 continue;
246 bp = best + V_FREE;
247 } else
248 bp = best + V_OFF;
250 else if (state == SNDRV_EMUX_ST_RELEASED ||
251 state == SNDRV_EMUX_ST_PENDING) {
252 bp = best + V_RELEASED;
253 #if 1
254 val = snd_emu10k1_ptr_read(hw, CVCF_CURRENTVOL, vp->ch);
255 if (! val)
256 bp = best + V_OFF;
257 #endif
259 else if (state == SNDRV_EMUX_ST_STANDBY)
260 continue;
261 else if (state & SNDRV_EMUX_ST_ON)
262 bp = best + V_PLAYING;
263 else
264 continue;
266 /* check if sample is finished playing (non-looping only) */
267 if (bp != best + V_OFF && bp != best + V_FREE &&
268 (vp->reg.sample_mode & SNDRV_SFNT_SAMPLE_SINGLESHOT)) {
269 val = snd_emu10k1_ptr_read(hw, CCCA_CURRADDR, vp->ch);
270 if (val >= vp->reg.loopstart)
271 bp = best + V_OFF;
274 if (vp->time < bp->time) {
275 bp->time = vp->time;
276 bp->voice = i;
282 * get an empty voice
284 * emu->voice_lock is already held.
286 static struct snd_emux_voice *
287 get_voice(struct snd_emux *emu, struct snd_emux_port *port)
289 struct snd_emu10k1 *hw;
290 struct snd_emux_voice *vp;
291 struct best_voice best[V_END];
292 int i;
294 hw = emu->hw;
296 lookup_voices(emu, hw, best, 0);
297 for (i = 0; i < V_END; i++) {
298 if (best[i].voice >= 0) {
299 vp = &emu->voices[best[i].voice];
300 if (vp->ch < 0) {
301 /* allocate a voice */
302 struct snd_emu10k1_voice *hwvoice;
303 if (snd_emu10k1_voice_alloc(hw, EMU10K1_SYNTH, 1, &hwvoice) < 0 || hwvoice == NULL)
304 continue;
305 vp->ch = hwvoice->number;
306 emu->num_voices++;
308 return vp;
312 /* not found */
313 return NULL;
317 * prepare envelopes and LFOs
319 static int
320 start_voice(struct snd_emux_voice *vp)
322 unsigned int temp;
323 int ch;
324 unsigned int addr, mapped_offset;
325 struct snd_midi_channel *chan;
326 struct snd_emu10k1 *hw;
327 struct snd_emu10k1_memblk *emem;
329 hw = vp->hw;
330 ch = vp->ch;
331 if (snd_BUG_ON(ch < 0))
332 return -EINVAL;
333 chan = vp->chan;
335 emem = (struct snd_emu10k1_memblk *)vp->block;
336 if (emem == NULL)
337 return -EINVAL;
338 emem->map_locked++;
339 if (snd_emu10k1_memblk_map(hw, emem) < 0) {
340 /* dev_err(hw->card->devK, "emu: cannot map!\n"); */
341 return -ENOMEM;
343 mapped_offset = snd_emu10k1_memblk_offset(emem) >> 1;
344 vp->reg.start += mapped_offset;
345 vp->reg.end += mapped_offset;
346 vp->reg.loopstart += mapped_offset;
347 vp->reg.loopend += mapped_offset;
349 /* set channel routing */
350 /* A = left(0), B = right(1), C = reverb(c), D = chorus(d) */
351 if (hw->audigy) {
352 temp = FXBUS_MIDI_LEFT | (FXBUS_MIDI_RIGHT << 8) |
353 (FXBUS_MIDI_REVERB << 16) | (FXBUS_MIDI_CHORUS << 24);
354 snd_emu10k1_ptr_write(hw, A_FXRT1, ch, temp);
355 } else {
356 temp = (FXBUS_MIDI_LEFT << 16) | (FXBUS_MIDI_RIGHT << 20) |
357 (FXBUS_MIDI_REVERB << 24) | (FXBUS_MIDI_CHORUS << 28);
358 snd_emu10k1_ptr_write(hw, FXRT, ch, temp);
361 /* channel to be silent and idle */
362 snd_emu10k1_ptr_write(hw, DCYSUSV, ch, 0x0000);
363 snd_emu10k1_ptr_write(hw, VTFT, ch, 0x0000FFFF);
364 snd_emu10k1_ptr_write(hw, CVCF, ch, 0x0000FFFF);
365 snd_emu10k1_ptr_write(hw, PTRX, ch, 0);
366 snd_emu10k1_ptr_write(hw, CPF, ch, 0);
368 /* set pitch offset */
369 snd_emu10k1_ptr_write(hw, IP, vp->ch, vp->apitch);
371 /* set envelope parameters */
372 snd_emu10k1_ptr_write(hw, ENVVAL, ch, vp->reg.parm.moddelay);
373 snd_emu10k1_ptr_write(hw, ATKHLDM, ch, vp->reg.parm.modatkhld);
374 snd_emu10k1_ptr_write(hw, DCYSUSM, ch, vp->reg.parm.moddcysus);
375 snd_emu10k1_ptr_write(hw, ENVVOL, ch, vp->reg.parm.voldelay);
376 snd_emu10k1_ptr_write(hw, ATKHLDV, ch, vp->reg.parm.volatkhld);
377 /* decay/sustain parameter for volume envelope is used
378 for triggerg the voice */
380 /* cutoff and volume */
381 temp = (unsigned int)vp->acutoff << 8 | (unsigned char)vp->avol;
382 snd_emu10k1_ptr_write(hw, IFATN, vp->ch, temp);
384 /* modulation envelope heights */
385 snd_emu10k1_ptr_write(hw, PEFE, ch, vp->reg.parm.pefe);
387 /* lfo1/2 delay */
388 snd_emu10k1_ptr_write(hw, LFOVAL1, ch, vp->reg.parm.lfo1delay);
389 snd_emu10k1_ptr_write(hw, LFOVAL2, ch, vp->reg.parm.lfo2delay);
391 /* lfo1 pitch & cutoff shift */
392 set_fmmod(hw, vp);
393 /* lfo1 volume & freq */
394 snd_emu10k1_ptr_write(hw, TREMFRQ, vp->ch, vp->reg.parm.tremfrq);
395 /* lfo2 pitch & freq */
396 set_fm2frq2(hw, vp);
398 /* reverb and loop start (reverb 8bit, MSB) */
399 temp = vp->reg.parm.reverb;
400 temp += (int)vp->chan->control[MIDI_CTL_E1_REVERB_DEPTH] * 9 / 10;
401 LIMITMAX(temp, 255);
402 addr = vp->reg.loopstart;
403 snd_emu10k1_ptr_write(hw, PSST, vp->ch, (temp << 24) | addr);
405 /* chorus & loop end (chorus 8bit, MSB) */
406 addr = vp->reg.loopend;
407 temp = vp->reg.parm.chorus;
408 temp += (int)chan->control[MIDI_CTL_E3_CHORUS_DEPTH] * 9 / 10;
409 LIMITMAX(temp, 255);
410 temp = (temp <<24) | addr;
411 snd_emu10k1_ptr_write(hw, DSL, ch, temp);
413 /* clear filter delay memory */
414 snd_emu10k1_ptr_write(hw, Z1, ch, 0);
415 snd_emu10k1_ptr_write(hw, Z2, ch, 0);
417 /* invalidate maps */
418 temp = (hw->silent_page.addr << hw->address_mode) | (hw->address_mode ? MAP_PTI_MASK1 : MAP_PTI_MASK0);
419 snd_emu10k1_ptr_write(hw, MAPA, ch, temp);
420 snd_emu10k1_ptr_write(hw, MAPB, ch, temp);
421 #if 0
422 /* cache */
424 unsigned int val, sample;
425 val = 32;
426 if (vp->reg.sample_mode & SNDRV_SFNT_SAMPLE_8BITS)
427 sample = 0x80808080;
428 else {
429 sample = 0;
430 val *= 2;
433 /* cache */
434 snd_emu10k1_ptr_write(hw, CCR, ch, 0x1c << 16);
435 snd_emu10k1_ptr_write(hw, CDE, ch, sample);
436 snd_emu10k1_ptr_write(hw, CDF, ch, sample);
438 /* invalidate maps */
439 temp = ((unsigned int)hw->silent_page.addr << hw_address_mode) | (hw->address_mode ? MAP_PTI_MASK1 : MAP_PTI_MASK0);
440 snd_emu10k1_ptr_write(hw, MAPA, ch, temp);
441 snd_emu10k1_ptr_write(hw, MAPB, ch, temp);
443 /* fill cache */
444 val -= 4;
445 val <<= 25;
446 val |= 0x1c << 16;
447 snd_emu10k1_ptr_write(hw, CCR, ch, val);
449 #endif
451 /* Q & current address (Q 4bit value, MSB) */
452 addr = vp->reg.start;
453 temp = vp->reg.parm.filterQ;
454 temp = (temp<<28) | addr;
455 if (vp->apitch < 0xe400)
456 temp |= CCCA_INTERPROM_0;
457 else {
458 unsigned int shift = (vp->apitch - 0xe000) >> 10;
459 temp |= shift << 25;
461 if (vp->reg.sample_mode & SNDRV_SFNT_SAMPLE_8BITS)
462 temp |= CCCA_8BITSELECT;
463 snd_emu10k1_ptr_write(hw, CCCA, ch, temp);
465 /* reset volume */
466 temp = (unsigned int)vp->vtarget << 16;
467 snd_emu10k1_ptr_write(hw, VTFT, ch, temp | vp->ftarget);
468 snd_emu10k1_ptr_write(hw, CVCF, ch, temp | 0xff00);
469 return 0;
473 * Start envelope
475 static void
476 trigger_voice(struct snd_emux_voice *vp)
478 unsigned int temp, ptarget;
479 struct snd_emu10k1 *hw;
480 struct snd_emu10k1_memblk *emem;
482 hw = vp->hw;
484 emem = (struct snd_emu10k1_memblk *)vp->block;
485 if (! emem || emem->mapped_page < 0)
486 return; /* not mapped */
488 #if 0
489 ptarget = (unsigned int)vp->ptarget << 16;
490 #else
491 ptarget = IP_TO_CP(vp->apitch);
492 #endif
493 /* set pitch target and pan (volume) */
494 temp = ptarget | (vp->apan << 8) | vp->aaux;
495 snd_emu10k1_ptr_write(hw, PTRX, vp->ch, temp);
497 /* pitch target */
498 snd_emu10k1_ptr_write(hw, CPF, vp->ch, ptarget);
500 /* trigger voice */
501 snd_emu10k1_ptr_write(hw, DCYSUSV, vp->ch, vp->reg.parm.voldcysus|DCYSUSV_CHANNELENABLE_MASK);
504 #define MOD_SENSE 18
506 /* set lfo1 modulation height and cutoff */
507 static void
508 set_fmmod(struct snd_emu10k1 *hw, struct snd_emux_voice *vp)
510 unsigned short fmmod;
511 short pitch;
512 unsigned char cutoff;
513 int modulation;
515 pitch = (char)(vp->reg.parm.fmmod>>8);
516 cutoff = (vp->reg.parm.fmmod & 0xff);
517 modulation = vp->chan->gm_modulation + vp->chan->midi_pressure;
518 pitch += (MOD_SENSE * modulation) / 1200;
519 LIMITVALUE(pitch, -128, 127);
520 fmmod = ((unsigned char)pitch<<8) | cutoff;
521 snd_emu10k1_ptr_write(hw, FMMOD, vp->ch, fmmod);
524 /* set lfo2 pitch & frequency */
525 static void
526 set_fm2frq2(struct snd_emu10k1 *hw, struct snd_emux_voice *vp)
528 unsigned short fm2frq2;
529 short pitch;
530 unsigned char freq;
531 int modulation;
533 pitch = (char)(vp->reg.parm.fm2frq2>>8);
534 freq = vp->reg.parm.fm2frq2 & 0xff;
535 modulation = vp->chan->gm_modulation + vp->chan->midi_pressure;
536 pitch += (MOD_SENSE * modulation) / 1200;
537 LIMITVALUE(pitch, -128, 127);
538 fm2frq2 = ((unsigned char)pitch<<8) | freq;
539 snd_emu10k1_ptr_write(hw, FM2FRQ2, vp->ch, fm2frq2);
542 /* set filterQ */
543 static void
544 set_filterQ(struct snd_emu10k1 *hw, struct snd_emux_voice *vp)
546 unsigned int val;
547 val = snd_emu10k1_ptr_read(hw, CCCA, vp->ch) & ~CCCA_RESONANCE;
548 val |= (vp->reg.parm.filterQ << 28);
549 snd_emu10k1_ptr_write(hw, CCCA, vp->ch, val);