/*

    SDL - Simple DirectMedia Layer

    Copyright (C) 1997-2004 Sam Lantinga

    This library is free software; you can redistribute it and/or

    modify it under the terms of the GNU Library General Public

    License as published by the Free Software Foundation; either

    version 2 of the License, or (at your option) any later version.

    This library is distributed in the hope that it will be useful,

    but WITHOUT ANY WARRANTY; without even the implied warranty of

    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

    Library General Public License for more details.

    You should have received a copy of the GNU Library General Public

    License along with this library; if not, write to the Free

    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

    Sam Lantinga

    slouken@libsdl.org

*/

#include "SDL_config.h"

/*

	MiNT audio driver

	using XBIOS functions (Falcon)

	Patrice Mandin, Didier Méquignon

*/

#include <unistd.h>

#include <support.h>

/* Mint includes */

#include <mint/osbind.h>

#include <mint/falcon.h>

#include <mint/cookie.h>

#include "SDL_audio.h"

#include "../SDL_audio_c.h"

#include "../SDL_sysaudio.h"

#include "../../video/ataricommon/SDL_atarimxalloc_c.h"

#include "SDL_mintaudio.h"

#include "SDL_mintaudio_dma8.h"

/*--- Defines ---*/

#define MINT_AUDIO_DRIVER_NAME "mint_xbios"

/* Debug print info */

#define DEBUG_NAME "audio:xbios: "

#if 0

#define DEBUG_PRINT(what) \

	{ \

		printf what; \

	}

#else

#define DEBUG_PRINT(what)

#endif

/*--- Static variables ---*/

static unsigned long cookie_snd;

/*--- Audio driver functions ---*/

static void Mint_CloseAudio(_THIS);

static int Mint_OpenAudio(_THIS, SDL_AudioSpec *spec);

static void Mint_LockAudio(_THIS);

static void Mint_UnlockAudio(_THIS);

/* To check/init hardware audio */

static int Mint_CheckAudio(_THIS, SDL_AudioSpec *spec);

static void Mint_InitAudio(_THIS, SDL_AudioSpec *spec);

/*--- Audio driver bootstrap functions ---*/

static int Audio_Available(void)

{

	unsigned long dummy;

	const char *envr = SDL_getenv("SDL_AUDIODRIVER");

	/*SDL_MintAudio_mint_present = (Getcookie(C_MiNT, &dummy) == C_FOUND);*/

	SDL_MintAudio_mint_present = SDL_FALSE;

	/* We can't use XBIOS in interrupt with Magic, don't know about thread */

	if (Getcookie(C_MagX, &dummy) == C_FOUND) {

		return(0);

	}

	/* Check if user asked a different audio driver */

	if ((envr) && (SDL_strcmp(envr, MINT_AUDIO_DRIVER_NAME)!=0)) {

		DEBUG_PRINT((DEBUG_NAME "user asked a different audio driver\n"));

		return(0);

	}

	/* Cookie _SND present ? if not, assume ST machine */

	if (Getcookie(C__SND, &cookie_snd) == C_NOTFOUND) {

		cookie_snd = SND_PSG;

	}

	/* Check if we have 16 bits audio */

	if ((cookie_snd & SND_16BIT)==0) {

		DEBUG_PRINT((DEBUG_NAME "no 16 bits sound\n"));

	    return(0);

	}

	/* Check if audio is lockable */

	if (Locksnd()!=1) {

		DEBUG_PRINT((DEBUG_NAME "audio locked by other application\n"));

		return(0);

	}

	Unlocksnd();

	DEBUG_PRINT((DEBUG_NAME "XBIOS audio available!\n"));

	return(1);

}

static void Audio_DeleteDevice(SDL_AudioDevice *device)

{

    SDL_free(device->hidden);

    SDL_free(device);

}

static SDL_AudioDevice *Audio_CreateDevice(int devindex)

{

	SDL_AudioDevice *this;

	/* Initialize all variables that we clean on shutdown */

	this = (SDL_AudioDevice *)SDL_malloc(sizeof(SDL_AudioDevice));

    if ( this ) {

        SDL_memset(this, 0, (sizeof *this));

        this->hidden = (struct SDL_PrivateAudioData *)

                SDL_malloc((sizeof *this->hidden));

    }

    if ( (this == NULL) || (this->hidden == NULL) ) {

        SDL_OutOfMemory();

        if ( this ) {

            SDL_free(this);

        }

        return(0);

    }

    SDL_memset(this->hidden, 0, (sizeof *this->hidden));

    /* Set the function pointers */

    this->OpenAudio   = Mint_OpenAudio;

    this->CloseAudio  = Mint_CloseAudio;

    this->LockAudio   = Mint_LockAudio;

    this->UnlockAudio = Mint_UnlockAudio;

    this->free        = Audio_DeleteDevice;

    return this;

}

AudioBootStrap MINTAUDIO_XBIOS_bootstrap = {

	MINT_AUDIO_DRIVER_NAME, "MiNT XBIOS audio driver",

	Audio_Available, Audio_CreateDevice

};

static void Mint_LockAudio(_THIS)

{

	/* Stop replay */

	Buffoper(0);

}

static void Mint_UnlockAudio(_THIS)

{

	/* Restart replay */

	Buffoper(SB_PLA_ENA|SB_PLA_RPT);

}

static void Mint_CloseAudio(_THIS)

{

	/* Stop replay */

	SDL_MintAudio_WaitThread();

	Buffoper(0);

	if (!SDL_MintAudio_mint_present) {

		/* Uninstall interrupt */

		Jdisint(MFP_DMASOUND);

	}

	/* Wait if currently playing sound */

	while (SDL_MintAudio_mutex != 0) {

	}

	/* Clear buffers */

	if (SDL_MintAudio_audiobuf[0]) {

		Mfree(SDL_MintAudio_audiobuf[0]);

		SDL_MintAudio_audiobuf[0] = SDL_MintAudio_audiobuf[1] = NULL;

	}

	/* Unlock sound system */

	Unlocksnd();

}

/* Falcon XBIOS implementation of Devconnect() is buggy with external clock */

static void Devconnect2(int src, int dst, int sclk, int pre)

{		

	static const unsigned short MASK1[3] = { 0, 0x6000, 0 };

	static const unsigned short MASK2[4] = { 0xFFF0, 0xFF8F, 0xF0FF, 0x0FFF };

	static const unsigned short INDEX1[4] = {  1, 3, 5, 7 };

	static const unsigned short INDEX2[4] = {  0, 2, 4, 6 };

	unsigned short sync_div,dev_ctrl,dest_ctrl;

	void *oldstack;

	if (dst==0) {

		return;

	}

	oldstack=(void *)Super(0);

	dev_ctrl = DMAAUDIO_IO.dev_ctrl;

	dest_ctrl = DMAAUDIO_IO.dest_ctrl;

	dev_ctrl &= MASK2[src];

	if (src==ADC) {

		dev_ctrl |= MASK1[sclk];

	} else {

		dev_ctrl |= (INDEX1[sclk] << (src<<4));

	}

	if (dst & DMAREC) {		

		dest_ctrl &= 0xFFF0;

		dest_ctrl |= INDEX1[src];

	}

	if (dst & DSPRECV) {		

		dest_ctrl &= 0xFF8F;

		dest_ctrl |= (INDEX1[src]<<4); 

	}

	if (dst & EXTOUT) {		

		dest_ctrl &= 0xF0FF;

		dest_ctrl |= (INDEX1[src]<<8); 

	}

	if (dst & DAC) {		

		dev_ctrl &= 0x0FFF;

		dev_ctrl |= MASK1[sclk]; 

		dest_ctrl &=  0x0FFF;

		dest_ctrl |= (INDEX2[src]<<12); 

	}

	sync_div = DMAAUDIO_IO.sync_div;

	if (sclk==CLKEXT) {

		pre<<=8;

		sync_div &= 0xF0FF;

	} else {

		sync_div &= 0xFFF0;

	}

	sync_div |= pre;

	DMAAUDIO_IO.dev_ctrl = dev_ctrl;

	DMAAUDIO_IO.dest_ctrl = dest_ctrl;

	DMAAUDIO_IO.sync_div = sync_div;

	Super(oldstack);

}

static void Mint_CheckExternalClock(_THIS)

{

#define SIZE_BUF_CLOCK_MEASURE (44100/10)

	unsigned long cookie_snd;

	char *buffer;

	int i, j;

	/* DSP present with its GPIO port ? */

	if (Getcookie(C__SND, &cookie_snd) == C_NOTFOUND) {

		return;

	}

	if ((cookie_snd & SND_DSP)==0) {

		return;

	}

	buffer = Atari_SysMalloc(SIZE_BUF_CLOCK_MEASURE, MX_STRAM);

	if (buffer==NULL) {

		DEBUG_PRINT((DEBUG_NAME "Not enough memory for the measure\n"));

		return;

	}

	SDL_memset(buffer, 0, SIZE_BUF_CLOCK_MEASURE);

	Buffoper(0);

	Settracks(0,0);

	Setmontracks(0);

	Setmode(MONO8);

	Jdisint(MFP_TIMERA);

	for (i=0; i<2; i++) {

		Gpio(GPIO_SET,7);      /* DSP port gpio outputs */

		Gpio(GPIO_WRITE,2+i);  /* 22.5792/24.576 MHz for 44.1/48KHz */

		Devconnect2(DMAPLAY, DAC, CLKEXT, CLK50K);  /* Matrix and clock source */

		Setbuffer(0, buffer, buffer + SIZE_BUF_CLOCK_MEASURE);		           /* Set buffer */

		Xbtimer(XB_TIMERA, 5, 38, SDL_MintAudio_XbiosInterruptMeasureClock); /* delay mode timer A, prediv /64, 1KHz */

		Jenabint(MFP_TIMERA);

		SDL_MintAudio_clocktics = 0;

		Buffoper(SB_PLA_ENA);

		usleep(110000);

		if((Buffoper(-1) & 1)==0) {

			if (SDL_MintAudio_clocktics) {

				unsigned long khz;

				khz = ((SIZE_BUF_CLOCK_MEASURE/SDL_MintAudio_clocktics) +1) & 0xFFFFFFFE;

				DEBUG_PRINT((DEBUG_NAME "measure %d: freq=%lu KHz\n", i+1, khz));

				if(khz==44) {

					for (j=1; j<4; j++) {

						SDL_MintAudio_AddFrequency(this, MASTERCLOCK_44K/(MASTERPREDIV_FALCON*(1<<j)), MASTERCLOCK_44K, (1<<j)-1, 2+i);

					}

				} else if (khz==48) {

					for (j=1; j<4; j++) {

						SDL_MintAudio_AddFrequency(this, MASTERCLOCK_48K/(MASTERPREDIV_FALCON*(1<<j)), MASTERCLOCK_48K, (1<<j)-1, 2+i);

					}

				}

			} else {

				DEBUG_PRINT((DEBUG_NAME "No measure\n"));

			}

		} else {

			DEBUG_PRINT((DEBUG_NAME "No SDMA clock\n"));

		}

		Buffoper(0);             /* stop */

		Jdisint(MFP_TIMERA);     /* Uninstall interrupt */

	}

	Mfree(buffer);

}

static int Mint_CheckAudio(_THIS, SDL_AudioSpec *spec)

{

	int i;

	Uint32 extclock;

	DEBUG_PRINT((DEBUG_NAME "asked: %d bits, ",spec->format & 0x00ff));

	DEBUG_PRINT(("signed=%d, ", ((spec->format & 0x8000)!=0)));

	DEBUG_PRINT(("big endian=%d, ", ((spec->format & 0x1000)!=0)));

	DEBUG_PRINT(("channels=%d, ", spec->channels));

	DEBUG_PRINT(("freq=%d\n", spec->freq));

    if (spec->channels > 2) {

        spec->channels = 2;  /* no more than stereo! */

    }

	spec->format |= 0x8000;	/* Audio is always signed */

	if ((spec->format & 0x00ff)==16) {

		spec->format |= 0x1000;	/* Audio is always big endian */

		spec->channels=2;	/* 16 bits always stereo */

	}

	MINTAUDIO_freqcount=0;

	/* Add external clocks if present */

	Mint_CheckExternalClock(this);

	/* Standard clocks */

	for (i=1;i<12;i++) {

		/* Remove unusable Falcon codec predivisors */

		if ((i==6) || (i==8) || (i==10)) {

			continue;

		}

		SDL_MintAudio_AddFrequency(this, MASTERCLOCK_FALCON1/(MASTERPREDIV_FALCON*(i+1)), MASTERCLOCK_FALCON1, i, -1);

	}

#if 1

	for (i=0; i<MINTAUDIO_freqcount; i++) {

		DEBUG_PRINT((DEBUG_NAME "freq %d: %lu Hz, clock %lu, prediv %d\n",

			i, MINTAUDIO_frequencies[i].frequency, MINTAUDIO_frequencies[i].masterclock,

			MINTAUDIO_frequencies[i].predivisor

		));

	}

#endif

	MINTAUDIO_numfreq=SDL_MintAudio_SearchFrequency(this, spec->freq);

	spec->freq=MINTAUDIO_frequencies[MINTAUDIO_numfreq].frequency;

	DEBUG_PRINT((DEBUG_NAME "obtained: %d bits, ",spec->format & 0x00ff));

	DEBUG_PRINT(("signed=%d, ", ((spec->format & 0x8000)!=0)));

	DEBUG_PRINT(("big endian=%d, ", ((spec->format & 0x1000)!=0)));

	DEBUG_PRINT(("channels=%d, ", spec->channels));

	DEBUG_PRINT(("freq=%d\n", spec->freq));

	return 0;

}

static void Mint_InitAudio(_THIS, SDL_AudioSpec *spec)

{

	int channels_mode, dmaclock, prediv;

	void *buffer;

	/* Stop currently playing sound */

	SDL_MintAudio_quit_thread = SDL_FALSE;

	SDL_MintAudio_thread_finished = SDL_TRUE;

	SDL_MintAudio_WaitThread();

	Buffoper(0);

	/* Set replay tracks */

	Settracks(0,0);

	Setmontracks(0);

	/* Select replay format */

	channels_mode=STEREO16;

	switch (spec->format & 0xff) {

		case 8:

			if (spec->channels==2) {

				channels_mode=STEREO8;

			} else {

				channels_mode=MONO8;

			}

			break;

	}

	if (Setmode(channels_mode)<0) {

		DEBUG_PRINT((DEBUG_NAME "Setmode() failed\n"));

	}

	dmaclock = MINTAUDIO_frequencies[MINTAUDIO_numfreq].masterclock;

	prediv = MINTAUDIO_frequencies[MINTAUDIO_numfreq].predivisor;

	if (MINTAUDIO_frequencies[MINTAUDIO_numfreq].gpio_bits != -1) {

		Gpio(GPIO_SET,7);		/* DSP port gpio outputs */

		Gpio(GPIO_WRITE, MINTAUDIO_frequencies[MINTAUDIO_numfreq].gpio_bits);

		Devconnect2(DMAPLAY, DAC|EXTOUT, CLKEXT, prediv);

	} else {

		Devconnect2(DMAPLAY, DAC, CLK25M, prediv);

	}

	/* Set buffer */

	buffer = SDL_MintAudio_audiobuf[SDL_MintAudio_numbuf];

	if (Setbuffer(0, buffer, buffer + spec->size)<0) {

		DEBUG_PRINT((DEBUG_NAME "Setbuffer() failed\n"));

	}

	if (SDL_MintAudio_mint_present) {

		SDL_MintAudio_thread_pid = tfork(SDL_MintAudio_Thread, 0);

	} else {

		/* Install interrupt */

		Jdisint(MFP_DMASOUND);

		/*Xbtimer(XB_TIMERA, 8, 1, SDL_MintAudio_XbiosInterrupt);*/

		Xbtimer(XB_TIMERA, 8, 1, SDL_MintAudio_Dma8Interrupt);

		Jenabint(MFP_DMASOUND);

		if (Setinterrupt(SI_TIMERA, SI_PLAY)<0) {

			DEBUG_PRINT((DEBUG_NAME "Setinterrupt() failed\n"));

		}

	}

	/* Go */

	Buffoper(SB_PLA_ENA|SB_PLA_RPT);

	DEBUG_PRINT((DEBUG_NAME "hardware initialized\n"));

}

static int Mint_OpenAudio(_THIS, SDL_AudioSpec *spec)

{

	/* Lock sound system */

	if (Locksnd()!=1) {

   	    SDL_SetError("Mint_OpenAudio: Audio system already in use");

        return(-1);

	}

	SDL_MintAudio_device = this;

	/* Check audio capabilities */

	if (Mint_CheckAudio(this, spec)==-1) {

		return -1;

	}

	SDL_CalculateAudioSpec(spec);

	/* Allocate memory for audio buffers in DMA-able RAM */

	DEBUG_PRINT((DEBUG_NAME "buffer size=%d\n", spec->size));

	SDL_MintAudio_audiobuf[0] = Atari_SysMalloc(spec->size *2, MX_STRAM);

	if (SDL_MintAudio_audiobuf[0]==NULL) {

		SDL_SetError("MINT_OpenAudio: Not enough memory for audio buffer");

		return (-1);

	}

	SDL_MintAudio_audiobuf[1] = SDL_MintAudio_audiobuf[0] + spec->size ;

	SDL_MintAudio_numbuf=0;

	SDL_memset(SDL_MintAudio_audiobuf[0], spec->silence, spec->size *2);

	SDL_MintAudio_audiosize = spec->size;

	SDL_MintAudio_mutex = 0;

	DEBUG_PRINT((DEBUG_NAME "buffer 0 at 0x%08x\n", SDL_MintAudio_audiobuf[0]));

	DEBUG_PRINT((DEBUG_NAME "buffer 1 at 0x%08x\n", SDL_MintAudio_audiobuf[1]));

	SDL_MintAudio_CheckFpu();

	/* Setup audio hardware */

	Mint_InitAudio(this, spec);

    return(1);	/* We don't use SDL threaded audio */

}