jack2 codebase
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

1173 lines
29KB

  1. /*
  2. * ALSA RAWMIDI < - > JACK MIDI bridge
  3. *
  4. * Copyright (c) 2006,2007 Dmitry S. Baikov
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, write to the Free Software
  18. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  19. */
  20. /* Required for clock_nanosleep(). Thanks, Nedko */
  21. #define _GNU_SOURCE
  22. #include <stdlib.h>
  23. #include <unistd.h>
  24. #include <errno.h>
  25. #include <pthread.h>
  26. #include <time.h>
  27. #include <limits.h>
  28. #include <ctype.h>
  29. #include <alsa/asoundlib.h>
  30. #include <jack/ringbuffer.h>
  31. #include <jack/midiport.h>
  32. #include "alsa_midi_impl.h"
  33. #include "midi_pack.h"
  34. #include "midi_unpack.h"
  35. enum {
  36. NANOSLEEP_RESOLUTION = 7000
  37. };
  38. #define NFRAMES_INF INT_MAX
  39. enum {
  40. #ifndef DEBUG
  41. MAX_PFDS = 64,
  42. MAX_PORTS = MAX_PFDS-1,
  43. MAX_EVENTS = 4096,
  44. MAX_DATA = 64*1024,
  45. MIDI_THREAD_PRIO = 80
  46. #else
  47. MAX_PFDS = 6,
  48. MAX_PORTS = MAX_PFDS-1,
  49. MAX_EVENTS = 16,
  50. MAX_DATA = 64,
  51. MIDI_THREAD_PRIO = 80
  52. #endif
  53. };
  54. enum PortState {
  55. PORT_DESTROYED,
  56. PORT_CREATED,
  57. PORT_ADDED_TO_JACK,
  58. PORT_ADDED_TO_MIDI,
  59. PORT_REMOVED_FROM_MIDI,
  60. PORT_REMOVED_FROM_JACK,
  61. PORT_ZOMBIFIED,
  62. };
  63. typedef struct {
  64. int id[4]; //card, dev, dir, sub;
  65. } alsa_id_t;
  66. typedef struct {
  67. jack_time_t time;
  68. int size;
  69. int overruns;
  70. } event_head_t;
  71. typedef struct midi_port_t midi_port_t;
  72. struct midi_port_t {
  73. midi_port_t *next;
  74. enum PortState state;
  75. alsa_id_t id;
  76. char dev[16];
  77. char name[64];
  78. jack_port_t *jack;
  79. snd_rawmidi_t *rawmidi;
  80. int npfds;
  81. int is_ready;
  82. jack_ringbuffer_t *event_ring;
  83. jack_ringbuffer_t *data_ring;
  84. };
  85. typedef struct input_port_t {
  86. midi_port_t base;
  87. // jack
  88. midi_unpack_t unpack;
  89. // midi
  90. int overruns;
  91. } input_port_t;
  92. typedef struct output_port_t {
  93. midi_port_t base;
  94. // jack
  95. midi_pack_t packer;
  96. // midi
  97. event_head_t next_event;
  98. int todo;
  99. } output_port_t;
  100. typedef struct alsa_rawmidi_t alsa_rawmidi_t;
  101. typedef struct {
  102. alsa_rawmidi_t *midi;
  103. midi_port_t *port;
  104. void *buffer;
  105. jack_time_t frame_time;
  106. jack_nframes_t nframes;
  107. } process_jack_t;
  108. typedef struct {
  109. alsa_rawmidi_t *midi;
  110. int mode;
  111. midi_port_t *port;
  112. struct pollfd *rpfds;
  113. struct pollfd *wpfds;
  114. int max_pfds;
  115. jack_nframes_t cur_frames;
  116. jack_time_t cur_time;
  117. jack_time_t next_time;
  118. } process_midi_t;
  119. typedef struct midi_stream_t {
  120. alsa_rawmidi_t *owner;
  121. int mode;
  122. const char *name;
  123. pthread_t thread;
  124. int wake_pipe[2];
  125. struct {
  126. jack_ringbuffer_t *new_ports;
  127. int nports;
  128. midi_port_t *ports[MAX_PORTS];
  129. } jack, midi;
  130. size_t port_size;
  131. int (*port_init)(alsa_rawmidi_t *midi, midi_port_t *port);
  132. void (*port_close)(alsa_rawmidi_t *midi, midi_port_t *port);
  133. void (*process_jack)(process_jack_t *j);
  134. int (*process_midi)(process_midi_t *m);
  135. } midi_stream_t;
  136. struct alsa_rawmidi_t {
  137. alsa_midi_t ops;
  138. jack_client_t *client;
  139. int keep_walking;
  140. struct {
  141. pthread_t thread;
  142. midi_port_t *ports;
  143. int wake_pipe[2];
  144. } scan;
  145. midi_stream_t in;
  146. midi_stream_t out;
  147. };
  148. static int input_port_init(alsa_rawmidi_t *midi, midi_port_t *port);
  149. static void input_port_close(alsa_rawmidi_t *midi, midi_port_t *port);
  150. static void do_jack_input(process_jack_t *j);
  151. static int do_midi_input(process_midi_t *m);
  152. static int output_port_init(alsa_rawmidi_t *midi, midi_port_t *port);
  153. static void output_port_close(alsa_rawmidi_t *midi, midi_port_t *port);
  154. static void do_jack_output(process_jack_t *j);
  155. static int do_midi_output(process_midi_t *m);
  156. static
  157. int stream_init(midi_stream_t *s, alsa_rawmidi_t *midi, const char *name)
  158. {
  159. s->owner = midi;
  160. s->name = name;
  161. if (pipe(s->wake_pipe)==-1) {
  162. s->wake_pipe[0] = -1;
  163. error_log("pipe() in stream_init(%s) failed: %s\n", name, strerror(errno));
  164. return -errno;
  165. }
  166. s->jack.new_ports = jack_ringbuffer_create(sizeof(midi_port_t*)*MAX_PORTS);
  167. s->midi.new_ports = jack_ringbuffer_create(sizeof(midi_port_t*)*MAX_PORTS);
  168. if (!s->jack.new_ports || !s->midi.new_ports)
  169. return -ENOMEM;
  170. return 0;
  171. }
  172. static
  173. void stream_close(midi_stream_t *s)
  174. {
  175. if (s->wake_pipe[0] != -1) {
  176. close(s->wake_pipe[0]);
  177. close(s->wake_pipe[1]);
  178. }
  179. if (s->jack.new_ports)
  180. jack_ringbuffer_free(s->jack.new_ports);
  181. if (s->midi.new_ports)
  182. jack_ringbuffer_free(s->midi.new_ports);
  183. }
  184. static void alsa_rawmidi_delete(alsa_midi_t *m);
  185. static int alsa_rawmidi_attach(alsa_midi_t *m);
  186. static int alsa_rawmidi_detach(alsa_midi_t *m);
  187. static int alsa_rawmidi_start(alsa_midi_t *m);
  188. static int alsa_rawmidi_stop(alsa_midi_t *m);
  189. static void alsa_rawmidi_read(alsa_midi_t *m, jack_nframes_t nframes);
  190. static void alsa_rawmidi_write(alsa_midi_t *m, jack_nframes_t nframes);
  191. alsa_midi_t* alsa_rawmidi_new(jack_client_t *jack)
  192. {
  193. alsa_rawmidi_t *midi = calloc(1, sizeof(alsa_rawmidi_t));
  194. if (!midi)
  195. goto fail_0;
  196. midi->client = jack;
  197. if (pipe(midi->scan.wake_pipe)==-1) {
  198. error_log("pipe() in alsa_midi_new failed: %s\n", strerror(errno));
  199. goto fail_1;
  200. }
  201. if (stream_init(&midi->in, midi, "in"))
  202. goto fail_2;
  203. midi->in.mode = POLLIN;
  204. midi->in.port_size = sizeof(input_port_t);
  205. midi->in.port_init = input_port_init;
  206. midi->in.port_close = input_port_close;
  207. midi->in.process_jack = do_jack_input;
  208. midi->in.process_midi = do_midi_input;
  209. if (stream_init(&midi->out, midi, "out"))
  210. goto fail_3;
  211. midi->out.mode = POLLOUT;
  212. midi->out.port_size = sizeof(output_port_t);
  213. midi->out.port_init = output_port_init;
  214. midi->out.port_close = output_port_close;
  215. midi->out.process_jack = do_jack_output;
  216. midi->out.process_midi = do_midi_output;
  217. midi->ops.destroy = alsa_rawmidi_delete;
  218. midi->ops.attach = alsa_rawmidi_attach;
  219. midi->ops.detach = alsa_rawmidi_detach;
  220. midi->ops.start = alsa_rawmidi_start;
  221. midi->ops.stop = alsa_rawmidi_stop;
  222. midi->ops.read = alsa_rawmidi_read;
  223. midi->ops.write = alsa_rawmidi_write;
  224. return &midi->ops;
  225. fail_3:
  226. stream_close(&midi->out);
  227. fail_2:
  228. stream_close(&midi->in);
  229. close(midi->scan.wake_pipe[1]);
  230. close(midi->scan.wake_pipe[0]);
  231. fail_1:
  232. free(midi);
  233. fail_0:
  234. return NULL;
  235. }
  236. static
  237. midi_port_t** scan_port_del(alsa_rawmidi_t *midi, midi_port_t **list);
  238. static
  239. void alsa_rawmidi_delete(alsa_midi_t *m)
  240. {
  241. alsa_rawmidi_t *midi = (alsa_rawmidi_t*)m;
  242. alsa_rawmidi_detach(m);
  243. stream_close(&midi->out);
  244. stream_close(&midi->in);
  245. close(midi->scan.wake_pipe[0]);
  246. close(midi->scan.wake_pipe[1]);
  247. free(midi);
  248. }
  249. static void* scan_thread(void *);
  250. static void *midi_thread(void *arg);
  251. static
  252. int alsa_rawmidi_attach(alsa_midi_t *m)
  253. {
  254. return 0;
  255. }
  256. static
  257. int alsa_rawmidi_detach(alsa_midi_t *m)
  258. {
  259. alsa_rawmidi_t *midi = (alsa_rawmidi_t*)m;
  260. midi_port_t **list;
  261. alsa_rawmidi_stop(m);
  262. list = &midi->scan.ports;
  263. while (*list) {
  264. (*list)->state = PORT_REMOVED_FROM_JACK;
  265. list = scan_port_del(midi, list);
  266. }
  267. return 0;
  268. }
  269. static
  270. int alsa_rawmidi_start(alsa_midi_t *m)
  271. {
  272. alsa_rawmidi_t *midi = (alsa_rawmidi_t*)m;
  273. int err;
  274. char c = 'q';
  275. if (midi->keep_walking == 1)
  276. return -EALREADY;
  277. midi->keep_walking = 1;
  278. if ((err = jack_client_create_thread(midi->client, &midi->in.thread, MIDI_THREAD_PRIO, jack_is_realtime(midi->client), midi_thread, &midi->in))) {
  279. midi->keep_walking = 0;
  280. return err;
  281. }
  282. if ((err = jack_client_create_thread(midi->client, &midi->out.thread, MIDI_THREAD_PRIO, jack_is_realtime(midi->client), midi_thread, &midi->out))) {
  283. midi->keep_walking = 0;
  284. write(midi->in.wake_pipe[1], &c, 1);
  285. pthread_join(midi->in.thread, NULL);
  286. return err;
  287. }
  288. if ((err = jack_client_create_thread(midi->client, &midi->scan.thread, 0, 0, scan_thread, midi))) {
  289. midi->keep_walking = 0;
  290. write(midi->in.wake_pipe[1], &c, 1);
  291. write(midi->out.wake_pipe[1], &c, 1);
  292. pthread_join(midi->in.thread, NULL);
  293. pthread_join(midi->out.thread, NULL);
  294. return err;
  295. }
  296. return 0;
  297. }
  298. static
  299. int alsa_rawmidi_stop(alsa_midi_t *m)
  300. {
  301. alsa_rawmidi_t *midi = (alsa_rawmidi_t*)m;
  302. char c = 'q';
  303. if (midi->keep_walking == 0)
  304. return -EALREADY;
  305. midi->keep_walking = 0;
  306. write(midi->in.wake_pipe[1], &c, 1);
  307. write(midi->out.wake_pipe[1], &c, 1);
  308. write(midi->scan.wake_pipe[1], &c, 1);
  309. pthread_join(midi->in.thread, NULL);
  310. pthread_join(midi->out.thread, NULL);
  311. pthread_join(midi->scan.thread, NULL);
  312. // ports are freed in alsa_midi_detach()
  313. return 0;
  314. }
  315. static void jack_process(midi_stream_t *str, jack_nframes_t nframes);
  316. static
  317. void alsa_rawmidi_read(alsa_midi_t *m, jack_nframes_t nframes)
  318. {
  319. alsa_rawmidi_t *midi = (alsa_rawmidi_t*)m;
  320. jack_process(&midi->in, nframes);
  321. }
  322. static
  323. void alsa_rawmidi_write(alsa_midi_t *m, jack_nframes_t nframes)
  324. {
  325. alsa_rawmidi_t *midi = (alsa_rawmidi_t*)m;
  326. jack_process(&midi->out, nframes);
  327. }
  328. /*
  329. * -----------------------------------------------------------------------------
  330. */
  331. static inline
  332. int can_pass(size_t sz, jack_ringbuffer_t *in, jack_ringbuffer_t *out)
  333. {
  334. return jack_ringbuffer_read_space(in) >= sz && jack_ringbuffer_write_space(out) >= sz;
  335. }
  336. static
  337. void midi_port_init(const alsa_rawmidi_t *midi, midi_port_t *port, snd_rawmidi_info_t *info, const alsa_id_t *id)
  338. {
  339. const char *name;
  340. char *c;
  341. port->id = *id;
  342. snprintf(port->dev, sizeof(port->dev), "hw:%d,%d,%d", id->id[0], id->id[1], id->id[3]);
  343. name = snd_rawmidi_info_get_subdevice_name(info);
  344. if (!strlen(name))
  345. name = snd_rawmidi_info_get_name(info);
  346. snprintf(port->name, sizeof(port->name), "%s %s %s", port->id.id[2] ? "out":"in", port->dev, name);
  347. // replace all offending characters with '-'
  348. for (c=port->name; *c; ++c)
  349. if (!isalnum(*c))
  350. *c = '-';
  351. port->state = PORT_CREATED;
  352. }
  353. static
  354. inline int midi_port_open_jack(const alsa_rawmidi_t *midi, midi_port_t *port, int type, const char *name)
  355. {
  356. port->jack = jack_port_register(midi->client, name, JACK_DEFAULT_MIDI_TYPE,
  357. type | JackPortIsPhysical|JackPortIsTerminal, 0);
  358. return port->jack == NULL;
  359. }
  360. static
  361. int midi_port_open(const alsa_rawmidi_t *midi, midi_port_t *port)
  362. {
  363. int err;
  364. int type;
  365. char name[64];
  366. snd_rawmidi_t **in = NULL;
  367. snd_rawmidi_t **out = NULL;
  368. if (port->id.id[2] == 0) {
  369. in = &port->rawmidi;
  370. type = JackPortIsOutput;
  371. } else {
  372. out = &port->rawmidi;
  373. type = JackPortIsInput;
  374. }
  375. if ((err = snd_rawmidi_open(in, out, port->dev, SND_RAWMIDI_NONBLOCK))<0)
  376. return err;
  377. /* Some devices (emu10k1) have subdevs with the same name,
  378. * and we need to generate unique port name for jack */
  379. snprintf(name, sizeof(name), "%s", port->name);
  380. if (midi_port_open_jack(midi, port, type, name)) {
  381. int num;
  382. num = port->id.id[3] ? port->id.id[3] : port->id.id[1];
  383. snprintf(name, sizeof(name), "%s %d", port->name, num);
  384. if (midi_port_open_jack(midi, port, type, name))
  385. return 2;
  386. }
  387. if ((port->event_ring = jack_ringbuffer_create(MAX_EVENTS*sizeof(event_head_t)))==NULL)
  388. return 3;
  389. if ((port->data_ring = jack_ringbuffer_create(MAX_DATA))==NULL)
  390. return 4;
  391. return 0;
  392. }
  393. static
  394. void midi_port_close(const alsa_rawmidi_t *midi, midi_port_t *port)
  395. {
  396. if (port->data_ring)
  397. jack_ringbuffer_free(port->data_ring);
  398. if (port->event_ring)
  399. jack_ringbuffer_free(port->event_ring);
  400. if (port->jack)
  401. jack_port_unregister(midi->client, port->jack);
  402. if (port->rawmidi)
  403. snd_rawmidi_close(port->rawmidi);
  404. memset(port, 0, sizeof(*port));
  405. }
  406. /*
  407. * ------------------------- Port scanning -------------------------------
  408. */
  409. static
  410. int alsa_id_before(const alsa_id_t *p1, const alsa_id_t *p2)
  411. {
  412. int i;
  413. for (i=0; i<4; ++i) {
  414. if (p1->id[i] < p2->id[i])
  415. return 1;
  416. else if (p1->id[i] > p2->id[i])
  417. return 0;
  418. }
  419. return 0;
  420. }
  421. static
  422. void alsa_get_id(alsa_id_t *id, snd_rawmidi_info_t *info)
  423. {
  424. id->id[0] = snd_rawmidi_info_get_card(info);
  425. id->id[1] = snd_rawmidi_info_get_device(info);
  426. id->id[2] = snd_rawmidi_info_get_stream(info) == SND_RAWMIDI_STREAM_OUTPUT ? 1 : 0;
  427. id->id[3] = snd_rawmidi_info_get_subdevice(info);
  428. }
  429. #include <stdio.h>
  430. static inline
  431. void alsa_error(const char *func, int err)
  432. {
  433. error_log("%s() failed\n", snd_strerror(err));
  434. }
  435. typedef struct {
  436. alsa_rawmidi_t *midi;
  437. midi_port_t **iterator;
  438. snd_ctl_t *ctl;
  439. snd_rawmidi_info_t *info;
  440. } scan_t;
  441. static midi_port_t** scan_port_del(alsa_rawmidi_t *midi, midi_port_t **list);
  442. static
  443. void scan_cleanup(alsa_rawmidi_t *midi)
  444. {
  445. midi_port_t **list = &midi->scan.ports;
  446. while (*list)
  447. list = scan_port_del(midi, list);
  448. }
  449. static void scan_card(scan_t *scan);
  450. static midi_port_t** scan_port_open(alsa_rawmidi_t *midi, midi_port_t **list);
  451. void scan_cycle(alsa_rawmidi_t *midi)
  452. {
  453. int card = -1, err;
  454. scan_t scan;
  455. midi_port_t **ports;
  456. //debug_log("scan: cleanup\n");
  457. scan_cleanup(midi);
  458. scan.midi = midi;
  459. scan.iterator = &midi->scan.ports;
  460. snd_rawmidi_info_alloca(&scan.info);
  461. //debug_log("scan: rescan\n");
  462. while ((err = snd_card_next(&card))>=0 && card>=0) {
  463. char name[32];
  464. snprintf(name, sizeof(name), "hw:%d", card);
  465. if ((err = snd_ctl_open(&scan.ctl, name, SND_CTL_NONBLOCK))>=0) {
  466. scan_card(&scan);
  467. snd_ctl_close(scan.ctl);
  468. } else
  469. alsa_error("scan: snd_ctl_open", err);
  470. }
  471. // delayed open to workaround alsa<1.0.14 bug (can't open more than 1 subdevice if ctl is opened).
  472. ports = &midi->scan.ports;
  473. while (*ports) {
  474. midi_port_t *port = *ports;
  475. if (port->state == PORT_CREATED)
  476. ports = scan_port_open(midi, ports);
  477. else
  478. ports = &port->next;
  479. }
  480. }
  481. static void scan_device(scan_t *scan);
  482. static
  483. void scan_card(scan_t *scan)
  484. {
  485. int device = -1;
  486. int err;
  487. while ((err = snd_ctl_rawmidi_next_device(scan->ctl, &device))>=0 && device >=0) {
  488. snd_rawmidi_info_set_device(scan->info, device);
  489. snd_rawmidi_info_set_stream(scan->info, SND_RAWMIDI_STREAM_INPUT);
  490. snd_rawmidi_info_set_subdevice(scan->info, 0);
  491. if ((err = snd_ctl_rawmidi_info(scan->ctl, scan->info))>=0)
  492. scan_device(scan);
  493. else if (err != -ENOENT)
  494. alsa_error("scan: snd_ctl_rawmidi_info on device", err);
  495. snd_rawmidi_info_set_stream(scan->info, SND_RAWMIDI_STREAM_OUTPUT);
  496. snd_rawmidi_info_set_subdevice(scan->info, 0);
  497. if ((err = snd_ctl_rawmidi_info(scan->ctl, scan->info))>=0)
  498. scan_device(scan);
  499. else if (err != -ENOENT)
  500. alsa_error("scan: snd_ctl_rawmidi_info on device", err);
  501. }
  502. }
  503. static void scan_port_update(scan_t *scan);
  504. static
  505. void scan_device(scan_t *scan)
  506. {
  507. int err;
  508. int sub, nsubs = 0;
  509. nsubs = snd_rawmidi_info_get_subdevices_count(scan->info);
  510. for (sub=0; sub<nsubs; ++sub) {
  511. snd_rawmidi_info_set_subdevice(scan->info, sub);
  512. if ((err = snd_ctl_rawmidi_info(scan->ctl, scan->info)) < 0) {
  513. alsa_error("scan: snd_ctl_rawmidi_info on subdevice", err);
  514. continue;
  515. }
  516. scan_port_update(scan);
  517. }
  518. }
  519. static midi_port_t** scan_port_add(scan_t *scan, const alsa_id_t *id, midi_port_t **list);
  520. static
  521. void scan_port_update(scan_t *scan)
  522. {
  523. midi_port_t **list = scan->iterator;
  524. alsa_id_t id;
  525. alsa_get_id(&id, scan->info);
  526. while (*list && alsa_id_before(&(*list)->id, &id))
  527. list = scan_port_del(scan->midi, list);
  528. if (!*list || alsa_id_before(&id, &(*list)->id))
  529. list = scan_port_add(scan, &id, list);
  530. else if (*list)
  531. list = &(*list)->next;
  532. scan->iterator = list;
  533. }
  534. static
  535. midi_port_t** scan_port_add(scan_t *scan, const alsa_id_t *id, midi_port_t **list)
  536. {
  537. midi_port_t *port;
  538. midi_stream_t *str = id->id[2] ? &scan->midi->out : &scan->midi->in;
  539. port = calloc(1, str->port_size);
  540. if (!port)
  541. return list;
  542. midi_port_init(scan->midi, port, scan->info, id);
  543. port->next = *list;
  544. *list = port;
  545. error_log("scan: added port %s %s\n", port->dev, port->name);
  546. return &port->next;
  547. }
  548. static
  549. midi_port_t** scan_port_open(alsa_rawmidi_t *midi, midi_port_t **list)
  550. {
  551. midi_stream_t *str;
  552. midi_port_t *port;
  553. port = *list;
  554. str = port->id.id[2] ? &midi->out : &midi->in;
  555. if (jack_ringbuffer_write_space(str->jack.new_ports) < sizeof(port))
  556. goto fail_0;
  557. if (midi_port_open(midi, port))
  558. goto fail_1;
  559. if ((str->port_init)(midi, port))
  560. goto fail_2;
  561. port->state = PORT_ADDED_TO_JACK;
  562. jack_ringbuffer_write(str->jack.new_ports, (char*) &port, sizeof(port));
  563. error_log("scan: opened port %s %s\n", port->dev, port->name);
  564. return &port->next;
  565. fail_2:
  566. (str->port_close)(midi, port);
  567. fail_1:
  568. midi_port_close(midi, port);
  569. fail_0:
  570. *list = port->next;
  571. error_log("scan: can't open port %s %s\n", port->dev, port->name);
  572. free(port);
  573. return list;
  574. }
  575. static
  576. midi_port_t** scan_port_del(alsa_rawmidi_t *midi, midi_port_t **list)
  577. {
  578. midi_port_t *port = *list;
  579. if (port->state == PORT_REMOVED_FROM_JACK) {
  580. error_log("scan: deleted port %s %s\n", port->dev, port->name);
  581. *list = port->next;
  582. if (port->id.id[2] )
  583. (midi->out.port_close)(midi, port);
  584. else
  585. (midi->in.port_close)(midi, port);
  586. midi_port_close(midi, port);
  587. free(port);
  588. return list;
  589. } else {
  590. //debug_log("can't delete port %s, wrong state: %d\n", port->name, (int)port->state);
  591. return &port->next;
  592. }
  593. }
  594. void* scan_thread(void *arg)
  595. {
  596. alsa_rawmidi_t *midi = arg;
  597. struct pollfd wakeup;
  598. wakeup.fd = midi->scan.wake_pipe[0];
  599. wakeup.events = POLLIN|POLLERR|POLLNVAL;
  600. while (midi->keep_walking) {
  601. int res;
  602. //error_log("scanning....\n");
  603. scan_cycle(midi);
  604. res = poll(&wakeup, 1, 2000);
  605. if (res>0) {
  606. char c;
  607. read(wakeup.fd, &c, 1);
  608. } else if (res<0 && errno != EINTR)
  609. break;
  610. }
  611. return NULL;
  612. }
  613. /*
  614. * ------------------------------- Input/Output ------------------------------
  615. */
  616. static
  617. void jack_add_ports(midi_stream_t *str)
  618. {
  619. midi_port_t *port;
  620. while (can_pass(sizeof(port), str->jack.new_ports, str->midi.new_ports) && str->jack.nports < MAX_PORTS) {
  621. jack_ringbuffer_read(str->jack.new_ports, (char*)&port, sizeof(port));
  622. str->jack.ports[str->jack.nports++] = port;
  623. port->state = PORT_ADDED_TO_MIDI;
  624. jack_ringbuffer_write(str->midi.new_ports, (char*)&port, sizeof(port));
  625. }
  626. }
  627. static
  628. void jack_process(midi_stream_t *str, jack_nframes_t nframes)
  629. {
  630. int r, w;
  631. process_jack_t proc;
  632. if (!str->owner->keep_walking)
  633. return;
  634. proc.midi = str->owner;
  635. proc.nframes = nframes;
  636. proc.frame_time = jack_last_frame_time(proc.midi->client);
  637. // process existing ports
  638. for (r=0, w=0; r<str->jack.nports; ++r) {
  639. midi_port_t *port = str->jack.ports[r];
  640. proc.port = port;
  641. assert (port->state > PORT_ADDED_TO_JACK && port->state < PORT_REMOVED_FROM_JACK);
  642. proc.buffer = jack_port_get_buffer(port->jack, nframes);
  643. if (str->mode == POLLIN)
  644. jack_midi_clear_buffer(proc.buffer);
  645. if (port->state == PORT_REMOVED_FROM_MIDI) {
  646. port->state = PORT_REMOVED_FROM_JACK; // this signals to scan thread
  647. continue; // this effectively removes port from the midi->in.jack.ports[]
  648. }
  649. (str->process_jack)(&proc);
  650. if (r != w)
  651. str->jack.ports[w] = port;
  652. ++w;
  653. }
  654. if (str->jack.nports != w)
  655. debug_log("jack_%s: nports %d -> %d\n", str->name, str->jack.nports, w);
  656. str->jack.nports = w;
  657. jack_add_ports(str); // it makes no sense to add them earlier since they have no data yet
  658. // wake midi thread
  659. write(str->wake_pipe[1], &r, 1);
  660. }
  661. static
  662. void *midi_thread(void *arg)
  663. {
  664. midi_stream_t *str = arg;
  665. alsa_rawmidi_t *midi = str->owner;
  666. struct pollfd pfds[MAX_PFDS];
  667. int npfds;
  668. jack_time_t wait_nsec = 1000*1000*1000; // 1 sec
  669. process_midi_t proc;
  670. proc.midi = midi;
  671. proc.mode = str->mode;
  672. pfds[0].fd = str->wake_pipe[0];
  673. pfds[0].events = POLLIN|POLLERR|POLLNVAL;
  674. npfds = 1;
  675. //debug_log("midi_thread(%s): enter\n", str->name);
  676. while (midi->keep_walking) {
  677. int poll_timeout;
  678. int wait_nanosleep;
  679. int r=1, w=1; // read,write pos in pfds
  680. int rp=0, wp=0; // read, write pos in ports
  681. // sleep
  682. //if (wait_nsec != 1000*1000*1000) {
  683. // debug_log("midi_thread(%s): ", str->name);
  684. // assert (wait_nsec == 1000*1000*1000);
  685. //}
  686. poll_timeout = wait_nsec / (1000*1000);
  687. wait_nanosleep = wait_nsec % (1000*1000);
  688. if (wait_nanosleep > NANOSLEEP_RESOLUTION) {
  689. struct timespec ts;
  690. ts.tv_sec = 0;
  691. ts.tv_nsec = wait_nanosleep;
  692. clock_nanosleep(CLOCK_MONOTONIC, 0, &ts, NULL);
  693. }
  694. int res = poll((struct pollfd*)&pfds, npfds, poll_timeout);
  695. //debug_log("midi_thread(%s): poll exit: %d\n", str->name, res);
  696. if (!midi->keep_walking)
  697. break;
  698. if (res < 0) {
  699. if (errno == EINTR)
  700. continue;
  701. error_log("midi_thread(%s) poll failed: %s\n", str->name, strerror(errno));
  702. break;
  703. }
  704. // check wakeup pipe
  705. if (pfds[0].revents & ~POLLIN)
  706. break;
  707. if (pfds[0].revents & POLLIN) {
  708. char c;
  709. read(pfds[0].fd, &c, 1);
  710. }
  711. // add new ports
  712. while (jack_ringbuffer_read_space(str->midi.new_ports) >= sizeof(midi_port_t*) && str->midi.nports < MAX_PORTS) {
  713. midi_port_t *port;
  714. jack_ringbuffer_read(str->midi.new_ports, (char*)&port, sizeof(port));
  715. str->midi.ports[str->midi.nports++] = port;
  716. debug_log("midi_thread(%s): added port %s\n", str->name, port->name);
  717. }
  718. // if (res == 0)
  719. // continue;
  720. // process ports
  721. proc.cur_time = 0; //jack_frame_time(midi->client);
  722. proc.next_time = NFRAMES_INF;
  723. for (rp = 0; rp < str->midi.nports; ++rp) {
  724. midi_port_t *port = str->midi.ports[rp];
  725. proc.cur_time = jack_frame_time(midi->client);
  726. proc.port = port;
  727. proc.rpfds = &pfds[r];
  728. proc.wpfds = &pfds[w];
  729. proc.max_pfds = MAX_PFDS - w;
  730. r += port->npfds;
  731. if (!(str->process_midi)(&proc)) {
  732. port->state = PORT_REMOVED_FROM_MIDI; // this signals to jack thread
  733. continue; // this effectively removes port from array
  734. }
  735. w += port->npfds;
  736. if (rp != wp)
  737. str->midi.ports[wp] = port;
  738. ++wp;
  739. }
  740. if (str->midi.nports != wp)
  741. debug_log("midi_%s: nports %d -> %d\n", str->name, str->midi.nports, wp);
  742. str->midi.nports = wp;
  743. if (npfds != w)
  744. debug_log("midi_%s: npfds %d -> %d\n", str->name, npfds, w);
  745. npfds = w;
  746. /*
  747. * Input : ports do not set proc.next_time.
  748. * Output: port sets proc.next_time ONLY if it does not have queued data.
  749. * So, zero timeout will not cause busy-looping.
  750. */
  751. if (proc.next_time < proc.cur_time) {
  752. debug_log("%s: late: next_time = %d, cur_time = %d\n", str->name, (int)proc.next_time, (int)proc.cur_time);
  753. wait_nsec = 0; // we are late
  754. } else if (proc.next_time != NFRAMES_INF) {
  755. jack_time_t wait_frames = proc.next_time - proc.cur_time;
  756. jack_nframes_t rate = jack_get_sample_rate(midi->client);
  757. wait_nsec = (wait_frames * (1000*1000*1000)) / rate;
  758. debug_log("midi_%s: timeout = %d\n", str->name, (int)wait_frames);
  759. } else
  760. wait_nsec = 1000*1000*1000;
  761. //debug_log("midi_thread(%s): wait_nsec = %lld\n", str->name, wait_nsec);
  762. }
  763. return NULL;
  764. }
  765. static
  766. int midi_is_ready(process_midi_t *proc)
  767. {
  768. midi_port_t *port = proc->port;
  769. if (port->npfds) {
  770. unsigned short revents = 0;
  771. int res = snd_rawmidi_poll_descriptors_revents(port->rawmidi, proc->rpfds, port->npfds, &revents);
  772. if (res) {
  773. error_log("snd_rawmidi_poll_descriptors_revents failed on port %s with: %s\n", port->name, snd_strerror(res));
  774. return 0;
  775. }
  776. if (revents & ~proc->mode) {
  777. debug_log("midi: port %s failed\n", port->name);
  778. return 0;
  779. }
  780. if (revents & proc->mode) {
  781. port->is_ready = 1;
  782. debug_log("midi: is_ready %s\n", port->name);
  783. }
  784. }
  785. return 1;
  786. }
  787. static
  788. int midi_update_pfds(process_midi_t *proc)
  789. {
  790. midi_port_t *port = proc->port;
  791. if (port->npfds == 0) {
  792. port->npfds = snd_rawmidi_poll_descriptors_count(port->rawmidi);
  793. if (port->npfds > proc->max_pfds) {
  794. debug_log("midi: not enough pfds for port %s\n", port->name);
  795. return 0;
  796. }
  797. snd_rawmidi_poll_descriptors(port->rawmidi, proc->wpfds, port->npfds);
  798. } else if (proc->rpfds != proc->wpfds) {
  799. memmove(proc->wpfds, proc->rpfds, sizeof(struct pollfd) * port->npfds);
  800. }
  801. return 1;
  802. }
  803. /*
  804. * ------------------------------------ Input ------------------------------
  805. */
  806. static
  807. int input_port_init(alsa_rawmidi_t *midi, midi_port_t *port)
  808. {
  809. input_port_t *in = (input_port_t*)port;
  810. midi_unpack_init(&in->unpack);
  811. return 0;
  812. }
  813. static
  814. void input_port_close(alsa_rawmidi_t *midi, midi_port_t *port)
  815. {
  816. }
  817. /*
  818. * Jack-level input.
  819. */
  820. static
  821. void do_jack_input(process_jack_t *p)
  822. {
  823. input_port_t *port = (input_port_t*) p->port;
  824. event_head_t event;
  825. while (jack_ringbuffer_read_space(port->base.event_ring) >= sizeof(event)) {
  826. jack_ringbuffer_data_t vec[2];
  827. jack_nframes_t time;
  828. int i, todo;
  829. jack_ringbuffer_read(port->base.event_ring, (char*)&event, sizeof(event));
  830. // TODO: take into account possible warping
  831. if ((event.time + p->nframes) < p->frame_time)
  832. time = 0;
  833. else if (event.time >= p->frame_time)
  834. time = p->nframes -1;
  835. else
  836. time = event.time + p->nframes - p->frame_time;
  837. jack_ringbuffer_get_read_vector(port->base.data_ring, vec);
  838. assert ((vec[0].len + vec[1].len) >= event.size);
  839. if (event.overruns)
  840. midi_unpack_reset(&port->unpack);
  841. todo = event.size;
  842. for (i=0; i<2 && todo>0; ++i) {
  843. int avail = todo < vec[i].len ? todo : vec[i].len;
  844. int done = midi_unpack_buf(&port->unpack, (unsigned char*)vec[i].buf, avail, p->buffer, time);
  845. if (done != avail) {
  846. debug_log("jack_in: buffer overflow in port %s\n", port->base.name);
  847. break;
  848. }
  849. todo -= done;
  850. }
  851. jack_ringbuffer_read_advance(port->base.data_ring, event.size);
  852. }
  853. }
  854. /*
  855. * Low level input.
  856. */
  857. static
  858. int do_midi_input(process_midi_t *proc)
  859. {
  860. input_port_t *port = (input_port_t*) proc->port;
  861. if (!midi_is_ready(proc))
  862. return 0;
  863. if (port->base.is_ready) {
  864. jack_ringbuffer_data_t vec[2];
  865. int res;
  866. jack_ringbuffer_get_write_vector(port->base.data_ring, vec);
  867. if (jack_ringbuffer_write_space(port->base.event_ring) < sizeof(event_head_t) || vec[0].len < 1) {
  868. port->overruns++;
  869. if (port->base.npfds)
  870. debug_log("midi_in: internal overflow on %s\n", port->base.name);
  871. // remove from poll to prevent busy-looping
  872. port->base.npfds = 0;
  873. return 1;
  874. }
  875. res = snd_rawmidi_read(port->base.rawmidi, vec[0].buf, vec[0].len);
  876. if (res < 0 && res != -EWOULDBLOCK) {
  877. error_log("midi_in: reading from port %s failed: %s\n", port->base.name, snd_strerror(res));
  878. return 0;
  879. } else if (res > 0) {
  880. event_head_t event;
  881. event.time = proc->cur_time;
  882. event.size = res;
  883. event.overruns = port->overruns;
  884. port->overruns = 0;
  885. debug_log("midi_in: read %d bytes at %d\n", (int)event.size, (int)event.time);
  886. jack_ringbuffer_write_advance(port->base.data_ring, event.size);
  887. jack_ringbuffer_write(port->base.event_ring, (char*)&event, sizeof(event));
  888. }
  889. port->base.is_ready = 0;
  890. }
  891. if (!midi_update_pfds(proc))
  892. return 0;
  893. return 1;
  894. }
  895. /*
  896. * ------------------------------------ Output ------------------------------
  897. */
  898. static int output_port_init(alsa_rawmidi_t *midi, midi_port_t *port)
  899. {
  900. output_port_t *out = (output_port_t*)port;
  901. midi_pack_reset(&out->packer);
  902. out->next_event.time = 0;
  903. out->next_event.size = 0;
  904. out->todo = 0;
  905. return 0;
  906. }
  907. static void output_port_close(alsa_rawmidi_t *midi, midi_port_t *port)
  908. {
  909. }
  910. static
  911. void do_jack_output(process_jack_t *proc)
  912. {
  913. output_port_t *port = (output_port_t*) proc->port;
  914. int nevents = jack_midi_get_event_count(proc->buffer);
  915. int i;
  916. if (nevents)
  917. debug_log("jack_out: %d events in %s\n", nevents, port->base.name);
  918. for (i=0; i<nevents; ++i) {
  919. jack_midi_event_t event;
  920. event_head_t hdr;
  921. jack_midi_event_get(&event, proc->buffer, i);
  922. if (jack_ringbuffer_write_space(port->base.data_ring) < event.size || jack_ringbuffer_write_space(port->base.event_ring) < sizeof(hdr)) {
  923. debug_log("jack_out: output buffer overflow on %s\n", port->base.name);
  924. break;
  925. }
  926. midi_pack_event(&port->packer, &event);
  927. jack_ringbuffer_write(port->base.data_ring, (char*)event.buffer, event.size);
  928. hdr.time = proc->frame_time + event.time + proc->nframes;
  929. hdr.size = event.size;
  930. jack_ringbuffer_write(port->base.event_ring, (char*)&hdr, sizeof(hdr));
  931. debug_log("jack_out: sent %d-byte event at %ld\n", (int)event.size, (long)event.time);
  932. }
  933. }
  934. static
  935. int do_midi_output(process_midi_t *proc)
  936. {
  937. int worked = 0;
  938. output_port_t *port = (output_port_t*) proc->port;
  939. if (!midi_is_ready(proc))
  940. return 0;
  941. // eat events
  942. while (port->next_event.time <= proc->cur_time) {
  943. port->todo += port->next_event.size;
  944. if (jack_ringbuffer_read(port->base.event_ring, (char*)&port->next_event, sizeof(port->next_event))!=sizeof(port->next_event)) {
  945. port->next_event.time = 0;
  946. port->next_event.size = 0;
  947. break;
  948. } else
  949. debug_log("midi_out: at %ld got %d bytes for %ld\n", (long)proc->cur_time, (int)port->next_event.size, (long)port->next_event.time);
  950. }
  951. if (port->todo)
  952. debug_log("midi_out: todo = %d at %ld\n", (int)port->todo, (long)proc->cur_time);
  953. // calc next wakeup time
  954. if (!port->todo && port->next_event.time && port->next_event.time < proc->next_time) {
  955. proc->next_time = port->next_event.time;
  956. debug_log("midi_out: next_time = %ld\n", (long)proc->next_time);
  957. }
  958. if (port->todo && port->base.is_ready) {
  959. // write data
  960. int size = port->todo;
  961. int res;
  962. jack_ringbuffer_data_t vec[2];
  963. jack_ringbuffer_get_read_vector(port->base.data_ring, vec);
  964. if (size > vec[0].len) {
  965. size = vec[0].len;
  966. assert (size > 0);
  967. }
  968. res = snd_rawmidi_write(port->base.rawmidi, vec[0].buf, size);
  969. if (res > 0) {
  970. jack_ringbuffer_read_advance(port->base.data_ring, res);
  971. debug_log("midi_out: written %d bytes to %s\n", res, port->base.name);
  972. port->todo -= res;
  973. worked = 1;
  974. } else if (res == -EWOULDBLOCK) {
  975. port->base.is_ready = 0;
  976. debug_log("midi_out: -EWOULDBLOCK on %s\n", port->base.name);
  977. return 1;
  978. } else {
  979. error_log("midi_out: writing to port %s failed: %s\n", port->base.name, snd_strerror(res));
  980. return 0;
  981. }
  982. snd_rawmidi_drain(port->base.rawmidi);
  983. }
  984. // update pfds for this port
  985. if (!midi_update_pfds(proc))
  986. return 0;
  987. if (!port->todo) {
  988. int i;
  989. if (worked)
  990. debug_log("midi_out: relaxing on %s\n", port->base.name);
  991. for (i=0; i<port->base.npfds; ++i)
  992. proc->wpfds[i].events &= ~POLLOUT;
  993. } else {
  994. int i;
  995. for (i=0; i<port->base.npfds; ++i)
  996. proc->wpfds[i].events |= POLLOUT;
  997. }
  998. return 1;
  999. }