23 |
#include <unistd.h> |
#include <unistd.h> |
24 |
#include <fcntl.h> |
#include <fcntl.h> |
25 |
#include <errno.h> |
#include <errno.h> |
26 |
|
#include <sys/time.h> |
27 |
#include <sys/ioctl.h> |
#include <sys/ioctl.h> |
28 |
#include <sys/soundcard.h> |
#include <sys/soundcard.h> |
29 |
|
|
30 |
#define MAX_QUEUE 10 |
#define MAX_QUEUE 10 |
31 |
|
|
32 |
int g_dsp_fd; |
int g_dsp_fd; |
33 |
BOOL g_dsp_busy; |
BOOL g_dsp_busy = False; |
34 |
|
static int g_snd_rate; |
35 |
|
static short g_samplewidth; |
36 |
|
|
37 |
static struct audio_packet { |
static struct audio_packet |
38 |
|
{ |
39 |
struct stream s; |
struct stream s; |
40 |
uint16 tick; |
uint16 tick; |
41 |
uint8 index; |
uint8 index; |
45 |
BOOL |
BOOL |
46 |
wave_out_open(void) |
wave_out_open(void) |
47 |
{ |
{ |
48 |
char *dsp_dev = "/dev/dsp"; |
char *dsp_dev = getenv("AUDIODEV"); |
49 |
|
|
50 |
if ((g_dsp_fd = open(dsp_dev, O_WRONLY)) == -1) |
if (dsp_dev == NULL) |
51 |
|
{ |
52 |
|
dsp_dev = "/dev/dsp"; |
53 |
|
} |
54 |
|
|
55 |
|
if ((g_dsp_fd = open(dsp_dev, O_WRONLY | O_NONBLOCK)) == -1) |
56 |
{ |
{ |
57 |
perror(dsp_dev); |
perror(dsp_dev); |
58 |
return False; |
return False; |
59 |
} |
} |
60 |
|
|
61 |
/* Non-blocking so that user interface is responsive */ |
/* Non-blocking so that user interface is responsive */ |
62 |
fcntl(g_dsp_fd, F_SETFL, fcntl(g_dsp_fd, F_GETFL)|O_NONBLOCK); |
fcntl(g_dsp_fd, F_SETFL, fcntl(g_dsp_fd, F_GETFL) | O_NONBLOCK); |
63 |
return True; |
return True; |
64 |
} |
} |
65 |
|
|
70 |
} |
} |
71 |
|
|
72 |
BOOL |
BOOL |
73 |
wave_out_format_supported(WAVEFORMATEX *pwfx) |
wave_out_format_supported(WAVEFORMATEX * pwfx) |
74 |
{ |
{ |
75 |
if (pwfx->wFormatTag != WAVE_FORMAT_PCM) |
if (pwfx->wFormatTag != WAVE_FORMAT_PCM) |
76 |
return False; |
return False; |
83 |
} |
} |
84 |
|
|
85 |
BOOL |
BOOL |
86 |
wave_out_set_format(WAVEFORMATEX *pwfx) |
wave_out_set_format(WAVEFORMATEX * pwfx) |
87 |
{ |
{ |
88 |
int speed, channels, format; |
int channels, format; |
89 |
|
|
90 |
ioctl(g_dsp_fd, SNDCTL_DSP_RESET, NULL); |
ioctl(g_dsp_fd, SNDCTL_DSP_RESET, NULL); |
91 |
ioctl(g_dsp_fd, SNDCTL_DSP_SYNC, NULL); |
ioctl(g_dsp_fd, SNDCTL_DSP_SYNC, NULL); |
95 |
else if (pwfx->wBitsPerSample == 16) |
else if (pwfx->wBitsPerSample == 16) |
96 |
format = AFMT_S16_LE; |
format = AFMT_S16_LE; |
97 |
|
|
98 |
|
g_samplewidth = pwfx->wBitsPerSample / 8; |
99 |
|
|
100 |
if (ioctl(g_dsp_fd, SNDCTL_DSP_SETFMT, &format) == -1) |
if (ioctl(g_dsp_fd, SNDCTL_DSP_SETFMT, &format) == -1) |
101 |
{ |
{ |
102 |
perror("SNDCTL_DSP_SETFMT"); |
perror("SNDCTL_DSP_SETFMT"); |
112 |
return False; |
return False; |
113 |
} |
} |
114 |
|
|
115 |
speed = pwfx->nSamplesPerSec; |
if (channels == 2) |
116 |
if (ioctl(g_dsp_fd, SNDCTL_DSP_SPEED, &speed) == -1) |
{ |
117 |
|
g_samplewidth *= 2; |
118 |
|
} |
119 |
|
|
120 |
|
g_snd_rate = pwfx->nSamplesPerSec; |
121 |
|
if (ioctl(g_dsp_fd, SNDCTL_DSP_SPEED, &g_snd_rate) == -1) |
122 |
{ |
{ |
123 |
perror("SNDCTL_DSP_SPEED"); |
perror("SNDCTL_DSP_SPEED"); |
124 |
close(g_dsp_fd); |
close(g_dsp_fd); |
129 |
} |
} |
130 |
|
|
131 |
void |
void |
132 |
|
wave_out_volume(uint16 left, uint16 right) |
133 |
|
{ |
134 |
|
static BOOL use_dev_mixer = False; |
135 |
|
uint32 volume; |
136 |
|
int fd_mix = -1; |
137 |
|
|
138 |
|
volume = left / (65536 / 100); |
139 |
|
volume |= right / (65536 / 100) << 8; |
140 |
|
|
141 |
|
if (use_dev_mixer) |
142 |
|
{ |
143 |
|
if ((fd_mix = open("/dev/mixer", O_RDWR | O_NONBLOCK)) == -1) |
144 |
|
{ |
145 |
|
perror("open /dev/mixer"); |
146 |
|
return; |
147 |
|
} |
148 |
|
|
149 |
|
if (ioctl(fd_mix, MIXER_WRITE(SOUND_MIXER_PCM), &volume) == -1) |
150 |
|
{ |
151 |
|
perror("MIXER_WRITE(SOUND_MIXER_PCM)"); |
152 |
|
return; |
153 |
|
} |
154 |
|
|
155 |
|
close(fd_mix); |
156 |
|
} |
157 |
|
|
158 |
|
if (ioctl(g_dsp_fd, MIXER_WRITE(SOUND_MIXER_PCM), &volume) == -1) |
159 |
|
{ |
160 |
|
perror("MIXER_WRITE(SOUND_MIXER_PCM)"); |
161 |
|
use_dev_mixer = True; |
162 |
|
return; |
163 |
|
} |
164 |
|
} |
165 |
|
|
166 |
|
void |
167 |
wave_out_write(STREAM s, uint16 tick, uint8 index) |
wave_out_write(STREAM s, uint16 tick, uint8 index) |
168 |
{ |
{ |
169 |
struct audio_packet *packet = &packet_queue[queue_lo]; |
struct audio_packet *packet = &packet_queue[queue_hi]; |
170 |
unsigned int next_hi = (queue_lo + 1) % MAX_QUEUE; |
unsigned int next_hi = (queue_hi + 1) % MAX_QUEUE; |
171 |
|
|
172 |
if (next_hi == queue_lo) |
if (next_hi == queue_lo) |
173 |
{ |
{ |
180 |
packet->s = *s; |
packet->s = *s; |
181 |
packet->tick = tick; |
packet->tick = tick; |
182 |
packet->index = index; |
packet->index = index; |
183 |
|
packet->s.p += 4; |
184 |
|
|
185 |
/* we steal the data buffer from s, give it a new one */ |
/* we steal the data buffer from s, give it a new one */ |
186 |
s->data = malloc(s->size); |
s->data = malloc(s->size); |
195 |
struct audio_packet *packet; |
struct audio_packet *packet; |
196 |
ssize_t len; |
ssize_t len; |
197 |
STREAM out; |
STREAM out; |
198 |
|
static long startedat_us; |
199 |
|
static long startedat_s; |
200 |
|
static BOOL started = False; |
201 |
|
struct timeval tv; |
202 |
|
|
203 |
while (1) |
while (1) |
204 |
{ |
{ |
211 |
packet = &packet_queue[queue_lo]; |
packet = &packet_queue[queue_lo]; |
212 |
out = &packet->s; |
out = &packet->s; |
213 |
|
|
214 |
len = write(g_dsp_fd, out->p, out->end-out->p); |
if (!started) |
215 |
|
{ |
216 |
|
gettimeofday(&tv, NULL); |
217 |
|
startedat_us = tv.tv_usec; |
218 |
|
startedat_s = tv.tv_sec; |
219 |
|
started = True; |
220 |
|
} |
221 |
|
|
222 |
|
len = write(g_dsp_fd, out->p, out->end - out->p); |
223 |
if (len == -1) |
if (len == -1) |
224 |
{ |
{ |
225 |
if (errno != EWOULDBLOCK) |
if (errno != EWOULDBLOCK) |
231 |
out->p += len; |
out->p += len; |
232 |
if (out->p == out->end) |
if (out->p == out->end) |
233 |
{ |
{ |
234 |
rdpsnd_send_completion(packet->tick, packet->index); |
long long duration; |
235 |
free(out->data); |
long elapsed; |
236 |
queue_lo = (queue_lo + 1) % MAX_QUEUE; |
|
237 |
|
gettimeofday(&tv, NULL); |
238 |
|
duration = (out->size * (1000000 / (g_samplewidth * g_snd_rate))); |
239 |
|
elapsed = (tv.tv_sec - startedat_s) * 1000000 + (tv.tv_usec - startedat_us); |
240 |
|
|
241 |
|
if (elapsed >= (duration * 7) / 10) |
242 |
|
{ |
243 |
|
rdpsnd_send_completion(packet->tick, packet->index); |
244 |
|
free(out->data); |
245 |
|
queue_lo = (queue_lo + 1) % MAX_QUEUE; |
246 |
|
started = False; |
247 |
|
} |
248 |
|
else |
249 |
|
{ |
250 |
|
g_dsp_busy = 1; |
251 |
|
return; |
252 |
|
} |
253 |
} |
} |
254 |
} |
} |
|
|
|
255 |
} |
} |