/*

   Name:
   DRV_GUS.C

   Description:
   Mikmod driver for output on Gravis Ultrasound (native mode i.e. using
   the onboard DRAM)

   Portability:

   MSDOS:       BC(y)   Watcom(y)       DJGPP(y)
   Win95:       n
   Os2: n
   Linux:       n

   (y) - yes
   (n) - no (not possible or not useful)
   (?) - may be possible, but not tested

 */
#include <dos.h>
#include <stdio.h>
#include <stdlib.h>
#include <conio.h>
#include "mikmod.h"
#include "mirq.h"

/***************************************************************************
>>>>>>>>>>>>>>>>>>>>>>>>> Lowlevel GUS defines <<<<<<<<<<<<<<<<<<<<<<<<<<<<<
***************************************************************************/

/* Special macros for Least-most sig. bytes */
#define MAKE_MSW(x)     ((long)((long)(x)) << 16)
#define LSW(x)          ((unsigned int)(x))
#define MSW(x)          ((unsigned int)(((long)x)>>16))
#define MSB(x)          (unsigned char)((unsigned int)(x)>>8)
#define LSB(x)          ((unsigned char)(x))

/* Make GF1 address for direct chip i/o. */
#define ADDR_HIGH(x) ((unsigned int)((unsigned int)((x>>7L)&0x1fffL)))
#define ADDR_LOW(x)  ((unsigned int)((unsigned int)((x&0x7fL)<<9L)))

#define JOYSTICK_TIMER  (GUS_PORT+0x201)	/* 201 */
#define JOYSTICK_DATA   (GUS_PORT+0x201)	/* 201 */

#define GF1_MIDI_CTRL   (GUS_PORT+0x100)	/* 3X0 */
#define GF1_MIDI_DATA   (GUS_PORT+0x101)	/* 3X1 */

#define GF1_PAGE        (GUS_PORT+0x102)	/* 3X2 */
#define GF1_REG_SELECT  (GUS_PORT+0x103)	/* 3X3 */
#define GF1_VOICE_SELECT (GUS_PORT+0x102)	/* 3X3 */
#define GF1_DATA_LOW    (GUS_PORT+0x104)	/* 3X4 */
#define GF1_DATA_HI     (GUS_PORT+0x105)	/* 3X5 */
#define GF1_IRQ_STAT    (GUS_PORT+0x006)	/* 2X6 */
#define GF1_DRAM        (GUS_PORT+0x107)	/* 3X7 */

#define GF1_MIX_CTRL    (GUS_PORT+0x000)	/* 2X0 */
#define GF1_TIMER_CTRL  (GUS_PORT+0x008)	/* 2X8 */
#define GF1_TIMER_DATA  (GUS_PORT+0x009)	/* 2X9 */
#define GF1_IRQ_CTRL    (GUS_PORT+0x00B)	/* 2XB */

/* The GF1 Hardware clock. */
#define CLOCK_RATE              9878400L

/* Mixer control bits. */
#define ENABLE_LINE             0x01
#define ENABLE_DAC              0x02
#define ENABLE_MIC              0x04

/* interrupt controller 1 */
#define CNTRL_8259              0x21
#define OCR_8259                0x20
#define EOI                     0x20
#define REARM3                  0x2F3
#define REARM5                  0x2F5

/* interrupt controller 2 */
#define CNTRL_M_8259			0x21
#define CNTRL_M2_8259  			0xA1
#define OCR_2_8259              0xA0

#define DMA_CONTROL             0x41
#define SET_DMA_ADDRESS         0x42
#define SET_DRAM_LOW            0x43
#define SET_DRAM_HIGH           0x44

#define TIMER_CONTROL           0x45
#define TIMER1                  0x46
#define TIMER2                  0x47

#define SET_SAMPLE_RATE         0x48
#define SAMPLE_CONTROL          0x49

#define SET_JOYSTICK            0x4B
#define MASTER_RESET            0x4C

/* Voice register mapping. */
#define SET_CONTROL                     0x00
#define SET_FREQUENCY           0x01
#define SET_START_HIGH          0x02
#define SET_START_LOW           0x03
#define SET_END_HIGH            0x04
#define SET_END_LOW                     0x05
#define SET_VOLUME_RATE         0x06
#define SET_VOLUME_START        0x07
#define SET_VOLUME_END          0x08
#define SET_VOLUME                      0x09
#define SET_ACC_HIGH            0x0a
#define SET_ACC_LOW                     0x0b
#define SET_BALANCE                     0x0c
#define SET_VOLUME_CONTROL      0x0d
#define SET_VOICES                      0x0e

#define GET_CONTROL                     0x80
#define GET_FREQUENCY           0x81
#define GET_START_HIGH          0x82
#define GET_START_LOW           0x83
#define GET_END_HIGH            0x84
#define GET_END_LOW                     0x85
#define GET_VOLUME_RATE         0x86
#define GET_VOLUME_START        0x87
#define GET_VOLUME_END          0x88
#define GET_VOLUME                      0x89
#define GET_ACC_HIGH            0x8a
#define GET_ACC_LOW                     0x8b
#define GET_BALANCE                     0x8c
#define GET_VOLUME_CONTROL      0x8d
#define GET_VOICES                      0x8e
#define GET_IRQV                        0x8f

/********************************************************************
 *
 * MIDI defines
 *
 *******************************************************************/

#define MIDI_RESET      0x03
#define MIDI_ENABLE_XMIT        0x20
#define MIDI_ENABLE_RCV         0x80

#define MIDI_RCV_FULL           0x01
#define MIDI_XMIT_EMPTY         0x02
#define MIDI_FRAME_ERR          0x10
#define MIDI_OVERRUN            0x20
#define MIDI_IRQ_PEND           0x80

/********************************************************************
 *
 * JOYSTICK defines
 *
 *******************************************************************/

#define JOY_POSITION            0x0f
#define JOY_BUTTONS                     0xf0

/********************************************************************
 *
 * GF1 irq/dma programmable latches
 *
 *******************************************************************/

/* GF1_IRQ_STATUS (port 3X6) */
#define MIDI_TX_IRQ                     0x01	/* pending MIDI xmit IRQ */
#define MIDI_RX_IRQ                     0x02	/* pending MIDI recv IRQ */
#define GF1_TIMER1_IRQ          0x04	/* general purpose timer */
#define GF1_TIMER2_IRQ          0x08	/* general purpose timer */
#define WAVETABLE_IRQ           0x20	/* pending wavetable IRQ */
#define ENVELOPE_IRQ            0x40	/* pending volume envelope IRQ */
#define DMA_TC_IRQ                      0x80	/* pending dma tc IRQ */


/* GF1_MIX_CTRL (port 2X0) */
#define ENABLE_LINE_IN          0x01	/* 0=enable */
#define ENABLE_OUTPUT           0x02	/* 0=enable */
#define ENABLE_MIC_IN           0x04	/* 1=enable */
#define ENABLE_GF1_IRQ          0x08	/* 1=enable */
#define GF122                           0x10	/* ?? */
#define ENABLE_MIDI_LOOP        0x20	/* 1=enable loop back */
#define SELECT_GF1_REG          0x40	/* 0=irq latches */
										/* 1=dma latches */

/********************************************************************
 *
 * GF1 global registers ($41-$4C)
 *
 *******************************************************************/

/* DMA control register */
#define DMA_ENABLE                      0x01
#define DMA_READ                        0x02	/* 1=read,0=write */
#define DMA_WIDTH_16            0x04	/* 1=16 bit,0=8 bit (dma chan width) */
#define DMA_RATE                        0x18	/* 00=fast, 11=slow */
#define DMA_IRQ_ENABLE          0x20	/* 1=enable */
#define DMA_IRQ_PENDING         0x40	/* read */
#define DMA_DATA_16                     0x40	/* write (data width) */
#define DMA_TWOS_COMP           0x80	/* 1=do twos comp */

/* These are the xfer rate bits ... */
#define DMA_R0          0x00	/* Fastest DMA xfer (~650khz) */
#define DMA_R1          0x08	/* fastest / 2 */
#define DMA_R2          0x10	/* fastest / 4 */
#define DMA_R3          0x18	/* Slowest DMA xfer (fastest / 8) */

/* SAMPLE control register */
#define ENABLE_ADC                      0x01
#define ADC_MODE                        0x02	/* 0=mono, 1=stereo */
#define ADC_DMA_WIDTH           0x04	/* 0=8 bit, 1=16 bit */
#define ADC_IRQ_ENABLE          0x20	/* 1=enable */
#define ADC_IRQ_PENDING         0x40	/* 1=irq pending */
#define ADC_TWOS_COMP           0x80	/* 1=do twos comp */

/* RESET control register */
#define GF1_MASTER_RESET        0x01	/* 0=hold in reset */
#define GF1_OUTPUT_ENABLE       0x02	/* enable output */
#define GF1_MASTER_IRQ          0x04	/* master IRQ enable */

/********************************************************************
 *
 * GF1 voice specific registers ($00 - $0E and $80-$8f)
 *
 *******************************************************************/

/* ($0,$80) Voice control register */
#define VOICE_STOPPED           0x01	/* voice has stopped */
#define STOP_VOICE                      0x02	/* stop voice */
#define VC_DATA_TYPE            0x04	/* 0=8 bit,1=16 bit */
#define VC_LOOP_ENABLE          0x08	/* 1=enable */
#define VC_BI_LOOP                      0x10	/* 1=bi directional looping */
#define VC_WAVE_IRQ                     0x20	/* 1=enable voice's wave irq */
#define VC_DIRECT                       0x40	/* 0=increasing,1=decreasing */
#define VC_IRQ_PENDING          0x80	/* 1=wavetable irq pending */

/* ($1,$81) Frequency control */
/* Bit 0  - Unused */
/* Bits 1-9 - Fractional portion */
/* Bits 10-15 - Integer portion */

/* ($2,$82) Accumulator start address (high) */
/* Bits 0-11 - HIGH 12 bits of address */
/* Bits 12-15 - Unused */

/* ($3,$83) Accumulator start address (low) */
/* Bits 0-4 - Unused */
/* Bits 5-8 - Fractional portion */
/* Bits 9-15 - Low 7 bits of integer portion */

/* ($4,$84) Accumulator end address (high) */
/* Bits 0-11 - HIGH 12 bits of address */
/* Bits 12-15 - Unused */

/* ($5,$85) Accumulator end address (low) */
/* Bits 0-4 - Unused */
/* Bits 5-8 - Fractional portion */
/* Bits 9-15 - Low 7 bits of integer portion */


/* ($6,$86) Volume Envelope control register */
#define VL_RATE_MANTISSA                0x3f
#define VL_RATE_RANGE                   0xC0

/* ($7,$87) Volume envelope start */
#define VL_START_MANT                   0x0F
#define VL_START_EXP                    0xF0

/* ($8,$88) Volume envelope end */
#define VL_END_MANT                             0x0F
#define VL_END_EXP                              0xF0

/* ($9,$89) Current volume register */
/* Bits 0-3 are unused */
/* Bits 4-11 - Mantissa of current volume */
/* Bits 10-15 - Exponent of current volume */

/* ($A,$8A) Accumulator value (high) */
/* Bits 0-12 - HIGH 12 bits of current position (a19-a7) */

/* ($B,$8B) Accumulator value (low) */
/* Bits 0-8 - Fractional portion */
/* Bits 9-15 - Integer portion of low adress (a6-a0) */

/* ($C,$8C) Pan (balance) position */
/* Bits 0-3 - Balance position  0=full left, 0x0f=full right */

/* ($D,$8D) Volume control register */
#define VOLUME_STOPPED          0x01	/* volume has stopped */
#define STOP_VOLUME                     0x02	/* stop volume */
#define VC_ROLLOVER                     0x04	/* Roll PAST end & gen IRQ */
#define VL_LOOP_ENABLE          0x08	/* 1=enable */
#define VL_BI_LOOP                      0x10	/* 1=bi directional looping */
#define VL_WAVE_IRQ                     0x20	/* 1=enable voice's wave irq */
#define VL_DIRECT                       0x40	/* 0=increasing,1=decreasing */
#define VL_IRQ_PENDING          0x80	/* 1=wavetable irq pending */

/* ($E,$8E) # of Active voices */
/* Bits 0-5 - # of active voices -1 */

/* ($F,$8F) - Sources of IRQs */
/* Bits 0-4 - interrupting voice number */
/* Bit 5 - Always a 1 */
#define VOICE_VOLUME_IRQ        0x40	/* individual voice irq bit */
#define VOICE_WAVE_IRQ          0x80	/* individual waveform irq bit */


/***************************************************************************
>>>>>>>>>>>>>>>>>>>>>>>>> Lowlevel GUS code <<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<<
***************************************************************************/

static UWORD GUS_PORT;
static UBYTE GUS_VOICES;
static UBYTE GUS_TIMER_CTRL;
static UBYTE GUS_TIMER_MASK;
static UBYTE GUS_MIX_IMAGE;

static UWORD GUS_DRAM_DMA;
static UWORD GUS_ADC_DMA;
static UWORD GUS_GF1_IRQ;
static UWORD GUS_MIDI_IRQ;
static ULONG GUS_POOL;		/* dram address of first gusmem pool node */

static UBYTE GUS_SELECT;	/* currently selected GF1 register */

static void (*GUS_TIMER1_FUNC) (void);
static void (*GUS_TIMER2_FUNC) (void);

#define UltraSelect(x) outportb(GF1_REG_SELECT,GUS_SELECT=x)

#define USE_ROLLOVER 0

/***************************************************************
 * This function will convert the value read from the GF1 registers
 * back to a 'real' address.
 ***************************************************************/

#define MAKE_MS_SWORD( x )       ((unsigned long)((unsigned long)(x)) << 16)

static ULONG make_physical_address(UWORD low, UWORD high, UBYTE mode)
{
    UWORD lower_16, upper_16;
    ULONG ret_address, bit_19_20;

    upper_16 = high >> 9;
    lower_16 = ((high & 0x01ff) << 7) | ((low >> 9) & 0x007f);

    ret_address = MAKE_MS_SWORD(upper_16) + lower_16;

    if (mode & VC_DATA_TYPE) {
	bit_19_20 = ret_address & 0xC0000;
	ret_address <<= 1;
	ret_address &= 0x3ffff;
	ret_address |= bit_19_20;
    }

    return (ret_address);
}

/***************************************************************
 * This function will translate the address if the dma channel
 * is a 16 bit channel. This translation is not necessary for
 * an 8 bit dma channel.
 ***************************************************************/

static ULONG convert_to_16bit(ULONG address)
/* unsigned long address;               /* 20 bit ultrasound dram address */
{
    ULONG hold_address;

    hold_address = address;

    /* Convert to 16 translated address. */
    address = address >> 1;

    /* Zero out bit 17. */
    address &= 0x0001ffffL;

    /* Reset bits 18 and 19. */
    address |= (hold_address & 0x000c0000L);

    return (address);
}


static void GF1OutB(UBYTE x, UBYTE y)
{
    UltraSelect(x);
    outportb(GF1_DATA_HI, y);
}


static void GF1OutW(UBYTE x, UWORD y)
{
    UltraSelect(x);
    outport(GF1_DATA_LOW, y);
}


static UBYTE GF1InB(UBYTE x)
{
    UltraSelect(x);
    return inportb(GF1_DATA_HI);
}


static UWORD GF1InW(UBYTE x)
{
    UltraSelect(x);
    return inport(GF1_DATA_LOW);
}


static void gf1_delay(void)
{
    inportb(GF1_DRAM);
    inportb(GF1_DRAM);
    inportb(GF1_DRAM);
    inportb(GF1_DRAM);
    inportb(GF1_DRAM);
    inportb(GF1_DRAM);
    inportb(GF1_DRAM);
}


static UBYTE UltraPeek(ULONG address)
{
    GF1OutW(SET_DRAM_LOW, address);
    GF1OutB(SET_DRAM_HIGH, (address >> 16) & 0xff);	/* 8 bits */
    return (inportb(GF1_DRAM));
}


static void UltraPoke(ULONG address, UBYTE data)
{
    GF1OutW(SET_DRAM_LOW, address);
    GF1OutB(SET_DRAM_HIGH, (address >> 16) & 0xff);
    outportb(GF1_DRAM, data);
}


static void UltraPokeFast(ULONG address, UBYTE * src, ULONG size)
/*
   [address,size> doesn't cross 64k page boundary
 */
{
    if (!size)
	return;

    UltraSelect(SET_DRAM_HIGH);
    outportb(GF1_DATA_HI, (address >> 16) & 0xff);	/* 8 bits */
    UltraSelect(SET_DRAM_LOW);

    while (size--) {
	outport(GF1_DATA_LOW, address);
	outportb(GF1_DRAM, *src);
	address++;
	src++;
    }
}


static void UltraPokeChunk(ULONG address, UBYTE * src, ULONG size)
{
    ULONG todo;

    /* first 'todo' is number of bytes 'till first 64k boundary */

    todo = 0x10000 - (address & 0xffff);
    if (todo > size)
	todo = size;

    do {
	UltraPokeFast(address, src, todo);
	address += todo;
	src += todo;
	size -= todo;

	/* next 'todo' is in chunks of max 64k at once. */
	todo = (size > 0xffff) ? 0x10000 : size;

    } while (todo);
}


static ULONG UltraPeekLong(ULONG address)
{
    ULONG data;
    char *s = (char *) &data;
    s[0] = UltraPeek(address);
    s[1] = UltraPeek(address + 1);
    s[2] = UltraPeek(address + 2);
    s[3] = UltraPeek(address + 3);
    return data;
}


static void UltraPokeLong(ULONG address, ULONG data)
{
    UltraPokeChunk(address, (UBYTE *) & data, 4);
}


static void UltraEnableOutput(void)
{
    GUS_MIX_IMAGE &= ~ENABLE_OUTPUT;
    outportb(GF1_MIX_CTRL, GUS_MIX_IMAGE);
}

static void UltraDisableOutput(void)
{
    GUS_MIX_IMAGE |= ENABLE_OUTPUT;
    outportb(GF1_MIX_CTRL, GUS_MIX_IMAGE);
}

static void UltraEnableLineIn(void)
{
    GUS_MIX_IMAGE &= ~ENABLE_LINE_IN;
    outportb(GF1_MIX_CTRL, GUS_MIX_IMAGE);
}

static void UltraDisableLineIn(void)
{
    GUS_MIX_IMAGE |= ENABLE_LINE_IN;
    outportb(GF1_MIX_CTRL, GUS_MIX_IMAGE);
}

static void UltraEnableMicIn(void)
{
    GUS_MIX_IMAGE |= ENABLE_MIC_IN;
    outportb(GF1_MIX_CTRL, GUS_MIX_IMAGE);
}


static void UltraDisableMicIn(void)
{
    GUS_MIX_IMAGE &= ~ENABLE_MIC_IN;
    outportb(GF1_MIX_CTRL, GUS_MIX_IMAGE);
}


static void UltraReset(int voices)
{
    int v;

    if (voices < 14)
	voices = 14;
    if (voices > 32)
	voices = 32;

    GUS_VOICES = voices;
    GUS_TIMER_CTRL = 0;
    GUS_TIMER_MASK = 0;

    UltraPokeLong(0, 0);

    GF1OutB(MASTER_RESET, 0x00);
    for (v = 0; v < 10; v++)
	gf1_delay();

    /* Release Reset and wait */
    GF1OutB(MASTER_RESET, GF1_MASTER_RESET);
    for (v = 0; v < 10; v++)
	gf1_delay();

    /* Reset the MIDI port also */
    outportb(GF1_MIDI_CTRL, MIDI_RESET);
    for (v = 0; v < 10; v++)
	gf1_delay();
    outportb(GF1_MIDI_CTRL, 0x00);

    /* Clear all interrupts. */
    GF1OutB(DMA_CONTROL, 0x00);
    GF1OutB(TIMER_CONTROL, 0x00);
    GF1OutB(SAMPLE_CONTROL, 0x00);

    /* Set the number of active voices */
    GF1OutB(SET_VOICES, ((voices - 1) | 0xC0));

    /* Clear interrupts on voices. */
    /* Reading the status ports will clear the irqs. */

    inportb(GF1_IRQ_STAT);

    GF1InB(DMA_CONTROL);
    GF1InB(SAMPLE_CONTROL);
    GF1InB(GET_IRQV);

    for (v = 0; v < voices; v++) {

	/* Select the proper voice */
	outportb(GF1_PAGE, v);

	/* Stop the voice and volume */
	GF1OutB(SET_CONTROL, VOICE_STOPPED | STOP_VOICE);
	GF1OutB(SET_VOLUME_CONTROL, VOLUME_STOPPED | STOP_VOLUME);

	gf1_delay();		/* Wait 4.8 micos. or more. */

	/* Initialize each voice specific registers. This is not */
	/* really necessary, but is nice for completeness sake .. */
	/* Each application will set up these to whatever values */
	/* it needs. */

	GF1OutW(SET_FREQUENCY, 0x0400);
	GF1OutW(SET_START_HIGH, 0);
	GF1OutW(SET_START_LOW, 0);
	GF1OutW(SET_END_HIGH, 0);
	GF1OutW(SET_END_LOW, 0);
	GF1OutB(SET_VOLUME_RATE, 0x01);
	GF1OutB(SET_VOLUME_START, 0x10);
	GF1OutB(SET_VOLUME_END, 0xe0);
	GF1OutW(SET_VOLUME, 0x0000);

	GF1OutW(SET_ACC_HIGH, 0);
	GF1OutW(SET_ACC_LOW, 0);
	GF1OutB(SET_BALANCE, 0x07);
    }

    inportb(GF1_IRQ_STAT);

    GF1InB(DMA_CONTROL);
    GF1InB(SAMPLE_CONTROL);
    GF1InB(GET_IRQV);

    /* Set up GF1 Chip for interrupts & enable DACs. */
/*      GF1OutB(MASTER_RESET,GF1_MASTER_RESET|GF1_OUTPUT_ENABLE); */
    GF1OutB(MASTER_RESET, GF1_MASTER_RESET | GF1_OUTPUT_ENABLE | GF1_MASTER_IRQ);
}


static BOOL UltraProbe(void)
{
    UBYTE s1, s2, t1, t2;

    /* Pull a reset on the GF1 */

    GF1OutB(MASTER_RESET, 0x00);

    /* Wait a little while ... */
    gf1_delay();
    gf1_delay();

    /* Release Reset */
    GF1OutB(MASTER_RESET, GF1_MASTER_RESET);

    gf1_delay();
    gf1_delay();

    s1 = UltraPeek(0);
    s2 = UltraPeek(1);
    UltraPoke(0, 0xaa);
    t1 = UltraPeek(0);
    UltraPoke(1, 0x55);
    t2 = UltraPeek(1);
    UltraPoke(0, s1);
    UltraPoke(1, s2);

    return (t1 == 0xaa && t2 == 0x55);
}



static BOOL UltraDetect(void)
{
    char *ptr;

    if ((ptr = getenv("ULTRASND")) == NULL)
	return 0;

    if (sscanf(ptr, "%hx,%hd,%hd,%hd,%hd",
	       &GUS_PORT,
	       &GUS_DRAM_DMA,
	       &GUS_ADC_DMA,
	       &GUS_GF1_IRQ,
	       &GUS_MIDI_IRQ) != 5)
	return 0;

    return (UltraProbe());
}




static UBYTE dmalatch[8] =
{0, 1, 0, 2, 0, 3, 4, 5};
static UBYTE irqlatch[16] =
{0, 0, 1, 3, 0, 2, 0, 4, 0, 0, 0, 5, 6, 0, 0, 7};


static void UltraSetInterface(int dram, int adc, int gf1, int midi)
/* int dram;    /* dram dma chan */
/* int adc;             /* adc dma chan */
/* int gf1;             /* gf1 irq # */
/* int midi;    /* midi irq # */
{
    UBYTE gf1_irq, midi_irq, dram_dma, adc_dma;
    UBYTE irq_control, dma_control;
    UBYTE mix_image;

    /* Don't need to check for 0 irq #. Its latch entry = 0 */
    gf1_irq = irqlatch[gf1];
    midi_irq = irqlatch[midi];
    midi_irq <<= 3;

    dram_dma = dmalatch[dram];
    adc_dma = dmalatch[adc];
    adc_dma <<= 3;

    irq_control = dma_control = 0x0;

    mix_image = GUS_MIX_IMAGE;

    irq_control |= gf1_irq;

    if ((gf1 == midi) && (gf1 != 0))
	irq_control |= 0x40;
    else
	irq_control |= midi_irq;

    dma_control |= dram_dma;

    if ((dram == adc) && (dram != 0))
	dma_control |= 0x40;
    else
	dma_control |= adc_dma;

    /* Set up for Digital ASIC */
    outportb(GUS_PORT + 0x0f, 0x5);
    outportb(GF1_MIX_CTRL, mix_image);
    outportb(GF1_IRQ_CTRL, 0x0);
    outportb(GUS_PORT + 0x0f, 0x0);

    /* First do DMA control register */
    outportb(GF1_MIX_CTRL, mix_image);
    outportb(GF1_IRQ_CTRL, dma_control | 0x80);

    /* IRQ CONTROL REG */
    outportb(GF1_MIX_CTRL, mix_image | 0x40);
    outportb(GF1_IRQ_CTRL, irq_control);

    /* First do DMA control register */
    outportb(GF1_MIX_CTRL, mix_image);
    outportb(GF1_IRQ_CTRL, dma_control);

    /* IRQ CONTROL REG */
    outportb(GF1_MIX_CTRL, mix_image | 0x40);
    outportb(GF1_IRQ_CTRL, irq_control);

    /* IRQ CONTROL, ENABLE IRQ */
    /* just to Lock out writes to irq\dma register ... */
    outportb(GF1_VOICE_SELECT, 0);

    /* enable output & irq, disable line & mic input */
    mix_image |= 0x09;
    outportb(GF1_MIX_CTRL, mix_image);

    /* just to Lock out writes to irq\dma register ... */
    outportb(GF1_VOICE_SELECT, 0x0);

    /* put image back .... */
    GUS_MIX_IMAGE = mix_image;
}


static BOOL UltraPP(ULONG address)
{
    UBYTE s, t;
    s = UltraPeek(address);
    UltraPoke(address, 0xaa);
    t = UltraPeek(address);
    UltraPoke(address, s);
    return (t == 0xaa);
}


static UWORD UltraSizeDram(void)
{
    if (!UltraPP(0))
	return 0;
    if (!UltraPP(262144))
	return 256;
    if (!UltraPP(524288))
	return 512;
    if (!UltraPP(786432))
	return 768;
    return 1024;
}





static ULONG UltraMemTotal(void)
{
    ULONG node = GUS_POOL, nsize, total = 0;

    while (node != 0) {
	nsize = UltraPeekLong(node);
	total += nsize;
	node = UltraPeekLong(node + 4);
    }
    return total;
}



static BOOL Mergeable(ULONG a, ULONG b)
{
    return (a && b && (a + UltraPeekLong(a)) == b);
}



static ULONG Merge(ULONG a, ULONG b)
{
    UltraPokeLong(a, UltraPeekLong(a) + UltraPeekLong(b));
    UltraPokeLong(a + 4, UltraPeekLong(b + 4));
    return a;
}



static void UltraFree(ULONG size, ULONG location)
{
    ULONG pred = 0, succ = GUS_POOL;

    if (!size)
	return;
    size += 31;
    size &= -32L;

    UltraPokeLong(location, size);

    while (succ != 0 && succ <= location) {
	pred = succ;
	succ = UltraPeekLong(succ + 4);
    }

    if (pred)
	UltraPokeLong(pred + 4, location);
    else
	GUS_POOL = location;

    UltraPokeLong(location + 4, succ);

    if (Mergeable(pred, location)) {
	location = Merge(pred, location);
    }

    if (Mergeable(location, succ)) {
	Merge(location, succ);
    }
}


/*
   void DumpPool(void)
   {
   ULONG node=GUS_POOL;

   while(node!=0){
   printf("Node %ld, size %ld, next %ld\n",node,UltraPeekLong(node),UltraPeekLong(node+4));
   node=UltraPeekLong(node+4);
   }
   }
 */






static ULONG UltraMalloc(ULONG reqsize)
{
    ULONG curnode = GUS_POOL, cursize, newnode, newsize, pred, succ;

    if (!reqsize)
	return 0;

    /* round size to 32 bytes */

    reqsize += 31;
    reqsize &= -32L;

    /* as long as there are nodes: */

    pred = 0;

    while (curnode != 0) {

	succ = UltraPeekLong(curnode + 4);

	/* get current node size */

	cursize = UltraPeekLong(curnode);

	/* requested block fits? */

	if (cursize >= reqsize) {

	    /* it fits, so we're allocating the first
	       'size' bytes of this node */

	    /* find new node position and size */

	    newnode = curnode + reqsize;
	    newsize = cursize - reqsize;

	    /* create a new freenode if needed: */

	    if (newsize >= 8) {
		UltraPokeLong(newnode, newsize);
		UltraPokeLong(newnode + 4, succ);
		succ = newnode;
	    }

	    /* link prednode & succnode */

	    if (pred)
		UltraPokeLong(pred + 4, succ);
	    else
		GUS_POOL = succ;

	    /* store size of allocated memory block in block itself: */

	    UltraPokeLong(curnode, reqsize);
	    return curnode;
	}

	/* doesn't fit, try next node */
	curnode = succ;
    }
    return 0;
}



static ULONG UltraMalloc16(ULONG reqsize)
/*
   Allocates a free block of gus memory, suited for 16 bit samples i.e.
   smaller than 256k and doesn't cross a 256k page.
 */
{
    ULONG p, spage, epage;

    if (reqsize > 262144)
	return 0;

    /* round size to 32 bytes */

    reqsize += 31;
    reqsize &= -32L;

    p = UltraMalloc(reqsize);
    spage = p >> 18;
    epage = (p + reqsize - 1) >> 18;

    if (p && spage != epage) {
	ULONG newp, esize;

	/* free the second part of the block, and try again */

	esize = (p + reqsize) - (epage << 18);
	UltraFree(esize, epage << 18);

	newp = UltraMalloc16(reqsize);

	/* free first part of the previous block */

	UltraFree(reqsize - esize, p);
	p = newp;
    }

    return p;
}



static void UltraMemInit(void)
{
    UWORD memsize;
    GUS_POOL = 32;
    memsize = UltraSizeDram();
    UltraPokeLong(GUS_POOL, ((ULONG) memsize << 10) - 32);
    UltraPokeLong(GUS_POOL + 4, 0);
}


static void UltraNumVoices(int voices)
{
    UltraDisableLineIn();
    UltraDisableMicIn();
    UltraDisableOutput();
    UltraReset(voices);
    UltraSetInterface(GUS_DRAM_DMA, GUS_ADC_DMA, GUS_GF1_IRQ, GUS_MIDI_IRQ);
}


static void interrupt gf1handler(MIRQARGS)
{
    UBYTE irq_source;
    UBYTE oldselect = GUS_SELECT;

    while (irq_source = inportb(GF1_IRQ_STAT)) {

/*              if(irq_source & DMA_TC_IRQ){
   no provisions for DMA-ready irq yet
   }

   if(irq_source & (MIDI_TX_IRQ|MIDI_RX_IRQ)){
   no provisions for MIDI-ready irq yet
   }
 */
	if (irq_source & GF1_TIMER1_IRQ) {
	    GF1OutB(TIMER_CONTROL, GUS_TIMER_CTRL & ~0x04);
	    GF1OutB(TIMER_CONTROL, GUS_TIMER_CTRL);
	    if (GUS_TIMER1_FUNC != NULL)
		GUS_TIMER1_FUNC();
	}

	if (irq_source & GF1_TIMER2_IRQ) {
	    GF1OutB(TIMER_CONTROL, GUS_TIMER_CTRL & ~0x08);
	    GF1OutB(TIMER_CONTROL, GUS_TIMER_CTRL);
	    if (GUS_TIMER2_FUNC != NULL)
		GUS_TIMER2_FUNC();
	}

/*              if (irq_source & (WAVETABLE_IRQ | ENVELOPE_IRQ)){
   no wavetable or envelope irq provisions yet
   }
 */
    }

    MIrq_EOI(GUS_GF1_IRQ);
    UltraSelect(oldselect);
}


static PVI oldhandler;
typedef void (*PFV) (void);


static PFV UltraTimer1Handler(PFV handler)
{
    PFV old = GUS_TIMER1_FUNC;
    GUS_TIMER1_FUNC = handler;
    return old;
}


static PFV UltraTimer2Handler(PFV handler)
{
    PFV old = GUS_TIMER1_FUNC;
    GUS_TIMER1_FUNC = handler;
    return old;
}


static void UltraOpen(int voices)
{
    GUS_MIX_IMAGE = 0x0b;
    GUS_TIMER1_FUNC = NULL;
    GUS_TIMER2_FUNC = NULL;

    UltraDisableLineIn();
    UltraDisableMicIn();
    UltraDisableOutput();

    UltraReset(voices);
    UltraSetInterface(GUS_DRAM_DMA, GUS_ADC_DMA, GUS_GF1_IRQ, GUS_MIDI_IRQ);
    UltraMemInit();
    oldhandler = MIrq_SetHandler(GUS_GF1_IRQ, gf1handler);
    MIrq_OnOff(GUS_GF1_IRQ, 1);
}


static void UltraClose(void)
{
    MIrq_OnOff(GUS_GF1_IRQ, 0);
    MIrq_SetHandler(GUS_GF1_IRQ, oldhandler);
    UltraDisableOutput();
    UltraDisableLineIn();
    UltraDisableMicIn();
    UltraReset(14);
}


static void UltraSelectVoice(UBYTE voice)
{
    /* Make sure was are talking to proper voice */
    outportb(GF1_VOICE_SELECT, voice);
}



static void UltraSetVoiceEnd(ULONG end)
{
    ULONG phys_end;
    UBYTE data;

    data = GF1InB(GET_CONTROL);

    phys_end = (data & VC_DATA_TYPE) ? convert_to_16bit(end) : end;

    /* Set end address of buffer */
    GF1OutW(SET_END_LOW, ADDR_LOW(phys_end));
    GF1OutW(SET_END_HIGH, ADDR_HIGH(phys_end));

    data &= ~(VC_IRQ_PENDING | VOICE_STOPPED | STOP_VOICE);

    GF1OutB(SET_CONTROL, data);
    gf1_delay();

    GF1OutB(SET_CONTROL, data);
}


/* The formula for this table is:
   1,000,000 / (1.619695497 * # of active voices)

   The 1.619695497 is calculated by knowing that 14 voices
   gives exactly 44.1 Khz. Therefore,
   1,000,000 / (X * 14) = 44100
   X = 1.619695497
 */

static UWORD freq_divisor[19] =
{
    44100,			/* 14 active voices */
    41160,			/* 15 active voices */
    38587,			/* 16 active voices */
    36317,			/* 17 active voices */
    34300,			/* 18 active voices */
    32494,			/* 19 active voices */
    30870,			/* 20 active voices */
    29400,			/* 21 active voices */
    28063,			/* 22 active voices */
    26843,			/* 23 active voices */
    25725,			/* 24 active voices */
    24696,			/* 25 active voices */
    23746,			/* 26 active voices */
    22866,			/* 27 active voices */
    22050,			/* 28 active voices */
    21289,			/* 29 active voices */
    20580,			/* 30 active voices */
    19916,			/* 31 active voices */
    19293}			/* 32 active voices */
;

static void UltraSetFrequency(ULONG speed_khz)
{
    UWORD fc;
    ULONG temp;

    /* FC is calculated based on the # of active voices ... */
    temp = freq_divisor[GUS_VOICES - 14];

    fc = (((speed_khz << 9L) + (temp >> 1L)) / temp);
    GF1OutW(SET_FREQUENCY, fc << 1);
}


static void UltraSetLoopMode(UBYTE mode)
{
    UBYTE data;
    UBYTE vmode;

    /* set/reset the rollover bit as per user request */

    vmode = GF1InB(GET_VOLUME_CONTROL);

    if (mode & USE_ROLLOVER)
	vmode |= VC_ROLLOVER;
    else
	vmode &= ~VC_ROLLOVER;

    GF1OutB(SET_VOLUME_CONTROL, vmode);
    gf1_delay();
    GF1OutB(SET_VOLUME_CONTROL, vmode);

    data = GF1InB(GET_CONTROL);

    data &= ~(VC_WAVE_IRQ | VC_BI_LOOP | VC_LOOP_ENABLE);	/* isolate the bits */
    mode &= VC_WAVE_IRQ | VC_BI_LOOP | VC_LOOP_ENABLE;	/* no bad bits passed in */
    data |= mode;		/* turn on proper bits ... */

    GF1OutB(SET_CONTROL, data);
    gf1_delay();
    GF1OutB(SET_CONTROL, data);
}


static ULONG UltraReadVoice(void)
{
    UWORD count_low, count_high;
    ULONG acc;
    UBYTE mode;

    /* Get the high & low portion of the accumulator */
    count_high = GF1InW(GET_ACC_HIGH);
    count_low = GF1InW(GET_ACC_LOW);

    /* convert from UltraSound's format to a physical address */

    mode = GF1InB(GET_CONTROL);

    acc = make_physical_address(count_low, count_high, mode);
    acc &= 0xfffffL;		/* Only 20 bits please ... */

    return (acc);
}



static void UltraSetVoice(ULONG location)
{
    ULONG phys_loc;
    UBYTE data;

    data = GF1InB(GET_CONTROL);

    phys_loc = (data & VC_DATA_TYPE) ? convert_to_16bit(location) : location;

    /* First set accumulator to beginning of data */
    GF1OutW(SET_ACC_HIGH, ADDR_HIGH(phys_loc));
    GF1OutW(SET_ACC_LOW, ADDR_LOW(phys_loc));
}



static UBYTE UltraPrimeVoice(ULONG begin, ULONG start, ULONG end, UBYTE mode)
{
    ULONG phys_start, phys_end;
    ULONG phys_begin;
    ULONG temp;
    UBYTE vmode;

    /* if start is greater than end, flip 'em and turn on */
    /* decrementing addresses */
    if (start > end) {
	temp = start;
	start = end;
	end = temp;
	mode |= VC_DIRECT;
    }

    /* if 16 bit data, must convert addresses */
    if (mode & VC_DATA_TYPE) {
	phys_begin = convert_to_16bit(begin);
	phys_start = convert_to_16bit(start);
	phys_end = convert_to_16bit(end);
    }
    else {
	phys_begin = begin;
	phys_start = start;
	phys_end = end;
    }

    /* set/reset the rollover bit as per user request */
    vmode = GF1InB(GET_VOLUME_CONTROL);

    if (mode & USE_ROLLOVER)
	vmode |= VC_ROLLOVER;
    else
	vmode &= ~VC_ROLLOVER;

    GF1OutB(SET_VOLUME_CONTROL, vmode);
    gf1_delay();
    GF1OutB(SET_VOLUME_CONTROL, vmode);

    /* First set accumulator to beginning of data */
    GF1OutW(SET_ACC_LOW, ADDR_LOW(phys_begin));
    GF1OutW(SET_ACC_HIGH, ADDR_HIGH(phys_begin));

    /* Set start loop address of buffer */
    GF1OutW(SET_START_HIGH, ADDR_HIGH(phys_start));
    GF1OutW(SET_START_LOW, ADDR_LOW(phys_start));

    /* Set end address of buffer */
    GF1OutW(SET_END_HIGH, ADDR_HIGH(phys_end));
    GF1OutW(SET_END_LOW, ADDR_LOW(phys_end));
    return (mode);
}


static void UltraGoVoice(UBYTE mode)
{
    mode &= ~(VOICE_STOPPED | STOP_VOICE);	/* turn 'stop' bits off ... */

    /* NOTE: no irq's from the voice ... */

    GF1OutB(SET_CONTROL, mode);
    gf1_delay();
    GF1OutB(SET_CONTROL, mode);
}


/**********************************************************************
 *
 * This function will start playing a wave out of DRAM. It assumes
 * the playback rate, volume & balance have been set up before ...
 *
 *********************************************************************/

static void UltraStartVoice(ULONG begin, ULONG start, ULONG end, UBYTE mode)
{
    mode = UltraPrimeVoice(begin, start, end, mode);
    UltraGoVoice(mode);
}



/***************************************************************
 * This function will stop a given voices output. Note that a delay
 * is necessary after the stop is issued to ensure the self-
 * modifying bits aren't a problem.
 ***************************************************************/

static void UltraStopVoice(void)
{
    UBYTE data;

    /* turn off the roll over bit first ... */

    data = GF1InB(GET_VOLUME_CONTROL);
    data &= ~VC_ROLLOVER;

    GF1OutB(SET_VOLUME_CONTROL, data);
    gf1_delay();
    GF1OutB(SET_VOLUME_CONTROL, data);

    /* Now stop the voice  */

    data = GF1InB(GET_CONTROL);
    data &= ~VC_WAVE_IRQ;	/* disable irq's & stop voice .. */
    data |= VOICE_STOPPED | STOP_VOICE;

    GF1OutB(SET_CONTROL, data);	/* turn it off */
    gf1_delay();
    GF1OutB(SET_CONTROL, data);
}


static int UltraVoiceStopped(void)
{
    return (GF1InB(GET_CONTROL) & (VOICE_STOPPED | STOP_VOICE));
}


static void UltraSetBalance(UBYTE pan)
{
    GF1OutB(SET_BALANCE, pan & 0xf);
}


static void UltraSetVolume(UWORD volume)
{
    GF1OutW(SET_VOLUME, volume << 4);
}


static UWORD UltraReadVolume(void)
{
    return (GF1InW(GET_VOLUME) >> 4);
}


static void UltraStopVolume(void)
{
    UBYTE vmode;

    vmode = GF1InB(GET_VOLUME_CONTROL);
    vmode |= (VOLUME_STOPPED | STOP_VOLUME);

    GF1OutB(SET_VOLUME_CONTROL, vmode);
    gf1_delay();
    GF1OutB(SET_VOLUME_CONTROL, vmode);
}


static void UltraRampVolume(UWORD start, UWORD end, UBYTE rate, UBYTE mode)
{
    UWORD begin;
    UBYTE vmode;

    if (start == end)
	return;
/*********************************************************************
 * If the start volume is greater than the end volume, flip them and
 * turn on decreasing volume. Note that the GF1 requires that the
 * programmed start volume MUST be less than or equal to the end
 * volume.
 *********************************************************************/
    /* Don't let bad bits thru ... */
    mode &= ~(VL_IRQ_PENDING | VC_ROLLOVER | STOP_VOLUME | VOLUME_STOPPED);

    begin = start;

    if (start > end) {
	/* flip start & end if decreasing numbers ... */
	start = end;
	end = begin;
	mode |= VC_DIRECT;	/* decreasing volumes */
    }

    /* looping below 64 or greater that 4032 can cause strange things */
    if (start < 64)
	start = 64;
    if (end > 4032)
	end = 4032;

    GF1OutB(SET_VOLUME_RATE, rate);
    GF1OutB(SET_VOLUME_START, start >> 4);
    GF1OutB(SET_VOLUME_END, end >> 4);

    /* Also MUST set the current volume to the start volume ... */
    UltraSetVolume(begin);

    vmode = GF1InB(GET_VOLUME_CONTROL);

    if (vmode & VC_ROLLOVER)
	mode |= VC_ROLLOVER;

    /* start 'er up !!! */
    GF1OutB(SET_VOLUME_CONTROL, mode);
    gf1_delay();
    GF1OutB(SET_VOLUME_CONTROL, mode);
}


static void UltraVectorVolume(UWORD end, UBYTE rate, UBYTE mode)
{
    UltraStopVolume();
    UltraRampVolume(UltraReadVolume(), end, rate, mode);
}


static int UltraVolumeStopped(void)
{
    return (GF1InB(GET_VOLUME_CONTROL) & (VOLUME_STOPPED | STOP_VOLUME));
}


static UWORD vol_rates[19] =
{
23, 24, 26, 28, 29, 31, 32, 34, 36, 37, 39, 40, 42, 44, 45, 47, 49, 50, 52
};


static UBYTE UltraCalcRate(UWORD start, UWORD end, ULONG mil_secs)
{
    ULONG gap, mic_secs;
    UWORD i, range, increment;
    UBYTE rate_val;
    UWORD value;

    gap = (start > end) ? (start - end) : (end - start);
    mic_secs = (mil_secs * 1000L) / gap;

/* OK. We now have the # of microseconds for each update to go from */
/* A to B in X milliseconds. See what the best fit is in the table */

    range = 4;
    value = vol_rates[GUS_VOICES - 14];

    for (i = 0; i < 3; i++) {
	if (mic_secs < value) {
	    range = i;
	    break;
	}
	else
	    value <<= 3;
    }

    if (range == 4) {
	range = 3;
	increment = 1;
    }
    else {
	/* calculate increment value ... (round it up ?) */
	increment = (unsigned int) ((value + (value >> 1)) / mic_secs);
    }

    rate_val = range << 6;
    rate_val |= (increment & 0x3F);
    return (rate_val);
}


static UWORD _gf1_volumes[512] =
{
    0x0000,
  0x0700, 0x07ff, 0x0880, 0x08ff, 0x0940, 0x0980, 0x09c0, 0x09ff, 0x0a20,
  0x0a40, 0x0a60, 0x0a80, 0x0aa0, 0x0ac0, 0x0ae0, 0x0aff, 0x0b10, 0x0b20,
  0x0b30, 0x0b40, 0x0b50, 0x0b60, 0x0b70, 0x0b80, 0x0b90, 0x0ba0, 0x0bb0,
  0x0bc0, 0x0bd0, 0x0be0, 0x0bf0, 0x0bff, 0x0c08, 0x0c10, 0x0c18, 0x0c20,
  0x0c28, 0x0c30, 0x0c38, 0x0c40, 0x0c48, 0x0c50, 0x0c58, 0x0c60, 0x0c68,
  0x0c70, 0x0c78, 0x0c80, 0x0c88, 0x0c90, 0x0c98, 0x0ca0, 0x0ca8, 0x0cb0,
  0x0cb8, 0x0cc0, 0x0cc8, 0x0cd0, 0x0cd8, 0x0ce0, 0x0ce8, 0x0cf0, 0x0cf8,
  0x0cff, 0x0d04, 0x0d08, 0x0d0c, 0x0d10, 0x0d14, 0x0d18, 0x0d1c, 0x0d20,
  0x0d24, 0x0d28, 0x0d2c, 0x0d30, 0x0d34, 0x0d38, 0x0d3c, 0x0d40, 0x0d44,
  0x0d48, 0x0d4c, 0x0d50, 0x0d54, 0x0d58, 0x0d5c, 0x0d60, 0x0d64, 0x0d68,
  0x0d6c, 0x0d70, 0x0d74, 0x0d78, 0x0d7c, 0x0d80, 0x0d84, 0x0d88, 0x0d8c,
  0x0d90, 0x0d94, 0x0d98, 0x0d9c, 0x0da0, 0x0da4, 0x0da8, 0x0dac, 0x0db0,
  0x0db4, 0x0db8, 0x0dbc, 0x0dc0, 0x0dc4, 0x0dc8, 0x0dcc, 0x0dd0, 0x0dd4,
  0x0dd8, 0x0ddc, 0x0de0, 0x0de4, 0x0de8, 0x0dec, 0x0df0, 0x0df4, 0x0df8,
  0x0dfc, 0x0dff, 0x0e02, 0x0e04, 0x0e06, 0x0e08, 0x0e0a, 0x0e0c, 0x0e0e,
  0x0e10, 0x0e12, 0x0e14, 0x0e16, 0x0e18, 0x0e1a, 0x0e1c, 0x0e1e, 0x0e20,
  0x0e22, 0x0e24, 0x0e26, 0x0e28, 0x0e2a, 0x0e2c, 0x0e2e, 0x0e30, 0x0e32,
  0x0e34, 0x0e36, 0x0e38, 0x0e3a, 0x0e3c, 0x0e3e, 0x0e40, 0x0e42, 0x0e44,
  0x0e46, 0x0e48, 0x0e4a, 0x0e4c, 0x0e4e, 0x0e50, 0x0e52, 0x0e54, 0x0e56,
  0x0e58, 0x0e5a, 0x0e5c, 0x0e5e, 0x0e60, 0x0e62, 0x0e64, 0x0e66, 0x0e68,
  0x0e6a, 0x0e6c, 0x0e6e, 0x0e70, 0x0e72, 0x0e74, 0x0e76, 0x0e78, 0x0e7a,
  0x0e7c, 0x0e7e, 0x0e80, 0x0e82, 0x0e84, 0x0e86, 0x0e88, 0x0e8a, 0x0e8c,
  0x0e8e, 0x0e90, 0x0e92, 0x0e94, 0x0e96, 0x0e98, 0x0e9a, 0x0e9c, 0x0e9e,
  0x0ea0, 0x0ea2, 0x0ea4, 0x0ea6, 0x0ea8, 0x0eaa, 0x0eac, 0x0eae, 0x0eb0,
  0x0eb2, 0x0eb4, 0x0eb6, 0x0eb8, 0x0eba, 0x0ebc, 0x0ebe, 0x0ec0, 0x0ec2,
  0x0ec4, 0x0ec6, 0x0ec8, 0x0eca, 0x0ecc, 0x0ece, 0x0ed0, 0x0ed2, 0x0ed4,
  0x0ed6, 0x0ed8, 0x0eda, 0x0edc, 0x0ede, 0x0ee0, 0x0ee2, 0x0ee4, 0x0ee6,
  0x0ee8, 0x0eea, 0x0eec, 0x0eee, 0x0ef0, 0x0ef2, 0x0ef4, 0x0ef6, 0x0ef8,
  0x0efa, 0x0efc, 0x0efe, 0x0eff, 0x0f01, 0x0f02, 0x0f03, 0x0f04, 0x0f05,
  0x0f06, 0x0f07, 0x0f08, 0x0f09, 0x0f0a, 0x0f0b, 0x0f0c, 0x0f0d, 0x0f0e,
  0x0f0f, 0x0f10, 0x0f11, 0x0f12, 0x0f13, 0x0f14, 0x0f15, 0x0f16, 0x0f17,
  0x0f18, 0x0f19, 0x0f1a, 0x0f1b, 0x0f1c, 0x0f1d, 0x0f1e, 0x0f1f, 0x0f20,
  0x0f21, 0x0f22, 0x0f23, 0x0f24, 0x0f25, 0x0f26, 0x0f27, 0x0f28, 0x0f29,
  0x0f2a, 0x0f2b, 0x0f2c, 0x0f2d, 0x0f2e, 0x0f2f, 0x0f30, 0x0f31, 0x0f32,
  0x0f33, 0x0f34, 0x0f35, 0x0f36, 0x0f37, 0x0f38, 0x0f39, 0x0f3a, 0x0f3b,
  0x0f3c, 0x0f3d, 0x0f3e, 0x0f3f, 0x0f40, 0x0f41, 0x0f42, 0x0f43, 0x0f44,
  0x0f45, 0x0f46, 0x0f47, 0x0f48, 0x0f49, 0x0f4a, 0x0f4b, 0x0f4c, 0x0f4d,
  0x0f4e, 0x0f4f, 0x0f50, 0x0f51, 0x0f52, 0x0f53, 0x0f54, 0x0f55, 0x0f56,
  0x0f57, 0x0f58, 0x0f59, 0x0f5a, 0x0f5b, 0x0f5c, 0x0f5d, 0x0f5e, 0x0f5f,
  0x0f60, 0x0f61, 0x0f62, 0x0f63, 0x0f64, 0x0f65, 0x0f66, 0x0f67, 0x0f68,
  0x0f69, 0x0f6a, 0x0f6b, 0x0f6c, 0x0f6d, 0x0f6e, 0x0f6f, 0x0f70, 0x0f71,
  0x0f72, 0x0f73, 0x0f74, 0x0f75, 0x0f76, 0x0f77, 0x0f78, 0x0f79, 0x0f7a,
  0x0f7b, 0x0f7c, 0x0f7d, 0x0f7e, 0x0f7f, 0x0f80, 0x0f81, 0x0f82, 0x0f83,
  0x0f84, 0x0f85, 0x0f86, 0x0f87, 0x0f88, 0x0f89, 0x0f8a, 0x0f8b, 0x0f8c,
  0x0f8d, 0x0f8e, 0x0f8f, 0x0f90, 0x0f91, 0x0f92, 0x0f93, 0x0f94, 0x0f95,
  0x0f96, 0x0f97, 0x0f98, 0x0f99, 0x0f9a, 0x0f9b, 0x0f9c, 0x0f9d, 0x0f9e,
  0x0f9f, 0x0fa0, 0x0fa1, 0x0fa2, 0x0fa3, 0x0fa4, 0x0fa5, 0x0fa6, 0x0fa7,
  0x0fa8, 0x0fa9, 0x0faa, 0x0fab, 0x0fac, 0x0fad, 0x0fae, 0x0faf, 0x0fb0,
  0x0fb1, 0x0fb2, 0x0fb3, 0x0fb4, 0x0fb5, 0x0fb6, 0x0fb7, 0x0fb8, 0x0fb9,
  0x0fba, 0x0fbb, 0x0fbc, 0x0fbd, 0x0fbe, 0x0fbf, 0x0fc0, 0x0fc1, 0x0fc2,
  0x0fc3, 0x0fc4, 0x0fc5, 0x0fc6, 0x0fc7, 0x0fc8, 0x0fc9, 0x0fca, 0x0fcb,
  0x0fcc, 0x0fcd, 0x0fce, 0x0fcf, 0x0fd0, 0x0fd1, 0x0fd2, 0x0fd3, 0x0fd4,
  0x0fd5, 0x0fd6, 0x0fd7, 0x0fd8, 0x0fd9, 0x0fda, 0x0fdb, 0x0fdc, 0x0fdd,
  0x0fde, 0x0fdf, 0x0fe0, 0x0fe1, 0x0fe2, 0x0fe3, 0x0fe4, 0x0fe5, 0x0fe6,
  0x0fe7, 0x0fe8, 0x0fe9, 0x0fea, 0x0feb, 0x0fec, 0x0fed, 0x0fee, 0x0fef,
  0x0ff0, 0x0ff1, 0x0ff2, 0x0ff3, 0x0ff4, 0x0ff5, 0x0ff6, 0x0ff7, 0x0ff8,
    0x0ff9, 0x0ffa, 0x0ffb, 0x0ffc, 0x0ffd, 0x0ffe, 0x0fff
};


static void UltraSetLinearVolume(UWORD index)
{
    UltraSetVolume(_gf1_volumes[index]);
}


static void UltraRampLinearVolume(UWORD start_idx, UWORD end_idx, ULONG msecs, UBYTE mode)
{
    UWORD start, end;
    UBYTE rate;

    /* Ramp from start to end in x milliseconds */

    start = _gf1_volumes[start_idx];
    end = _gf1_volumes[end_idx];

    /* calculate a rate to get from start to end in msec milliseconds .. */
    rate = UltraCalcRate(start, end, msecs);
    UltraRampVolume(start, end, rate, mode);
}


static void UltraVectorLinearVolume(UWORD end_idx, UBYTE rate, UBYTE mode)
{
    UltraStopVolume();
    UltraRampVolume(UltraReadVolume(), _gf1_volumes[end_idx], rate, mode);
}


static void UltraStartTimer(UBYTE timer, UBYTE time)
{
    UBYTE temp;

    if (timer == 1) {
	GUS_TIMER_CTRL |= 0x04;
	GUS_TIMER_MASK |= 0x01;
	temp = TIMER1;
    }
    else {
	GUS_TIMER_CTRL |= 0x08;
	GUS_TIMER_MASK |= 0x02;
	temp = TIMER2;
    }

/*      ENTER_CRITICAL; */

    time = 256 - time;

    GF1OutB(temp, time);	/* set timer speed */
    GF1OutB(TIMER_CONTROL, GUS_TIMER_CTRL);	/* enable timer interrupt on gf1 */
    outportb(GF1_TIMER_CTRL, 0x04);	/* select timer stuff */
    outportb(GF1_TIMER_DATA, GUS_TIMER_MASK);	/* start the timers */

/*      LEAVE_CRITICAL; */
}


static void UltraStopTimer(int timer)
{
    if (timer == 1) {
	GUS_TIMER_CTRL &= ~0x04;
	GUS_TIMER_MASK &= ~0x01;
    }
    else {
	GUS_TIMER_CTRL &= ~0x08;
	GUS_TIMER_MASK &= ~0x02;
    }

/*      ENTER_CRITICAL; */

    GF1OutB(TIMER_CONTROL, GUS_TIMER_CTRL);	/* disable timer interrupts */
    outportb(GF1_TIMER_CTRL, 0x04);	/* select timer stuff */
    outportb(GF1_TIMER_DATA, GUS_TIMER_MASK | 0x80);

/*      LEAVE_CRITICAL; */
}


static BOOL UltraTimerStopped(UBYTE timer)
{
    UBYTE value;
    UBYTE temp;

    if (timer == 1)
	temp = 0x40;
    else
	temp = 0x20;

    value = (inportb(GF1_TIMER_CTRL)) & temp;

    return (value);
}


/***************************************************************************
>>>>>>>>>>>>>>>>>>>>>>>>> The actual GUS driver <<<<<<<<<<<<<<<<<<<<<<<<<<<<
***************************************************************************/


static ULONG Ultra[MAXSAMPLEHANDLES];
static ULONG Ultrs[MAXSAMPLEHANDLES];

/* Ultra[] holds the sample dram adresses
   of the samples of a module */

typedef struct {
    UBYTE kick;			/* =1 -> sample has to be restarted */
    UBYTE active;		/* =1 -> sample is playing */
    UWORD flags;		/* 16/8 bits looping/one-shot */
    SWORD handle;		/* identifies the sample */
    ULONG start;		/* start index */
    ULONG size;			/* samplesize */
    ULONG reppos;		/* loop start */
    ULONG repend;		/* loop end */
    ULONG frq;			/* current frequency */
    UBYTE vol;			/* current volume */
    UBYTE pan;			/* current panning position */
} GHOLD;

static GHOLD ghld[32];


static UBYTE timeskip;
static UBYTE timecount;
static UBYTE GUS_BPM;


void UltraSetBPM(UBYTE bpm)
{
    /* The player routine has to be called (bpm*50)/125 times a second,
       so the interval between calls takes 125/(bpm*50) seconds (amazing!).

       The Timer1 handler has a resolution of 80 microseconds.

       So the timer value to program:

       (125/(bpm*50)) / 80e-6 = 31250/bpm
     */
    UWORD rate = 31250 / bpm;

    rate+=2; /*MOJE*/

    timeskip = 0;
    timecount = 0;

    while (rate > 255) {
	rate >>= 1;
	timeskip++;
    }
    UltraStartTimer(1, rate);
}



void GUS_Update(void)
{
    UBYTE t;
    GHOLD *aud;
    UWORD vol;
    ULONG base, start, size, reppos, repend;

    UWORD curvol, bigvol = 0, bigvoc = 0;

    if (timecount < timeskip) {
	timecount++;
	return;
    }
    timecount = 0;

    md_player();

    if (GUS_BPM != md_bpm) {
	UltraSetBPM(md_bpm);
	GUS_BPM = md_bpm;
    }

    /* ramp down voices that need to be started next */

    for (t = 0; t < md_numchn; t++) {
	UltraSelectVoice(t);
	aud = &ghld[t];
	if (aud->kick) {
	    curvol = UltraReadVolume();
	    if (bigvol <= curvol) {
		bigvol = curvol;
		bigvoc = t;
	    }
	    UltraVectorLinearVolume(0, 0x3f, 0);
	}
    }

/*      while(!UltraVolumeStopped(bigvoc)); */

    for (t = 0; t < md_numchn; t++) {
	UltraSelectVoice(t);
	aud = &ghld[t];

	if (aud->kick) {
	    aud->kick = 0;

	    base = Ultra[aud->handle];

	    start = aud->start;
	    reppos = aud->reppos;
	    repend = aud->repend;
	    size = aud->size;

	    if (aud->flags & SF_16BITS) {
		start <<= 1;
		reppos <<= 1;
		repend <<= 1;
		size <<= 1;
	    }

	    /* Stop current sample and start a new one */

	    UltraStopVoice();

	    UltraSetFrequency(aud->frq);
	    UltraVectorLinearVolume(6U * aud->vol, 0x3f, 0);
	    UltraSetBalance(aud->pan >> 4);

	    if (aud->flags & SF_LOOP) {

		/* Start a looping sample */

		UltraStartVoice(base + start,
				base + reppos,
		base + repend, 0x8 | ((aud->flags & SF_16BITS) ? 4 : 0) |
				((aud->flags & SF_BIDI) ? 16 : 0));
	    }
	    else {

		/* Start a one-shot sample */

		UltraStartVoice(base + start,
				base + start,
		      base + size + 2, (aud->flags & SF_16BITS) ? 4 : 0);
	    }
	}
	else {
	    UltraSetFrequency(aud->frq);
	    UltraVectorLinearVolume(6U * aud->vol, 0x3f, 0);
	    UltraSetBalance(aud->pan >> 4);
	}
    }
}


SWORD GUS_Load(FILE * fp, ULONG length, ULONG loopstart, ULONG loopend, UWORD flags)
/*
   callback routine for the MODLOAD module.
 */
{
    int handle, t;
    long p, l;

    SL_Init(fp, flags, flags | SF_SIGNED);

    /* Find empty slot to put sample address in */

    for (handle = 0; handle < MAXSAMPLEHANDLES; handle++) {
	if (Ultra[handle] == 0)
	    break;
    }

    if (handle == MAXSAMPLEHANDLES) {
	myerr = ERROR_OUT_OF_HANDLES;
	return -1;
    }

    if (flags & SF_16BITS) {
	length <<= 1;
	loopstart <<= 1;
	loopend <<= 1;
    }

    /* Allocate GUS dram and store the address in Ultra[handle] */
    /* Alloc 8 bytes more for anticlick measures. see below. */

    /* 2.04: use UltraMalloc16 to allocate 16 bit samples */

    if (!(Ultra[handle] = (flags & SF_16BITS) ? UltraMalloc16(length + 8) : UltraMalloc(length + 8))) {
	myerr = ERROR_SAMPLE_TOO_BIG;
	return -1;
    }

    /* Load the sample */

    Ultrs[handle] = length + 8;
    p = Ultra[handle];
    l = length;

    while (l > 0) {
	static UBYTE buffer[1024];
	long todo;

	todo = (l > 1024) ? 1024 : l;

	SL_Load(buffer, todo);

	UltraPokeChunk(p, buffer, todo);

	p += todo;
	l -= todo;
    }

    if (flags & SF_LOOP && !(flags & SF_BIDI)) {	/* looping sample ? */

	/*      Anticlick for looping samples:
	   Copy the first bytes in the loop
	   beyond the end of the loop */

	for (t = 0; t < 8; t++) {
	    UltraPoke(Ultra[handle] + loopend + t,
		      UltraPeek(Ultra[handle] + loopstart + t));
	}
    }
    else {

	/*      Anticlick for one-shot samples:
	   Zero the bytes beyond the end of the sample.
	 */

	for (t = 0; t < 8; t++) {
	    UltraPoke(Ultra[handle] + length + t, 0);
	}
    }

    return handle;
}



void GUS_UnLoad(SWORD handle)
/*
   callback routine to unload samples

   smp                     :sampleinfo of sample that is being freed
 */
{
    UltraFree(Ultrs[handle], Ultra[handle]);
    Ultra[handle] = 0;
}




BOOL GUS_Init(void)
{
    ULONG p1, p2;
    int irq;

    if (!(md_mode & DMODE_16BITS)) {
	md_mode |= DMODE_16BITS;	/* gus can't do 8 bit mixing */
    }

    if (!(md_mode & DMODE_STEREO)) {
	md_mode |= DMODE_STEREO;	/* gus can't do mono mixing */
    }

    if (!UltraDetect()) {
	myerr = "Couldn't detect gus, please check env. string";
	return 0;
    }

    UltraOpen(14);
    UltraTimer1Handler(GUS_Update);

    return 1;
}



void GUS_Exit(void)
{
    UltraClose();
}



void GUS_PlayStart(void)
{
    int t;
    for (t = 0; t < md_numchn; t++) {
	ghld[t].flags = 0;
	ghld[t].handle = 0;
	ghld[t].kick = 0;
	ghld[t].active = 0;
	ghld[t].frq = 10000;
	ghld[t].vol = 0;
	ghld[t].pan = (t & 1) ? 0 : 255;
    }
    UltraNumVoices(md_numchn);
    UltraEnableOutput();
    GUS_BPM = 125;
    UltraSetBPM(125);
}



void GUS_PlayStop(void)
{
    UltraStopTimer(1);
    UltraDisableOutput();
}


BOOL GUS_IsThere(void)
{
    return (getenv("ULTRASND") != NULL);
}


void GUS_VoiceSetVolume(UBYTE voice, UBYTE vol)
{
    ghld[voice].vol = vol;
}


void GUS_VoiceSetFrequency(UBYTE voice, ULONG frq)
{
    ghld[voice].frq = frq;
}

void GUS_VoiceSetPanning(UBYTE voice, UBYTE pan)
{
    ghld[voice].pan = pan;
}

void GUS_VoicePlay(UBYTE voice, SWORD handle, ULONG start, ULONG size, ULONG reppos, ULONG repend, UWORD flags)
{
    if (start >= size)
	return;

    if (flags & SF_LOOP) {
	if (repend > size)
	    repend = size;	/* repend can't be bigger than size */
    }

    ghld[voice].flags = flags;
    ghld[voice].handle = handle;
    ghld[voice].start = start;
    ghld[voice].size = size;
    ghld[voice].reppos = reppos;
    ghld[voice].repend = repend;
    ghld[voice].kick = 1;
}

void GUS_Dummy(void)
{
}


DRIVER drv_gus =
{
    NULL,
    "Gravis Ultrasound",
    "MikMod GUS Driver v2.1 (uses gus timer interrupt)",
    GUS_IsThere,
    GUS_Load,
    GUS_UnLoad,
    GUS_Init,
    GUS_Exit,
    GUS_PlayStart,
    GUS_PlayStop,
    GUS_Dummy,
    GUS_VoiceSetVolume,
    GUS_VoiceSetFrequency,
    GUS_VoiceSetPanning,
    GUS_VoicePlay
};
