Newer
Older
Scratch / mobius / src / drivers / sound / solo1 / solo1.c
/*****************************************************************************
"skeleton" driver
*****************************************************************************/
#include "sound.h"
#include <kernel/sys.h>

/* DSP buffers -- large for few interrupts, small for responsiveness */
#define	NUM_BUFS	2
#define	LG2_BUF_SIZE	10
#define	BUF_SIZE	(1u << (LG2_BUF_SIZE))

typedef struct solo_t solo_t;
struct solo_t
{
	sound_t sound;
	device_t *device;
};

#define PCI_VENDOR_ESS			0x125d
#define PCI_DEVICE_ESS_SOLO1	0x1969

static bool _is_open;
static volatile bool _playback_in_progress;
/* THIS IS WRONG: static volatile unsigned char far *_dsp_buff_out; */
static unsigned char * volatile _dsp_buff_out;
static unsigned char *_dsp_buff_mem, *_dsp_buff_base, *_dsp_buff_in;
/*****************************************************************************
*****************************************************************************/
static void solo_set_volume(sound_t *sound, unsigned char level)
{
	TRACE1("solo_set_volume: %u/255\n", level);
}
/*****************************************************************************
*****************************************************************************/
static long solo_find_closest_rate(sound_t *sound, long rate)
{
	TRACE2("solo_find_closest_rate: %ld -> %ld\n", rate, rate);
	return rate;
}
/*****************************************************************************
*****************************************************************************/
static int solo_set_fmt(sound_t *sound, unsigned char depth, 
						unsigned char channels, long rate)
{
	switch(depth)
	{
		case 8:
			break;
		case 16:
			break;
		default:
			wprintf(L"solo_set_fmt: error: bits/sample (%u) "
				"is not 8 nor 16\n", depth);
			return -1;
	}
	switch(channels)
	{
		case 1:
			break;
		case 2:
			break;
		default:
			wprintf(L"solo_set_fmt: error: channels (%u) "
				"is not 1 nor 2\n", channels);
			return -1;
	}
	switch(rate)
	{
		case 8000:
		case 11025:
		case 22050:
		case 44100u:
			break;
		default:
			wprintf(L"solo_set_fmt: error: unsupported "
				"sample rate %ld\n", rate);
			return -1;
	}
	return 0;
}
/*****************************************************************************
*****************************************************************************/
static void solo_start_playback(sound_t *sound, unsigned long count)
{
	_playback_in_progress = true;
}
/*****************************************************************************
*****************************************************************************/
static void solo_stop_playback(sound_t *sound, bool wait)
{
	if(wait)
	{
		TRACE0("waiting...\n");
		while(_playback_in_progress)
			/* nothing */;
	}
	else
	{
		_playback_in_progress = false;
	}
}
/*****************************************************************************
*****************************************************************************/
static int write_sample(sound_t *sound, short left, short right)
{
	unsigned short in_buf, out_buf, new_in_buf, count;
	unsigned char depth, channels;
	bool wait = false;

depth = 8;
channels = 1;
/* to which buffer are we writing? */
	in_buf = _dsp_buff_in - _dsp_buff_base;
	in_buf >>= LG2_BUF_SIZE;
	while(1)
/* from which buffer are we playing? */
	{
		out_buf = _dsp_buff_out - _dsp_buff_base;
		out_buf >>= LG2_BUF_SIZE;
/* if they are the same, and if playback is active,
then wait until playback of this buffer is complete */
		if(out_buf != in_buf)
			break;
		if(!_playback_in_progress)
			break;
		if(!wait)
		{
			TRACE0("waiting...");
			wait = true;
		}
	}
/* store sample and advance pointer */
	if(depth == 16)
	{
/* assumes LITTLE ENDIAN 16-bit samples for this sound hardware */
		write_le16(_dsp_buff_in, left);
		_dsp_buff_in += 2;
		if(channels == 2)
		{
			write_le16(_dsp_buff_in, right);
			_dsp_buff_in += 2;
			count = BUF_SIZE >> 2;
		}
		else
			count = BUF_SIZE >> 1;
	}
	else /* if(depth == 8) */
	{
		left >>= 8;
		*_dsp_buff_in = left;
		_dsp_buff_in++;
		if(channels == 2)
		{
			right >>= 8;
			*_dsp_buff_in = right;
			_dsp_buff_in++;
			count = BUF_SIZE >> 1;
		}
		else
			count = BUF_SIZE;
	}
	if(_dsp_buff_in >= _dsp_buff_base + NUM_BUFS * BUF_SIZE)
		_dsp_buff_in = _dsp_buff_base;
/* did we cross over into a new buffer? */
	new_in_buf = _dsp_buff_in - _dsp_buff_base;
	new_in_buf >>= LG2_BUF_SIZE;
/* if yes, and if not currently playing, then kick-start playback */
	if((new_in_buf != in_buf) && !_playback_in_progress)
	{
/* you should see this message ONCE, when playback starts
see it again if you pause/unpause the playback

if you see it many times, something's wrong */
		wprintf(L"*** kicking playback ***\n");
		solo_start_playback(sound, count);
	}
	return 0;
}
/*****************************************************************************
detect sound hardware, allocate DSP buffers, install interrupt hanadler
*****************************************************************************/
static bool solo_open(sound_t *sound)
{
	solo_t *solo = (solo_t*) sound;
	dword index, end;
	word iobase, sbbase, vcbase, temp;
	byte val;

	/* The SOLO-1 is a PCI device: check configuration */
	if (solo->device->config == NULL ||
		solo->device->config->vendor_id != PCI_VENDOR_ESS ||
		solo->device->config->device_id != PCI_DEVICE_ESS_SOLO1)
	{
		TRACE0("solo_open: invalid PCI config\n");
		return false;
	}

	/* index should = zero */
	index = devFindResource(solo->device->config, dresIo, 0);
	if (index == (dword) -1)
	{
		TRACE0("solo_open: no IO port configured\n");
		return false;
	}

	iobase = solo->device->config->resources[index].u.io.base;
	sbbase = solo->device->config->resources[index + 1].u.io.base;
	vcbase = solo->device->config->resources[index + 2].u.io.base;
	TRACE3("solo_open: resetting device at io=%x sb=%x vc=%x\n", 
		iobase, sbbase, vcbase);
	
	/*
	 * Reset the SOLO-1
	 */

	/* Pulse sbbase + 6, bit 0 */
	out(sbbase + 6, in(sbbase + 6) | 1);
	temp = in(sbbase + 6);
	out(sbbase + 6, in(sbbase + 6) & ~1);

	/* Wait at least 1ms for sbbase + 0xE bit 7 to be set */
	end = sysUpTime() + 10;
	while (sysUpTime() < end &&
		(in(sbbase + 0xE) & 0x80) == 0)
		;

	/* Confirm that sbbase + 0xA == 0xAA */
	if ((val = in(sbbase + 0xA)) != 0xAA)
	{
		TRACE1("solo_open: reset failed (%x)\n", val);
		return false;
	}

	/*
	 * Configure SOLO-1 in native mode
	 */

	
	_is_open = true;
	return true;
}
/*****************************************************************************
*****************************************************************************/
static void solo_close(sound_t *sound)
{
	TRACE0("solo_close\n");
/* already closed? */
	if(!_is_open)
	{
		wprintf(L"solo_close: sound hardware already closed\n");
		return;
	}
/* abort playback */
	if(_playback_in_progress)
	{
		TRACE0("aborting playback...\n");
		solo_stop_playback(sound, false);
	}
/* free DSP buffers; restore old interrupt vector */
	_is_open = false;
}
/*****************************************************************************
*****************************************************************************/
solo_t solo_drv =
{
	{
		solo_open,
		solo_find_closest_rate,
		solo_set_fmt,
		solo_set_volume,
		write_sample,
		solo_stop_playback,
		solo_close,
	},
	NULL
};

sound_t *solo_init(device_t *dev)
{
	solo_drv.device = dev;
	return &solo_drv.sound;
}