trunk/rdesktop/rdpsnd_libao.c

/* -*- c-basic-offset: 8 -*-
   rdesktop: A Remote Desktop Protocol client.
   Sound Channel Process Functions - libao-driver
   Copyright (C) Matthew Chapman 2003
   Copyright (C) GuoJunBo guojunbo@ict.ac.cn 2003
   Copyright (C) Michael Gernoth mike@zerfleddert.de 2005-2006

   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License as published by
   the Free Software Foundation; either version 2 of the License, or
   (at your option) any later version.

   This program 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 General Public License for more details.

   You should have received a copy of the GNU General Public License
   along with this program; if not, write to the Free Software
   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#include "rdesktop.h"
#include "rdpsnd.h"
#include <unistd.h>
#include <fcntl.h>
#include <errno.h>
#include <ao/ao.h>
#include <sys/time.h>

#define WAVEOUTBUF      16

static ao_device *o_device = NULL;
static int default_driver;
static int samplerate;
static int audiochannels;
static BOOL reopened;
static short samplewidth;
static char *libao_device = NULL;

BOOL
libao_open(void)
{
        ao_sample_format format;
        static int warned = 0;

        if (!warned && libao_device)
        {
                warning("device-options not supported for libao-driver\n");
                warned = 1;
        }

        ao_initialize();
        default_driver = ao_default_driver_id();

        format.bits = 16;
        format.channels = 2;
        audiochannels = 2;
        format.rate = 44100;
        samplerate = 44100;
        format.byte_format = AO_FMT_LITTLE;

        o_device = ao_open_live(default_driver, &format, NULL);
        if (o_device == NULL)
        {
                return False;
        }

        g_dsp_fd = 0;
        rdpsnd_queue_init();

        reopened = True;

        return True;
}

void
libao_close(void)
{
        /* Ack all remaining packets */
        while (!rdpsnd_queue_empty())
        {
                rdpsnd_send_completion(rdpsnd_queue_current_packet()->tick,
                                       rdpsnd_queue_current_packet()->index);
                rdpsnd_queue_next();
        }

        if (o_device != NULL)
                ao_close(o_device);

        ao_shutdown();
}

BOOL
libao_format_supported(WAVEFORMATEX * pwfx)
{
        if (pwfx->wFormatTag != WAVE_FORMAT_PCM)
                return False;
        if ((pwfx->nChannels != 1) && (pwfx->nChannels != 2))
                return False;
        if ((pwfx->wBitsPerSample != 8) && (pwfx->wBitsPerSample != 16))
                return False;
        /* The only common denominator between libao output drivers is a sample-rate of
           44100, we need to upsample 22050 to it */
        if ((pwfx->nSamplesPerSec != 44100) && (pwfx->nSamplesPerSec != 22050))
                return False;

        return True;
}

BOOL
libao_set_format(WAVEFORMATEX * pwfx)
{
        ao_sample_format format;

        format.bits = pwfx->wBitsPerSample;
        format.channels = pwfx->nChannels;
        audiochannels = pwfx->nChannels;
        format.rate = 44100;
        samplerate = pwfx->nSamplesPerSec;
        format.byte_format = AO_FMT_LITTLE;

        samplewidth = pwfx->wBitsPerSample / 8;

        if (o_device != NULL)
                ao_close(o_device);

        o_device = ao_open_live(default_driver, &format, NULL);
        if (o_device == NULL)
        {
                return False;
        }

        reopened = True;

        return True;
}

void
libao_volume(uint16 left, uint16 right)
{
        warning("volume changes not supported with libao-output\n");
}

void
libao_play(void)
{
        struct audio_packet *packet;
        STREAM out;
        char outbuf[WAVEOUTBUF];
        int offset, len, i;
        static long prev_s, prev_us;
        unsigned int duration;
        struct timeval tv;
        int next_tick;

        if (reopened)
        {
                reopened = False;
                gettimeofday(&tv, NULL);
                prev_s = tv.tv_sec;
                prev_us = tv.tv_usec;
        }

        if (rdpsnd_queue_empty())
        {
                g_dsp_busy = 0;
                return;
        }

        packet = rdpsnd_queue_current_packet();
        out = &packet->s;

        next_tick = rdpsnd_queue_next_tick();

        len = 0;

        if (samplerate == 22050)
        {
                /* Resample to 44100 */
                for (i = 0; (i < ((WAVEOUTBUF / 4) * (3 - samplewidth))) && (out->p < out->end);
                     i++)
                {
                        /* On a stereo-channel we must make sure that left and right
                           does not get mixed up, so we need to expand the sample-
                           data with channels in mind: 1234 -> 12123434
                           If we have a mono-channel, we can expand the data by simply
                           doubling the sample-data: 1234 -> 11223344 */
                        if (audiochannels == 2)
                                offset = ((i * 2) - (i & 1)) * samplewidth;
                        else
                                offset = (i * 2) * samplewidth;

                        memcpy(&outbuf[offset], out->p, samplewidth);
                        memcpy(&outbuf[audiochannels * samplewidth + offset], out->p, samplewidth);

                        out->p += samplewidth;
                        len += 2 * samplewidth;
                }
        }
        else
        {
                len = (WAVEOUTBUF > (out->end - out->p)) ? (out->end - out->p) : WAVEOUTBUF;
                memcpy(outbuf, out->p, len);
                out->p += len;
        }

        ao_play(o_device, outbuf, len);

        gettimeofday(&tv, NULL);

        duration = ((tv.tv_sec - prev_s) * 1000000 + (tv.tv_usec - prev_us)) / 1000;

        if (packet->tick > next_tick)
                next_tick += 65536;

        if ((out->p == out->end) || duration > next_tick - packet->tick + 500)
        {
                prev_s = tv.tv_sec;
                prev_us = tv.tv_usec;

                if (abs((next_tick - packet->tick) - duration) > 20)
                {
                        DEBUG(("duration: %d, calc: %d, ", duration, next_tick - packet->tick));
                        DEBUG(("last: %d, is: %d, should: %d\n", packet->tick,
                               (packet->tick + duration) % 65536, next_tick % 65536));
                }

                rdpsnd_send_completion(((packet->tick + duration) % 65536), packet->index);
                rdpsnd_queue_next();
        }

        g_dsp_busy = 1;
        return;
}

struct audio_driver *
libao_register(char *options)
{
        static struct audio_driver libao_driver;

        libao_driver.wave_out_write = rdpsnd_queue_write;
        libao_driver.wave_out_open = libao_open;
        libao_driver.wave_out_close = libao_close;
        libao_driver.wave_out_format_supported = libao_format_supported;
        libao_driver.wave_out_set_format = libao_set_format;
        libao_driver.wave_out_volume = libao_volume;
        libao_driver.wave_out_play = libao_play;
        libao_driver.name = xstrdup("libao");
        libao_driver.description = xstrdup("libao output driver");
        libao_driver.next = NULL;

        if (options)
        {
                libao_device = xstrdup(options);
        }

        return &libao_driver;
}
1	astrand	963	/* -- c-basic-offset: 8 --
2	stargo	833	rdesktop: A Remote Desktop Protocol client.
3			Sound Channel Process Functions - libao-driver
4			Copyright (C) Matthew Chapman 2003
5			Copyright (C) GuoJunBo guojunbo@ict.ac.cn 2003
6	stargo	1254	Copyright (C) Michael Gernoth mike@zerfleddert.de 2005-2006
7	stargo	833
8			This program is free software; you can redistribute it and/or modify
9			it under the terms of the GNU General Public License as published by
10			the Free Software Foundation; either version 2 of the License, or
11			(at your option) any later version.
12
13			This program is distributed in the hope that it will be useful,
14			but WITHOUT ANY WARRANTY; without even the implied warranty of
15			MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16			GNU General Public License for more details.
17
18			You should have received a copy of the GNU General Public License
19			along with this program; if not, write to the Free Software
20			Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21			*/
22
23			#include "rdesktop.h"
24	stargo	1254	#include "rdpsnd.h"
25	stargo	833	#include <unistd.h>
26			#include <fcntl.h>
27			#include <errno.h>
28			#include <ao/ao.h>
29	stargo	891	#include <sys/time.h>
30	stargo	833
31	stargo	1045	#define WAVEOUTBUF 16
32	stargo	833
33	stargo	1245	static ao_device *o_device = NULL;
34			static int default_driver;
35			static int samplerate;
36			static int audiochannels;
37			static BOOL reopened;
38			static short samplewidth;
39	stargo	1255	static char *libao_device = NULL;
40	stargo	833
41			BOOL
42	stargo	1255	libao_open(void)
43	stargo	833	{
44			ao_sample_format format;
45	stargo	1255	static int warned = 0;
46	stargo	833
47	stargo	1255	if (!warned && libao_device)
48			{
49			warning("device-options not supported for libao-driver\n");
50			warned = 1;
51			}
52
53	stargo	833	ao_initialize();
54			default_driver = ao_default_driver_id();
55
56			format.bits = 16;
57			format.channels = 2;
58	stargo	1245	audiochannels = 2;
59	stargo	833	format.rate = 44100;
60	stargo	1245	samplerate = 44100;
61	stargo	833	format.byte_format = AO_FMT_LITTLE;
62
63			o_device = ao_open_live(default_driver, &format, NULL);
64			if (o_device == NULL)
65			{
66			return False;
67			}
68
69			g_dsp_fd = 0;
70	stargo	1254	rdpsnd_queue_init();
71	stargo	833
72	stargo	1245	reopened = True;
73	stargo	891
74	stargo	833	return True;
75			}
76
77			void
78	stargo	1255	libao_close(void)
79	stargo	833	{
80			/* Ack all remaining packets */
81	stargo	1254	while (!rdpsnd_queue_empty())
82	stargo	833	{
83	stargo	1254	rdpsnd_send_completion(rdpsnd_queue_current_packet()->tick,
84			rdpsnd_queue_current_packet()->index);
85			rdpsnd_queue_next();
86	stargo	833	}
87
88			if (o_device != NULL)
89			ao_close(o_device);
90	stargo	838
91	stargo	833	ao_shutdown();
92			}
93
94			BOOL
95	stargo	1255	libao_format_supported(WAVEFORMATEX * pwfx)
96	stargo	833	{
97			if (pwfx->wFormatTag != WAVE_FORMAT_PCM)
98			return False;
99			if ((pwfx->nChannels != 1) && (pwfx->nChannels != 2))
100			return False;
101			if ((pwfx->wBitsPerSample != 8) && (pwfx->wBitsPerSample != 16))
102			return False;
103			/* The only common denominator between libao output drivers is a sample-rate of
104	stargo	835	44100, we need to upsample 22050 to it */
105			if ((pwfx->nSamplesPerSec != 44100) && (pwfx->nSamplesPerSec != 22050))
106	stargo	833	return False;
107
108			return True;
109			}
110
111			BOOL
112	stargo	1255	libao_set_format(WAVEFORMATEX * pwfx)
113	stargo	833	{
114			ao_sample_format format;
115
116			format.bits = pwfx->wBitsPerSample;
117			format.channels = pwfx->nChannels;
118	stargo	1245	audiochannels = pwfx->nChannels;
119	stargo	833	format.rate = 44100;
120	stargo	1245	samplerate = pwfx->nSamplesPerSec;
121	stargo	833	format.byte_format = AO_FMT_LITTLE;
122
123	stargo	1245	samplewidth = pwfx->wBitsPerSample / 8;
124	stargo	833
125	stargo	837	if (o_device != NULL)
126	stargo	833	ao_close(o_device);
127
128			o_device = ao_open_live(default_driver, &format, NULL);
129			if (o_device == NULL)
130			{
131			return False;
132			}
133
134	stargo	1245	reopened = True;
135	stargo	833
136			return True;
137			}
138
139			void
140	stargo	1255	libao_volume(uint16 left, uint16 right)
141	stargo	833	{
142	stargo	838	warning("volume changes not supported with libao-output\n");
143	stargo	833	}
144
145			void
146	stargo	1255	libao_play(void)
147	stargo	833	{
148			struct audio_packet *packet;
149			STREAM out;
150	stargo	1043	char outbuf[WAVEOUTBUF];
151	stargo	837	int offset, len, i;
152	stargo	891	static long prev_s, prev_us;
153			unsigned int duration;
154			struct timeval tv;
155			int next_tick;
156	stargo	833
157	stargo	1245	if (reopened)
158	stargo	891	{
159	stargo	1245	reopened = False;
160	stargo	891	gettimeofday(&tv, NULL);
161			prev_s = tv.tv_sec;
162			prev_us = tv.tv_usec;
163			}
164
165	stargo	1254	if (rdpsnd_queue_empty())
166	stargo	833	{
167	stargo	835	g_dsp_busy = 0;
168			return;
169			}
170	stargo	833
171	stargo	1254	packet = rdpsnd_queue_current_packet();
172	stargo	835	out = &packet->s;
173	stargo	833
174	stargo	1254	next_tick = rdpsnd_queue_next_tick();
175	stargo	891
176	stargo	835	len = 0;
177	stargo	833
178	stargo	1245	if (samplerate == 22050)
179	stargo	835	{
180			/* Resample to 44100 */
181	stargo	1245	for (i = 0; (i < ((WAVEOUTBUF / 4) * (3 - samplewidth))) && (out->p < out->end);
182	stargo	837	i++)
183	stargo	835	{
184	stargo	841	/* On a stereo-channel we must make sure that left and right
185			does not get mixed up, so we need to expand the sample-
186			data with channels in mind: 1234 -> 12123434
187			If we have a mono-channel, we can expand the data by simply
188			doubling the sample-data: 1234 -> 11223344 */
189	stargo	1245	if (audiochannels == 2)
190			offset = ((i * 2) - (i & 1)) * samplewidth;
191	stargo	840	else
192	stargo	1245	offset = (i * 2) * samplewidth;
193	stargo	840
194	stargo	1245	memcpy(&outbuf[offset], out->p, samplewidth);
195			memcpy(&outbuf[audiochannels * samplewidth + offset], out->p, samplewidth);
196	stargo	833
197	stargo	1245	out->p += samplewidth;
198			len += 2 * samplewidth;
199	stargo	833	}
200			}
201	stargo	835	else
202			{
203	stargo	836	len = (WAVEOUTBUF > (out->end - out->p)) ? (out->end - out->p) : WAVEOUTBUF;
204	stargo	837	memcpy(outbuf, out->p, len);
205	stargo	835	out->p += len;
206			}
207
208	stargo	1043	ao_play(o_device, outbuf, len);
209	stargo	835
210	stargo	891	gettimeofday(&tv, NULL);
211
212			duration = ((tv.tv_sec - prev_s) * 1000000 + (tv.tv_usec - prev_us)) / 1000;
213
214			if (packet->tick > next_tick)
215			next_tick += 65536;
216
217			if ((out->p == out->end) \|\| duration > next_tick - packet->tick + 500)
218	stargo	835	{
219	stargo	891	prev_s = tv.tv_sec;
220			prev_us = tv.tv_usec;
221
222			if (abs((next_tick - packet->tick) - duration) > 20)
223			{
224			DEBUG(("duration: %d, calc: %d, ", duration, next_tick - packet->tick));
225			DEBUG(("last: %d, is: %d, should: %d\n", packet->tick,
226			(packet->tick + duration) % 65536, next_tick % 65536));
227			}
228
229	stargo	1254	rdpsnd_send_completion(((packet->tick + duration) % 65536), packet->index);
230			rdpsnd_queue_next();
231	stargo	835	}
232
233			g_dsp_busy = 1;
234			return;
235	stargo	833	}
236	stargo	1255
237			struct audio_driver *
238			libao_register(char *options)
239			{
240	stargo	1256	static struct audio_driver libao_driver;
241
242			libao_driver.wave_out_write = rdpsnd_queue_write;
243			libao_driver.wave_out_open = libao_open;
244			libao_driver.wave_out_close = libao_close;
245			libao_driver.wave_out_format_supported = libao_format_supported;
246			libao_driver.wave_out_set_format = libao_set_format;
247			libao_driver.wave_out_volume = libao_volume;
248			libao_driver.wave_out_play = libao_play;
249			libao_driver.name = xstrdup("libao");
250			libao_driver.description = xstrdup("libao output driver");
251			libao_driver.next = NULL;
252
253	stargo	1255	if (options)
254			{
255			libao_device = xstrdup(options);
256			}
257
258			return &libao_driver;
259			}