Add qemu 2.4.0
[kvmfornfv.git] / qemu / hw / audio / gusemu_hal.c
1 /*
2  * GUSEMU32 - bus interface part
3  *
4  * Copyright (C) 2000-2007 Tibor "TS" Schütz
5  *
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:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
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.
23  */
24
25 /*
26  * TODO: check mixer: see 7.20 of sdk for panning pos (applies to all gus models?)?
27  */
28
29 #include "gustate.h"
30 #include "gusemu.h"
31
32 #define GUSregb(position) (*            (gusptr+(position)))
33 #define GUSregw(position) (*(GUSword *) (gusptr+(position)))
34 #define GUSregd(position) (*(GUSdword *)(gusptr+(position)))
35
36 /* size given in bytes */
37 unsigned int gus_read(GUSEmuState * state, int port, int size)
38 {
39     int             value_read = 0;
40
41     GUSbyte        *gusptr;
42     gusptr = state->gusdatapos;
43     GUSregd(portaccesses)++;
44
45     switch (port & 0xff0f)
46     {
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 */
65
66 #if 0
67     case 0x20B:                          /* GUS hidden registers (read not supported on GUS classic) */
68         switch (GUSregb(RegCtrl_2xF) & 0x07)
69         {
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:;
80         }
81         break;
82 #endif
83
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? */
92         {
93             GUSregb(StatRead_2xF) |= 0x80;
94             GUS_irqrequest(state, state->gusirq, 1);
95         }
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))
113         {
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)
121             {
122                 value_read |= 0x40;
123                 GUSregb(IRQStatReg2x6) &= 0x7f;
124                 if (!GUSregb(IRQStatReg2x6))
125                     GUS_irqclear(state, state->gusirq);
126             }
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:
154             {
155                 int             offset = 2 * (GUSregb(FunkSelReg3x3) & 0x0f);
156                 offset += ((int) GUSregb(VoiceSelReg3x2) & 0x1f) << 5; /* = Voice*32 + Funktion*2 */
157                 value_read = GUSregw(offset);
158             }
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;
168         }
169         if (size == 1)
170         {
171             if ((port & 0xff0f) == 0x305)
172                 value_read = value_read >> 8;
173             value_read &= 0xff;
174         }
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 */
179         {
180             GUSbyte        *adr;
181             adr = state->himemaddr + (GUSregd(GUSDRAMPOS24bit) & 0xfffff);
182             return *adr;
183         }
184     default:;
185     }
186     return 0xffff;
187 }
188
189 void gus_write(GUSEmuState * state, int port, int size, unsigned int data)
190 {
191     GUSbyte        *gusptr;
192     gusptr = state->gusdatapos;
193     GUSregd(portaccesses)++;
194
195     switch (port & 0xff0f)
196     {
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 */
202         {
203             GUSregb(TimerStatus2x8) |= 0x08;
204             GUSregb(IRQStatReg2x6) = 0x10;
205             GUS_irqrequest(state, state->gusirq, 1);
206         }
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? */
215         {
216             if (data & 0x80)
217                 GUSregb(TimerStatus2x8) &= 0x1f; /* AdLib IRQ reset? -> clear maskable adl. timer int regs */
218             else
219                 GUSregb(TimerDataReg2x9) = (GUSbyte) data;
220         }
221         else
222         {
223             GUSregb(AdLibData2x9) = (GUSbyte) data;
224             if (GUSregb(GUS45TimerCtrl) & 0x02)
225             {
226                 GUSregb(TimerStatus2x8) |= 0x01;
227                 GUSregb(IRQStatReg2x6) = 0x10;
228                 GUS_irqrequest(state, state->gusirq, 1);
229             }
230         }
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)
237         {
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:;
254         }
255         break;
256     case 0x20C:                /* SB2xCd */
257         if (GUSregb(GUS45TimerCtrl) & 0x20)
258         {
259             GUSregb(TimerStatus2x8) |= 0x10; /* SB IRQ enabled? -> set 2xCIRQ bit */
260             GUSregb(IRQStatReg2x6) = 0x10;
261             GUS_irqrequest(state, state->gusirq, 1);
262         }
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 */
278         {
279             int             voice;
280             if (GUSregd(voicewavetableirq)) /* WavetableIRQ */
281             {
282                 for (voice = 0; voice < 31; voice++)
283                 {
284                     if (GUSregd(voicewavetableirq) & (1 << voice))
285                     {
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;
294                     }
295                 }
296             }
297             else if (GUSregd(voicevolrampirq)) /* VolRamp IRQ */
298             {
299                 for (voice = 0; voice < 31; voice++)
300                 {
301                     if (GUSregd(voicevolrampirq) & (1 << voice))
302                     {
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;
311                     }
312                 }
313             }
314             GUSregb(SynVoiceIRQ8f) = 0xe8; /* kein IRQ wartet */
315         }
316         break;
317     case 0x304:
318     case 0x305:
319         {
320             GUSword         writedata = (GUSword) data;
321             GUSword         readmask = 0x0000;
322             if (size == 1)
323             {
324                 readmask = 0xff00;
325                 writedata &= 0xff;
326                 if ((port & 0xff0f) == 0x305)
327                 {
328                     writedata = (GUSword) (writedata << 8);
329                     readmask = 0x00ff;
330                 }
331             }
332             switch (GUSregb(FunkSelReg3x3))
333             {
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:
349                 {
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);
356                 }
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))
391                 {
392                     if (GUSregb(TimerDataReg2x9) & 1)   /* start timer 1 (80us decrement rate) */
393                     {
394                         if (!(GUSregb(TimerDataReg2x9) & 0x40))
395                             GUSregb(TimerStatus2x8) |= 0xc0;    /* maskable bits */
396                         if (data & 4) /* timer1 irq enable */
397                         {
398                             GUSregb(TimerStatus2x8) |= 4;       /* nonmaskable bit */
399                             GUSregb(IRQStatReg2x6) |= 4;        /* timer 1 irq pending */
400                         }
401                     }
402                     if (GUSregb(TimerDataReg2x9) & 2)   /* start timer 2 (320us decrement rate) */
403                     {
404                         if (!(GUSregb(TimerDataReg2x9) & 0x20))
405                             GUSregb(TimerStatus2x8) |= 0xa0;    /* maskable bits */
406                         if (data & 8) /* timer2 irq enable */
407                         {
408                             GUSregb(TimerStatus2x8) |= 2;       /* nonmaskable bit */
409                             GUSregb(IRQStatReg2x6) |= 8;        /* timer 2 irq pending */
410                         }
411                     }
412                     GUSregw(TimerIRQs)--;
413                     if (GUSregw(BusyTimerIRQs) > 1)
414                         GUSregw(BusyTimerIRQs)--;
415                     else
416                         GUSregw(BusyTimerIRQs) =
417                             GUS_irqrequest(state, state->gusirq, GUSregw(TimerIRQs));
418                 }
419                 else
420                     GUSregw(TimerIRQs) = 0;
421
422                 if (!(data & 0x04))
423                 {
424                     GUSregb(TimerStatus2x8) &= 0xfb; /* clear non-maskable timer1 bit */
425                     GUSregb(IRQStatReg2x6)  &= 0xfb;
426                 }
427                 if (!(data & 0x08))
428                 {
429                     GUSregb(TimerStatus2x8) &= 0xfd; /* clear non-maskable timer2 bit */
430                     GUSregb(IRQStatReg2x6)  &= 0xf7;
431                 }
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... */
449                 {
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);
464                 }
465                 /* IRQ enable bit checked elsewhere */
466                 /* EnableDAC bit may be used by external callers */
467                 break;
468             }
469         }
470         break;
471     case 0x307:                /* DRAMaccess */
472         {
473             GUSbyte        *adr;
474             adr = state->himemaddr + (GUSregd(GUSDRAMPOS24bit) & 0xfffff);
475             *adr = (GUSbyte) data;
476         }
477         break;
478     }
479 }
480
481 /* Attention when breaking up a single DMA transfer to multiple ones:
482  * it may lead to multiple terminal count interrupts and broken transfers:
483  *
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
487  *
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
491  *
492  * Thus: Always make sure to set the TC flag correctly!
493  *
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
498  */
499
500 void gus_dma_transferdata(GUSEmuState * state, char *dma_addr, unsigned int count, int TC)
501 {
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 transferred 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 */
508
509     char           *srcaddr;
510     char           *destaddr;
511     char            msbmask = 0;
512     GUSbyte        *gusptr;
513     gusptr = state->gusdatapos;
514
515     srcaddr = dma_addr; /* system memory address */
516     {
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 address */
521     }
522
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? */
525
526     if (GUSregb(GUS41DMACtrl) & 0x02)   /* direction, 0 := sysram->gusram */
527     {
528         char           *tmpaddr = destaddr;
529         destaddr = srcaddr;
530         srcaddr = tmpaddr;
531     }
532
533     if ((GUSregb(GUS41DMACtrl) & 0x80) && (!(GUSregb(GUS41DMACtrl) & 0x02)))
534         msbmask = (const char) 0x80;    /* invert MSB */
535     for (; count > 0; count--)
536     {
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 */
543     }
544
545     if (TC)
546     {
547         (GUSregb(GUS41DMACtrl)) &= 0xfe;        /* clear DMA request bit */
548         if (GUSregb(GUS41DMACtrl) & 0x20)       /* DMA terminal count IRQ */
549         {
550             GUSregb(IRQStatReg2x6) |= 0x80;
551             GUS_irqrequest(state, state->gusirq, 1);
552         }
553     }
554 }