Fix qemu_send_packet
[qemu-kvm/fedora.git] / hw / gusemu_hal.c
blobc6f9537483b812e6952e4c6d9ce260412a524018
1 /*
2 * GUSEMU32 - bus interface part
4 * Copyright (C) 2000-2007 Tibor "TS" Schütz
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22 * THE SOFTWARE.
26 * TODO: check mixer: see 7.20 of sdk for panning pos (applies to all gus models?)?
29 #include "gustate.h"
30 #include "gusemu.h"
32 #define GUSregb(position) (* (gusptr+(position)))
33 #define GUSregw(position) (*(GUSword *) (gusptr+(position)))
34 #define GUSregd(position) (*(GUSdword *)(gusptr+(position)))
36 /* size given in bytes */
37 unsigned int gus_read(GUSEmuState * state, int port, int size)
39 int value_read = 0;
41 GUSbyte *gusptr;
42 gusptr = state->gusdatapos;
43 GUSregd(portaccesses)++;
45 switch (port & 0xff0f)
47 /* MixerCtrlReg (read not supported on GUS classic) */
48 /* case 0x200: return GUSregb(MixerCtrlReg2x0); */
49 case 0x206: /* IRQstatReg / SB2x6IRQ */
50 /* adlib/sb bits set in port handlers */
51 /* timer/voice bits set in gus_irqgen() */
52 /* dma bit set in gus_dma_transferdata */
53 /* midi not implemented yet */
54 return GUSregb(IRQStatReg2x6);
55 /* case 0x308: */ /* AdLib388 */
56 case 0x208:
57 if (GUSregb(GUS45TimerCtrl) & 1)
58 return GUSregb(TimerStatus2x8);
59 return GUSregb(AdLibStatus2x8); /* AdLibStatus */
60 case 0x309: /* AdLib389 */
61 case 0x209:
62 return GUSregb(AdLibData2x9); /* AdLibData */
63 case 0x20A:
64 return GUSregb(AdLibCommand2xA); /* AdLib2x8_2xA */
66 #if 0
67 case 0x20B: /* GUS hidden registers (read not supported on GUS classic) */
68 switch (GUSregb(RegCtrl_2xF) & 0x07)
70 case 0: /* IRQ/DMA select */
71 if (GUSregb(MixerCtrlReg2x0) & 0x40)
72 return GUSregb(IRQ_2xB); /* control register select bit */
73 else
74 return GUSregb(DMA_2xB);
75 /* case 1-5: */ /* general purpose emulation regs */
76 /* return ... */ /* + status reset reg (write only) */
77 case 6:
78 return GUSregb(Jumper_2xB); /* Joystick/MIDI enable (JumperReg) */
79 default:;
81 break;
82 #endif
84 case 0x20C: /* SB2xCd */
85 value_read = GUSregb(SB2xCd);
86 if (GUSregb(StatRead_2xF) & 0x20)
87 GUSregb(SB2xCd) ^= 0x80; /* toggle MSB on read */
88 return value_read;
89 /* case 0x20D: */ /* SB2xD is write only -> 2xE writes to it*/
90 case 0x20E:
91 if (GUSregb(RegCtrl_2xF) & 0x80) /* 2xE read IRQ enabled? */
93 GUSregb(StatRead_2xF) |= 0x80;
94 GUS_irqrequest(state, state->gusirq, 1);
96 return GUSregb(SB2xE); /* SB2xE */
97 case 0x20F: /* StatRead_2xF */
98 /*set/clear fixed bits */
99 /*value_read = (GUSregb(StatRead_2xF) & 0xf9)|1; */ /*(LSB not set on GUS classic!)*/
100 value_read = (GUSregb(StatRead_2xF) & 0xf9);
101 if (GUSregb(MixerCtrlReg2x0) & 0x08)
102 value_read |= 2; /* DMA/IRQ enabled flag */
103 return value_read;
104 /* case 0x300: */ /* MIDI (not implemented) */
105 /* case 0x301: */ /* MIDI (not implemented) */
106 case 0x302:
107 return GUSregb(VoiceSelReg3x2); /* VoiceSelReg */
108 case 0x303:
109 return GUSregb(FunkSelReg3x3); /* FunkSelReg */
110 case 0x304: /* DataRegLoByte3x4 + DataRegWord3x4 */
111 case 0x305: /* DataRegHiByte3x5 */
112 switch (GUSregb(FunkSelReg3x3))
114 /* common functions */
115 case 0x41: /* DramDMAContrReg */
116 value_read = GUSregb(GUS41DMACtrl); /* &0xfb */
117 GUSregb(GUS41DMACtrl) &= 0xbb;
118 if (state->gusdma >= 4)
119 value_read |= 0x04;
120 if (GUSregb(IRQStatReg2x6) & 0x80)
122 value_read |= 0x40;
123 GUSregb(IRQStatReg2x6) &= 0x7f;
124 if (!GUSregb(IRQStatReg2x6))
125 GUS_irqclear(state, state->gusirq);
127 return (GUSbyte) value_read;
128 /* DramDMAmemPosReg */
129 /* case 0x42: value_read=GUSregw(GUS42DMAStart); break;*/
130 /* 43h+44h write only */
131 case 0x45:
132 return GUSregb(GUS45TimerCtrl); /* TimerCtrlReg */
133 /* 46h+47h write only */
134 /* 48h: samp freq - write only */
135 case 0x49:
136 return GUSregb(GUS49SampCtrl) & 0xbf; /* SampCtrlReg */
137 /* case 4bh: */ /* joystick trim not supported */
138 /* case 0x4c: return GUSregb(GUS4cReset); */ /* GUSreset: write only*/
139 /* voice specific functions */
140 case 0x80:
141 case 0x81:
142 case 0x82:
143 case 0x83:
144 case 0x84:
145 case 0x85:
146 case 0x86:
147 case 0x87:
148 case 0x88:
149 case 0x89:
150 case 0x8a:
151 case 0x8b:
152 case 0x8c:
153 case 0x8d:
155 int offset = 2 * (GUSregb(FunkSelReg3x3) & 0x0f);
156 offset += ((int) GUSregb(VoiceSelReg3x2) & 0x1f) << 5; /* = Voice*32 + Funktion*2 */
157 value_read = GUSregw(offset);
159 break;
160 /* voice unspecific functions */
161 case 0x8e: /* NumVoice */
162 return GUSregb(NumVoices);
163 case 0x8f: /* irqstatreg */
164 /* (pseudo IRQ-FIFO is processed during a gus_write(0x3X3,0x8f)) */
165 return GUSregb(SynVoiceIRQ8f);
166 default:
167 return 0xffff;
169 if (size == 1)
171 if ((port & 0xff0f) == 0x305)
172 value_read = value_read >> 8;
173 value_read &= 0xff;
175 return (GUSword) value_read;
176 /* case 0x306: */ /* Mixer/Version info */
177 /* return 0xff; */ /* Pre 3.6 boards, ICS mixer NOT present */
178 case 0x307: /* DRAMaccess */
180 GUSbyte *adr;
181 adr = state->himemaddr + (GUSregd(GUSDRAMPOS24bit) & 0xfffff);
182 return *adr;
184 default:;
186 return 0xffff;
189 void gus_write(GUSEmuState * state, int port, int size, unsigned int data)
191 GUSbyte *gusptr;
192 gusptr = state->gusdatapos;
193 GUSregd(portaccesses)++;
195 switch (port & 0xff0f)
197 case 0x200: /* MixerCtrlReg */
198 GUSregb(MixerCtrlReg2x0) = (GUSbyte) data;
199 break;
200 case 0x206: /* IRQstatReg / SB2x6IRQ */
201 if (GUSregb(GUS45TimerCtrl) & 0x20) /* SB IRQ enabled? -> set 2x6IRQ bit */
203 GUSregb(TimerStatus2x8) |= 0x08;
204 GUSregb(IRQStatReg2x6) = 0x10;
205 GUS_irqrequest(state, state->gusirq, 1);
207 break;
208 case 0x308: /* AdLib 388h */
209 case 0x208: /* AdLibCommandReg */
210 GUSregb(AdLibCommand2xA) = (GUSbyte) data;
211 break;
212 case 0x309: /* AdLib 389h */
213 case 0x209: /* AdLibDataReg */
214 if ((GUSregb(AdLibCommand2xA) == 0x04) && (!(GUSregb(GUS45TimerCtrl) & 1))) /* GUS auto timer mode enabled? */
216 if (data & 0x80)
217 GUSregb(TimerStatus2x8) &= 0x1f; /* AdLib IRQ reset? -> clear maskable adl. timer int regs */
218 else
219 GUSregb(TimerDataReg2x9) = (GUSbyte) data;
221 else
223 GUSregb(AdLibData2x9) = (GUSbyte) data;
224 if (GUSregb(GUS45TimerCtrl) & 0x02)
226 GUSregb(TimerStatus2x8) |= 0x01;
227 GUSregb(IRQStatReg2x6) = 0x10;
228 GUS_irqrequest(state, state->gusirq, 1);
231 break;
232 case 0x20A:
233 GUSregb(AdLibStatus2x8) = (GUSbyte) data;
234 break; /* AdLibStatus2x8 */
235 case 0x20B: /* GUS hidden registers */
236 switch (GUSregb(RegCtrl_2xF) & 0x7)
238 case 0:
239 if (GUSregb(MixerCtrlReg2x0) & 0x40)
240 GUSregb(IRQ_2xB) = (GUSbyte) data; /* control register select bit */
241 else
242 GUSregb(DMA_2xB) = (GUSbyte) data;
243 break;
244 /* case 1-4: general purpose emulation regs */
245 case 5: /* clear stat reg 2xF */
246 GUSregb(StatRead_2xF) = 0; /* ToDo: is this identical with GUS classic? */
247 if (!GUSregb(IRQStatReg2x6))
248 GUS_irqclear(state, state->gusirq);
249 break;
250 case 6: /* Jumper reg (Joystick/MIDI enable) */
251 GUSregb(Jumper_2xB) = (GUSbyte) data;
252 break;
253 default:;
255 break;
256 case 0x20C: /* SB2xCd */
257 if (GUSregb(GUS45TimerCtrl) & 0x20)
259 GUSregb(TimerStatus2x8) |= 0x10; /* SB IRQ enabled? -> set 2xCIRQ bit */
260 GUSregb(IRQStatReg2x6) = 0x10;
261 GUS_irqrequest(state, state->gusirq, 1);
263 case 0x20D: /* SB2xCd no IRQ */
264 GUSregb(SB2xCd) = (GUSbyte) data;
265 break;
266 case 0x20E: /* SB2xE */
267 GUSregb(SB2xE) = (GUSbyte) data;
268 break;
269 case 0x20F:
270 GUSregb(RegCtrl_2xF) = (GUSbyte) data;
271 break; /* CtrlReg2xF */
272 case 0x302: /* VoiceSelReg */
273 GUSregb(VoiceSelReg3x2) = (GUSbyte) data;
274 break;
275 case 0x303: /* FunkSelReg */
276 GUSregb(FunkSelReg3x3) = (GUSbyte) data;
277 if ((GUSbyte) data == 0x8f) /* set irqstatreg, get voicereg and clear IRQ */
279 int voice;
280 if (GUSregd(voicewavetableirq)) /* WavetableIRQ */
282 for (voice = 0; voice < 31; voice++)
284 if (GUSregd(voicewavetableirq) & (1 << voice))
286 GUSregd(voicewavetableirq) ^= (1 << voice); /* clear IRQ bit */
287 GUSregb(voice << 5) &= 0x7f; /* clear voice reg irq bit */
288 if (!GUSregd(voicewavetableirq))
289 GUSregb(IRQStatReg2x6) &= 0xdf;
290 if (!GUSregb(IRQStatReg2x6))
291 GUS_irqclear(state, state->gusirq);
292 GUSregb(SynVoiceIRQ8f) = voice | 0x60; /* (bit==0 => IRQ wartend) */
293 return;
297 else if (GUSregd(voicevolrampirq)) /* VolRamp IRQ */
299 for (voice = 0; voice < 31; voice++)
301 if (GUSregd(voicevolrampirq) & (1 << voice))
303 GUSregd(voicevolrampirq) ^= (1 << voice); /* clear IRQ bit */
304 GUSregb((voice << 5) + VSRVolRampControl) &= 0x7f; /* clear voice volume reg irq bit */
305 if (!GUSregd(voicevolrampirq))
306 GUSregb(IRQStatReg2x6) &= 0xbf;
307 if (!GUSregb(IRQStatReg2x6))
308 GUS_irqclear(state, state->gusirq);
309 GUSregb(SynVoiceIRQ8f) = voice | 0x80; /* (bit==0 => IRQ wartend) */
310 return;
314 GUSregb(SynVoiceIRQ8f) = 0xe8; /* kein IRQ wartet */
316 break;
317 case 0x304:
318 case 0x305:
320 GUSword writedata = (GUSword) data;
321 GUSword readmask = 0x0000;
322 if (size == 1)
324 readmask = 0xff00;
325 writedata &= 0xff;
326 if ((port & 0xff0f) == 0x305)
328 writedata = (GUSword) (writedata << 8);
329 readmask = 0x00ff;
332 switch (GUSregb(FunkSelReg3x3))
334 /* voice specific functions */
335 case 0x00:
336 case 0x01:
337 case 0x02:
338 case 0x03:
339 case 0x04:
340 case 0x05:
341 case 0x06:
342 case 0x07:
343 case 0x08:
344 case 0x09:
345 case 0x0a:
346 case 0x0b:
347 case 0x0c:
348 case 0x0d:
350 int offset;
351 if (!(GUSregb(GUS4cReset) & 0x01))
352 break; /* reset flag active? */
353 offset = 2 * (GUSregb(FunkSelReg3x3) & 0x0f);
354 offset += (GUSregb(VoiceSelReg3x2) & 0x1f) << 5; /* = Voice*32 + Funktion*2 */
355 GUSregw(offset) = (GUSword) ((GUSregw(offset) & readmask) | writedata);
357 break;
358 /* voice unspecific functions */
359 case 0x0e: /* NumVoices */
360 GUSregb(NumVoices) = (GUSbyte) data;
361 break;
362 /* case 0x0f: */ /* read only */
363 /* common functions */
364 case 0x41: /* DramDMAContrReg */
365 GUSregb(GUS41DMACtrl) = (GUSbyte) data;
366 if (data & 0x01)
367 GUS_dmarequest(state);
368 break;
369 case 0x42: /* DramDMAmemPosReg */
370 GUSregw(GUS42DMAStart) = (GUSregw(GUS42DMAStart) & readmask) | writedata;
371 GUSregb(GUS50DMAHigh) &= 0xf; /* compatibility stuff... */
372 break;
373 case 0x43: /* DRAMaddrLo */
374 GUSregd(GUSDRAMPOS24bit) =
375 (GUSregd(GUSDRAMPOS24bit) & (readmask | 0xff0000)) | writedata;
376 break;
377 case 0x44: /* DRAMaddrHi */
378 GUSregd(GUSDRAMPOS24bit) =
379 (GUSregd(GUSDRAMPOS24bit) & 0xffff) | ((data & 0x0f) << 16);
380 break;
381 case 0x45: /* TCtrlReg */
382 GUSregb(GUS45TimerCtrl) = (GUSbyte) data;
383 if (!(data & 0x20))
384 GUSregb(TimerStatus2x8) &= 0xe7; /* sb IRQ dis? -> clear 2x8/2xC sb IRQ flags */
385 if (!(data & 0x02))
386 GUSregb(TimerStatus2x8) &= 0xfe; /* adlib data IRQ dis? -> clear 2x8 adlib IRQ flag */
387 if (!(GUSregb(TimerStatus2x8) & 0x19))
388 GUSregb(IRQStatReg2x6) &= 0xef; /* 0xe6; $$clear IRQ if both IRQ bits are inactive or cleared */
389 /* catch up delayed timer IRQs: */
390 if ((GUSregw(TimerIRQs) > 1) && (GUSregb(TimerDataReg2x9) & 3))
392 if (GUSregb(TimerDataReg2x9) & 1) /* start timer 1 (80us decrement rate) */
394 if (!(GUSregb(TimerDataReg2x9) & 0x40))
395 GUSregb(TimerStatus2x8) |= 0xc0; /* maskable bits */
396 if (data & 4) /* timer1 irq enable */
398 GUSregb(TimerStatus2x8) |= 4; /* nonmaskable bit */
399 GUSregb(IRQStatReg2x6) |= 4; /* timer 1 irq pending */
402 if (GUSregb(TimerDataReg2x9) & 2) /* start timer 2 (320us decrement rate) */
404 if (!(GUSregb(TimerDataReg2x9) & 0x20))
405 GUSregb(TimerStatus2x8) |= 0xa0; /* maskable bits */
406 if (data & 8) /* timer2 irq enable */
408 GUSregb(TimerStatus2x8) |= 2; /* nonmaskable bit */
409 GUSregb(IRQStatReg2x6) |= 8; /* timer 2 irq pending */
412 GUSregw(TimerIRQs)--;
413 if (GUSregw(BusyTimerIRQs) > 1)
414 GUSregw(BusyTimerIRQs)--;
415 else
416 GUSregw(BusyTimerIRQs) =
417 GUS_irqrequest(state, state->gusirq, GUSregw(TimerIRQs));
419 else
420 GUSregw(TimerIRQs) = 0;
422 if (!(data & 0x04))
424 GUSregb(TimerStatus2x8) &= 0xfb; /* clear non-maskable timer1 bit */
425 GUSregb(IRQStatReg2x6) &= 0xfb;
427 if (!(data & 0x08))
429 GUSregb(TimerStatus2x8) &= 0xfd; /* clear non-maskable timer2 bit */
430 GUSregb(IRQStatReg2x6) &= 0xf7;
432 if (!GUSregb(IRQStatReg2x6))
433 GUS_irqclear(state, state->gusirq);
434 break;
435 case 0x46: /* Counter1 */
436 GUSregb(GUS46Counter1) = (GUSbyte) data;
437 break;
438 case 0x47: /* Counter2 */
439 GUSregb(GUS47Counter2) = (GUSbyte) data;
440 break;
441 /* case 0x48: */ /* sampling freq reg not emulated (same as interwave) */
442 case 0x49: /* SampCtrlReg */
443 GUSregb(GUS49SampCtrl) = (GUSbyte) data;
444 break;
445 /* case 0x4b: */ /* joystick trim not emulated */
446 case 0x4c: /* GUSreset */
447 GUSregb(GUS4cReset) = (GUSbyte) data;
448 if (!(GUSregb(GUS4cReset) & 1)) /* reset... */
450 GUSregd(voicewavetableirq) = 0;
451 GUSregd(voicevolrampirq) = 0;
452 GUSregw(TimerIRQs) = 0;
453 GUSregw(BusyTimerIRQs) = 0;
454 GUSregb(NumVoices) = 0xcd;
455 GUSregb(IRQStatReg2x6) = 0;
456 GUSregb(TimerStatus2x8) = 0;
457 GUSregb(AdLibData2x9) = 0;
458 GUSregb(TimerDataReg2x9) = 0;
459 GUSregb(GUS41DMACtrl) = 0;
460 GUSregb(GUS45TimerCtrl) = 0;
461 GUSregb(GUS49SampCtrl) = 0;
462 GUSregb(GUS4cReset) &= 0xf9; /* clear IRQ and DAC enable bits */
463 GUS_irqclear(state, state->gusirq);
465 /* IRQ enable bit checked elsewhere */
466 /* EnableDAC bit may be used by external callers */
467 break;
470 break;
471 case 0x307: /* DRAMaccess */
473 GUSbyte *adr;
474 adr = state->himemaddr + (GUSregd(GUSDRAMPOS24bit) & 0xfffff);
475 *adr = (GUSbyte) data;
477 break;
481 /* Attention when breaking up a single DMA transfer to multiple ones:
482 * it may lead to multiple terminal count interrupts and broken transfers:
484 * 1. Whenever you transfer a piece of data, the gusemu callback is invoked
485 * 2. The callback may generate a TC irq (if the register was set up to do so)
486 * 3. The irq may result in the program using the GUS to reprogram the GUS
488 * Some programs also decide to upload by just checking if TC occurs
489 * (via interrupt or a cleared GUS dma flag)
490 * and then start the next transfer, without checking DMA state
492 * Thus: Always make sure to set the TC flag correctly!
494 * Note that the genuine GUS had a granularity of 16 bytes/words for low/high DMA
495 * while later cards had atomic granularity provided by an additional GUS50DMAHigh register
496 * GUSemu also uses this register to support byte-granular transfers for better compatibility
497 * with emulators other than GUSemu32
500 void gus_dma_transferdata(GUSEmuState * state, char *dma_addr, unsigned int count, int TC)
502 /* this function gets called by the callback function as soon as a DMA transfer is about to start
503 * dma_addr is a translated address within accessible memory, not the physical one,
504 * count is (real dma count register)+1
505 * note that the amount of bytes transfered is fully determined by values in the DMA registers
506 * do not forget to update DMA states after transferring the entire block:
507 * DREQ cleared & TC asserted after the _whole_ transfer */
509 char *srcaddr;
510 char *destaddr;
511 char msbmask = 0;
512 GUSbyte *gusptr;
513 gusptr = state->gusdatapos;
515 srcaddr = dma_addr; /* system memory address */
517 int offset = (GUSregw(GUS42DMAStart) << 4) + (GUSregb(GUS50DMAHigh) & 0xf);
518 if (state->gusdma >= 4)
519 offset = (offset & 0xc0000) + (2 * (offset & 0x1fff0)); /* 16 bit address translation */
520 destaddr = (char *) state->himemaddr + offset; /* wavetable RAM adress */
523 GUSregw(GUS42DMAStart) += (GUSword) (count >> 4); /* ToDo: add 16bit GUS page limit? */
524 GUSregb(GUS50DMAHigh) = (GUSbyte) ((count + GUSregb(GUS50DMAHigh)) & 0xf); /* ToDo: add 16bit GUS page limit? */
526 if (GUSregb(GUS41DMACtrl) & 0x02) /* direction, 0 := sysram->gusram */
528 char *tmpaddr = destaddr;
529 destaddr = srcaddr;
530 srcaddr = tmpaddr;
533 if ((GUSregb(GUS41DMACtrl) & 0x80) && (!(GUSregb(GUS41DMACtrl) & 0x02)))
534 msbmask = (const char) 0x80; /* invert MSB */
535 for (; count > 0; count--)
537 if (GUSregb(GUS41DMACtrl) & 0x40)
538 *(destaddr++) = *(srcaddr++); /* 16 bit lobyte */
539 else
540 *(destaddr++) = (msbmask ^ (*(srcaddr++))); /* 8 bit */
541 if (state->gusdma >= 4)
542 *(destaddr++) = (msbmask ^ (*(srcaddr++))); /* 16 bit hibyte */
545 if (TC)
547 (GUSregb(GUS41DMACtrl)) &= 0xfe; /* clear DMA request bit */
548 if (GUSregb(GUS41DMACtrl) & 0x20) /* DMA terminal count IRQ */
550 GUSregb(IRQStatReg2x6) |= 0x80;
551 GUS_irqrequest(state, state->gusirq, 1);