Added
Link Here
|
1 |
/* pmsndio.c -- PortMidi os-dependent code */ |
2 |
|
3 |
#include <stdlib.h> |
4 |
#include <stdio.h> |
5 |
#include <sndio.h> |
6 |
#include <string.h> |
7 |
#include <poll.h> |
8 |
#include <errno.h> |
9 |
#include <pthread.h> |
10 |
#include <glob.h> |
11 |
#include "portmidi.h" |
12 |
#include "pmutil.h" |
13 |
#include "pminternal.h" |
14 |
#include "porttime.h" |
15 |
|
16 |
#define NDEVS 1024 |
17 |
#define SYSEX_MAXLEN 1024 |
18 |
|
19 |
#define SYSEX_START 0xf0 |
20 |
#define SYSEX_END 0xf7 |
21 |
|
22 |
PmDeviceID pm_default_input_device_id = -1; |
23 |
PmDeviceID pm_default_output_device_id = -1; |
24 |
|
25 |
extern pm_fns_node pm_sndio_in_dictionary; |
26 |
extern pm_fns_node pm_sndio_out_dictionary; |
27 |
|
28 |
/* length of voice and common messages (status byte included) */ |
29 |
unsigned int voice_len[] = { 3, 3, 3, 3, 2, 2, 3 }; |
30 |
unsigned int common_len[] = { 0, 2, 3, 2, 0, 0, 1, 1 }; |
31 |
|
32 |
struct mio_dev { |
33 |
char name[16]; |
34 |
struct mio_hdl *hdl; |
35 |
int mode; |
36 |
char errmsg[PM_HOST_ERROR_MSG_LEN]; |
37 |
pthread_t thread; |
38 |
} devs[NDEVS]; |
39 |
|
40 |
static void set_mode(struct mio_dev *, unsigned int); |
41 |
|
42 |
void pm_init() |
43 |
{ |
44 |
int i, j, k = 0; |
45 |
char devices[][16] = {"midithru", "rmidi", "midi", "snd"}; |
46 |
glob_t out; |
47 |
|
48 |
/* default */ |
49 |
strcpy(devs[0].name, MIO_PORTANY); |
50 |
pm_add_device("SNDIO", devs[k].name, TRUE, (void *) &devs[k], |
51 |
&pm_sndio_in_dictionary); |
52 |
pm_add_device("SNDIO", devs[k].name, FALSE, (void *) &devs[k], |
53 |
&pm_sndio_out_dictionary); |
54 |
k++; |
55 |
|
56 |
glob("/dev/umidi*.0", GLOB_TILDE, NULL, &out); |
57 |
int umidi_num_major_devs = out.gl_pathc; |
58 |
globfree(&out); |
59 |
|
60 |
for (i = 0; i < 4; i++) { |
61 |
for (j = 0; j < umidi_num_major_devs; j++) { |
62 |
sprintf(devs[k].name, "%s/%d", devices[i], j); |
63 |
pm_add_device("SNDIO", devs[k].name, TRUE, (void *) &devs[k], |
64 |
&pm_sndio_in_dictionary); |
65 |
pm_add_device("SNDIO", devs[k].name, FALSE, (void *) &devs[k], |
66 |
&pm_sndio_out_dictionary); |
67 |
k++; |
68 |
} |
69 |
} |
70 |
|
71 |
// this is set when we return to Pm_Initialize, but we need it |
72 |
// now in order to (successfully) call Pm_CountDevices() |
73 |
pm_initialized = TRUE; |
74 |
pm_default_input_device_id = 0; |
75 |
pm_default_output_device_id = 1; |
76 |
} |
77 |
|
78 |
void pm_term(void) |
79 |
{ |
80 |
int i; |
81 |
glob_t out; |
82 |
|
83 |
glob("/dev/umidi*.0", GLOB_TILDE, NULL, &out); |
84 |
int umidi_num_major_devs = out.gl_pathc; |
85 |
/* each device has matching midithru, rmidi, midi and snd devices */ |
86 |
int ndevs = (umidi_num_major_devs * 4) + 1; |
87 |
globfree(&out); |
88 |
|
89 |
for(i = 0; i < ndevs; i++) { |
90 |
if (devs[i].mode != 0) { |
91 |
set_mode(&devs[i], 0); |
92 |
if (devs[i].thread) { |
93 |
pthread_join(devs[i].thread, NULL); |
94 |
devs[i].thread = NULL; |
95 |
} |
96 |
} |
97 |
} |
98 |
} |
99 |
|
100 |
PmDeviceID Pm_GetDefaultInputDeviceID() { |
101 |
Pm_Initialize(); |
102 |
return pm_default_input_device_id; |
103 |
} |
104 |
|
105 |
PmDeviceID Pm_GetDefaultOutputDeviceID() { |
106 |
Pm_Initialize(); |
107 |
return pm_default_output_device_id; |
108 |
} |
109 |
|
110 |
void *pm_alloc(size_t s) { return malloc(s); } |
111 |
|
112 |
void pm_free(void *ptr) { free(ptr); } |
113 |
|
114 |
/* midi_message_length -- how many bytes in a message? */ |
115 |
static int midi_message_length(PmMessage message) |
116 |
{ |
117 |
unsigned char st = message & 0xff; |
118 |
if (st >= 0xf8) |
119 |
return 1; |
120 |
else if (st >= 0xf0) |
121 |
return common_len[st & 7]; |
122 |
else if (st >= 0x80) |
123 |
return voice_len[(st >> 4) & 7]; |
124 |
else |
125 |
return 0; |
126 |
} |
127 |
|
128 |
void* input_thread(void *param) |
129 |
{ |
130 |
PmInternal *midi = (PmInternal*)param; |
131 |
struct mio_dev *dev = (struct mio_dev *) midi->descriptor; |
132 |
struct pollfd pfd[1]; |
133 |
nfds_t nfds; |
134 |
unsigned char st = 0, c = 0; |
135 |
int rc, revents, idx = 0, len = 0; |
136 |
size_t todo = 0; |
137 |
unsigned char buf[0x200], *p; |
138 |
PmEvent pm_ev, pm_ev_rt; |
139 |
unsigned char sysex_data[SYSEX_MAXLEN]; |
140 |
|
141 |
while(dev->mode & MIO_IN) { |
142 |
if (todo == 0) { |
143 |
nfds = mio_pollfd(dev->hdl, pfd, POLLIN); |
144 |
rc = poll(pfd, nfds, 100); |
145 |
if (rc < 0) { |
146 |
if (errno == EINTR) |
147 |
continue; |
148 |
break; |
149 |
} |
150 |
revents = mio_revents(dev->hdl, pfd); |
151 |
if (!(revents & POLLIN)) |
152 |
continue; |
153 |
|
154 |
todo = mio_read(dev->hdl, buf, sizeof(buf)); |
155 |
if (todo == 0) |
156 |
continue; |
157 |
p = buf; |
158 |
} |
159 |
c = *p++; |
160 |
todo--; |
161 |
|
162 |
if (c >= 0xf8) { |
163 |
pm_ev_rt.message = c; |
164 |
pm_ev_rt.timestamp = Pt_Time(); |
165 |
pm_read_short(midi, &pm_ev_rt); |
166 |
} else if (c == SYSEX_END) { |
167 |
if (st == SYSEX_START) { |
168 |
sysex_data[idx++] = c; |
169 |
pm_read_bytes(midi, sysex_data, idx, Pt_Time()); |
170 |
} |
171 |
st = 0; |
172 |
idx = 0; |
173 |
} else if (c == SYSEX_START) { |
174 |
st = c; |
175 |
idx = 0; |
176 |
sysex_data[idx++] = c; |
177 |
} else if (c >= 0xf0) { |
178 |
pm_ev.message = c; |
179 |
len = common_len[c & 7]; |
180 |
st = c; |
181 |
idx = 1; |
182 |
} else if (c >= 0x80) { |
183 |
pm_ev.message = c; |
184 |
len = voice_len[(c >> 4) & 7]; |
185 |
st = c; |
186 |
idx = 1; |
187 |
} else if (st == SYSEX_START) { |
188 |
if (idx == SYSEX_MAXLEN) { |
189 |
fprintf(stderr, "the message is too long\n"); |
190 |
idx = st = 0; |
191 |
} else { |
192 |
sysex_data[idx++] = c; |
193 |
} |
194 |
} else if (st) { |
195 |
if (idx == 0 && st != SYSEX_START) |
196 |
pm_ev.message |= (c << (8 * idx++)); |
197 |
pm_ev.message |= (c << (8 * idx++)); |
198 |
if (idx == len) { |
199 |
pm_read_short(midi, &pm_ev); |
200 |
if (st >= 0xf0) |
201 |
st = 0; |
202 |
idx = 0; |
203 |
} |
204 |
} |
205 |
} |
206 |
|
207 |
pthread_exit(NULL); |
208 |
return NULL; |
209 |
} |
210 |
|
211 |
static void set_mode(struct mio_dev *dev, unsigned int mode) { |
212 |
if (dev->mode != 0) |
213 |
mio_close(dev->hdl); |
214 |
dev->mode = 0; |
215 |
if (mode != 0) |
216 |
dev->hdl = mio_open(dev->name, mode, 0); |
217 |
if (dev->hdl) |
218 |
dev->mode = mode; |
219 |
} |
220 |
|
221 |
static PmError sndio_out_open(PmInternal *midi, void *driverInfo) |
222 |
{ |
223 |
descriptor_type desc = &descriptors[midi->device_id]; |
224 |
struct mio_dev *dev = (struct mio_dev *) desc->descriptor; |
225 |
|
226 |
if (dev->mode & MIO_OUT) |
227 |
return pmNoError; |
228 |
|
229 |
set_mode(dev, dev->mode | MIO_OUT); |
230 |
if (!(dev->mode & MIO_OUT)) { |
231 |
snprintf(dev->errmsg, PM_HOST_ERROR_MSG_LEN, |
232 |
"mio_open (output) failed: %s\n", dev->name); |
233 |
return pmHostError; |
234 |
} |
235 |
|
236 |
midi->descriptor = (void *)dev; |
237 |
return pmNoError; |
238 |
} |
239 |
|
240 |
static PmError sndio_in_open(PmInternal *midi, void *driverInfo) |
241 |
{ |
242 |
descriptor_type desc = &descriptors[midi->device_id]; |
243 |
struct mio_dev *dev = (struct mio_dev *) desc->descriptor; |
244 |
|
245 |
if (dev->mode & MIO_IN) |
246 |
return pmNoError; |
247 |
|
248 |
set_mode(dev, dev->mode | MIO_IN); |
249 |
if (!(dev->mode & MIO_IN)) { |
250 |
snprintf(dev->errmsg, PM_HOST_ERROR_MSG_LEN, |
251 |
"mio_open (input) failed: %s\n", dev->name); |
252 |
return pmHostError; |
253 |
} |
254 |
midi->descriptor = (void *)dev; |
255 |
pthread_attr_t attr; |
256 |
pthread_attr_init(&attr); |
257 |
pthread_create(&dev->thread, &attr, input_thread, ( void* )midi); |
258 |
return pmNoError; |
259 |
} |
260 |
|
261 |
static PmError sndio_out_close(PmInternal *midi) |
262 |
{ |
263 |
struct mio_dev *dev = (struct mio_dev *) midi->descriptor; |
264 |
|
265 |
if (dev->mode & MIO_OUT) |
266 |
set_mode(dev, dev->mode & ~MIO_OUT); |
267 |
return pmNoError; |
268 |
} |
269 |
|
270 |
static PmError sndio_in_close(PmInternal *midi) |
271 |
{ |
272 |
struct mio_dev *dev = (struct mio_dev *) midi->descriptor; |
273 |
|
274 |
if (dev->mode & MIO_IN) { |
275 |
set_mode(dev, dev->mode & ~MIO_IN); |
276 |
pthread_join(dev->thread, NULL); |
277 |
dev->thread = NULL; |
278 |
} |
279 |
return pmNoError; |
280 |
} |
281 |
|
282 |
static PmError sndio_abort(PmInternal *midi) |
283 |
{ |
284 |
return pmNoError; |
285 |
} |
286 |
|
287 |
static PmTimestamp sndio_synchronize(PmInternal *midi) |
288 |
{ |
289 |
return 0; |
290 |
} |
291 |
|
292 |
static PmError do_write(struct mio_dev *dev, const void *addr, size_t nbytes) |
293 |
{ |
294 |
size_t w = mio_write(dev->hdl, addr, nbytes); |
295 |
|
296 |
if (w != nbytes) { |
297 |
snprintf(dev->errmsg, PM_HOST_ERROR_MSG_LEN, |
298 |
"mio_write failed, bytes written:%zu\n", w); |
299 |
return pmHostError; |
300 |
} |
301 |
return pmNoError; |
302 |
} |
303 |
|
304 |
static PmError sndio_write_byte(PmInternal *midi, unsigned char byte, |
305 |
PmTimestamp timestamp) |
306 |
{ |
307 |
struct mio_dev *dev = (struct mio_dev *) midi->descriptor; |
308 |
|
309 |
return do_write(dev, &byte, 1); |
310 |
} |
311 |
|
312 |
static PmError sndio_write_short(PmInternal *midi, PmEvent *event) |
313 |
{ |
314 |
struct mio_dev *dev = (struct mio_dev *) midi->descriptor; |
315 |
int nbytes = midi_message_length(event->message); |
316 |
|
317 |
if (midi->latency > 0) { |
318 |
/* XXX the event should be queued for later playback */ |
319 |
return do_write(dev, &event->message, nbytes); |
320 |
} else { |
321 |
return do_write(dev, &event->message, nbytes); |
322 |
} |
323 |
return pmNoError; |
324 |
} |
325 |
|
326 |
static PmError sndio_write_flush(PmInternal *midi, PmTimestamp timestamp) |
327 |
{ |
328 |
return pmNoError; |
329 |
} |
330 |
|
331 |
PmError sndio_sysex(PmInternal *midi, PmTimestamp timestamp) |
332 |
{ |
333 |
return pmNoError; |
334 |
} |
335 |
|
336 |
static unsigned int sndio_has_host_error(PmInternal *midi) |
337 |
{ |
338 |
struct mio_dev *dev = (struct mio_dev *) midi->descriptor; |
339 |
|
340 |
return (dev->errmsg[0] != '\0'); |
341 |
} |
342 |
|
343 |
static void sndio_get_host_error(PmInternal *midi, char *msg, unsigned int len) |
344 |
{ |
345 |
struct mio_dev *dev = (struct mio_dev *) midi->descriptor; |
346 |
|
347 |
strlcpy(msg, dev->errmsg, len); |
348 |
dev->errmsg[0] = '\0'; |
349 |
} |
350 |
|
351 |
pm_fns_node pm_sndio_in_dictionary = { |
352 |
none_write_short, |
353 |
none_sysex, |
354 |
none_sysex, |
355 |
none_write_byte, |
356 |
none_write_short, |
357 |
none_write_flush, |
358 |
sndio_synchronize, |
359 |
sndio_in_open, |
360 |
sndio_abort, |
361 |
sndio_in_close, |
362 |
success_poll, |
363 |
sndio_has_host_error, |
364 |
sndio_get_host_error |
365 |
}; |
366 |
|
367 |
pm_fns_node pm_sndio_out_dictionary = { |
368 |
sndio_write_short, |
369 |
sndio_sysex, |
370 |
sndio_sysex, |
371 |
sndio_write_byte, |
372 |
sndio_write_short, |
373 |
sndio_write_flush, |
374 |
sndio_synchronize, |
375 |
sndio_out_open, |
376 |
sndio_abort, |
377 |
sndio_out_close, |
378 |
none_poll, |
379 |
sndio_has_host_error, |
380 |
sndio_get_host_error |
381 |
}; |
382 |
|