153a5a1b3Sopenharmony_ci#ifndef _GNU_SOURCE 253a5a1b3Sopenharmony_ci#define _GNU_SOURCE 353a5a1b3Sopenharmony_ci#endif 453a5a1b3Sopenharmony_ci 553a5a1b3Sopenharmony_ci#include <assert.h> 653a5a1b3Sopenharmony_ci#include <inttypes.h> 753a5a1b3Sopenharmony_ci#include <time.h> 853a5a1b3Sopenharmony_ci#include <unistd.h> 953a5a1b3Sopenharmony_ci#include <pthread.h> 1053a5a1b3Sopenharmony_ci 1153a5a1b3Sopenharmony_ci#include <alsa/asoundlib.h> 1253a5a1b3Sopenharmony_ci 1353a5a1b3Sopenharmony_ci#define SAMPLE_RATE 44100 1453a5a1b3Sopenharmony_ci#define CHANNELS 2 1553a5a1b3Sopenharmony_ci 1653a5a1b3Sopenharmony_cistatic uint64_t timespec_us(const struct timespec *ts) { 1753a5a1b3Sopenharmony_ci return 1853a5a1b3Sopenharmony_ci ts->tv_sec * 1000000LLU + 1953a5a1b3Sopenharmony_ci ts->tv_nsec / 1000LLU; 2053a5a1b3Sopenharmony_ci} 2153a5a1b3Sopenharmony_ci 2253a5a1b3Sopenharmony_ciint main(int argc, char *argv[]) { 2353a5a1b3Sopenharmony_ci const char *dev; 2453a5a1b3Sopenharmony_ci int r, cap, count = 0; 2553a5a1b3Sopenharmony_ci snd_pcm_hw_params_t *hwparams; 2653a5a1b3Sopenharmony_ci snd_pcm_sw_params_t *swparams; 2753a5a1b3Sopenharmony_ci snd_pcm_status_t *status; 2853a5a1b3Sopenharmony_ci snd_pcm_t *pcm; 2953a5a1b3Sopenharmony_ci unsigned rate = SAMPLE_RATE; 3053a5a1b3Sopenharmony_ci unsigned periods = 2; 3153a5a1b3Sopenharmony_ci snd_pcm_uframes_t boundary, buffer_size = SAMPLE_RATE/10; /* 100s */ 3253a5a1b3Sopenharmony_ci int dir = 1; 3353a5a1b3Sopenharmony_ci int fillrate; 3453a5a1b3Sopenharmony_ci struct timespec start, last_timestamp = { 0, 0 }; 3553a5a1b3Sopenharmony_ci uint64_t start_us, last_us = 0; 3653a5a1b3Sopenharmony_ci snd_pcm_sframes_t last_avail = 0, last_delay = 0; 3753a5a1b3Sopenharmony_ci struct pollfd *pollfds; 3853a5a1b3Sopenharmony_ci int n_pollfd; 3953a5a1b3Sopenharmony_ci int64_t sample_count = 0; 4053a5a1b3Sopenharmony_ci uint16_t *samples; 4153a5a1b3Sopenharmony_ci struct sched_param sp; 4253a5a1b3Sopenharmony_ci 4353a5a1b3Sopenharmony_ci r = -1; 4453a5a1b3Sopenharmony_ci#ifdef _POSIX_PRIORITY_SCHEDULING 4553a5a1b3Sopenharmony_ci sp.sched_priority = 5; 4653a5a1b3Sopenharmony_ci r = pthread_setschedparam(pthread_self(), SCHED_RR, &sp); 4753a5a1b3Sopenharmony_ci#endif 4853a5a1b3Sopenharmony_ci if (r) 4953a5a1b3Sopenharmony_ci printf("Could not get RT prio. :(\n"); 5053a5a1b3Sopenharmony_ci 5153a5a1b3Sopenharmony_ci snd_pcm_hw_params_alloca(&hwparams); 5253a5a1b3Sopenharmony_ci snd_pcm_sw_params_alloca(&swparams); 5353a5a1b3Sopenharmony_ci snd_pcm_status_alloca(&status); 5453a5a1b3Sopenharmony_ci 5553a5a1b3Sopenharmony_ci r = clock_gettime(CLOCK_MONOTONIC, &start); 5653a5a1b3Sopenharmony_ci assert(r == 0); 5753a5a1b3Sopenharmony_ci 5853a5a1b3Sopenharmony_ci start_us = timespec_us(&start); 5953a5a1b3Sopenharmony_ci 6053a5a1b3Sopenharmony_ci dev = argc > 1 ? argv[1] : "front:0"; 6153a5a1b3Sopenharmony_ci cap = argc > 2 ? atoi(argv[2]) : 0; 6253a5a1b3Sopenharmony_ci fillrate = argc > 3 ? atoi(argv[3]) : 1; 6353a5a1b3Sopenharmony_ci assert(fillrate > 0); 6453a5a1b3Sopenharmony_ci 6553a5a1b3Sopenharmony_ci samples = calloc(fillrate, CHANNELS*sizeof(uint16_t)); 6653a5a1b3Sopenharmony_ci assert(samples); 6753a5a1b3Sopenharmony_ci 6853a5a1b3Sopenharmony_ci if (cap == 0) 6953a5a1b3Sopenharmony_ci r = snd_pcm_open(&pcm, dev, SND_PCM_STREAM_PLAYBACK, 0); 7053a5a1b3Sopenharmony_ci else 7153a5a1b3Sopenharmony_ci r = snd_pcm_open(&pcm, dev, SND_PCM_STREAM_CAPTURE, 0); 7253a5a1b3Sopenharmony_ci assert(r == 0); 7353a5a1b3Sopenharmony_ci 7453a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_any(pcm, hwparams); 7553a5a1b3Sopenharmony_ci assert(r == 0); 7653a5a1b3Sopenharmony_ci 7753a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_rate_resample(pcm, hwparams, 0); 7853a5a1b3Sopenharmony_ci assert(r == 0); 7953a5a1b3Sopenharmony_ci 8053a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_access(pcm, hwparams, SND_PCM_ACCESS_RW_INTERLEAVED); 8153a5a1b3Sopenharmony_ci assert(r == 0); 8253a5a1b3Sopenharmony_ci 8353a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_format(pcm, hwparams, SND_PCM_FORMAT_S16_LE); 8453a5a1b3Sopenharmony_ci assert(r == 0); 8553a5a1b3Sopenharmony_ci 8653a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_rate_near(pcm, hwparams, &rate, NULL); 8753a5a1b3Sopenharmony_ci assert(r == 0); 8853a5a1b3Sopenharmony_ci 8953a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_channels(pcm, hwparams, CHANNELS); 9053a5a1b3Sopenharmony_ci assert(r == 0); 9153a5a1b3Sopenharmony_ci 9253a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_periods_integer(pcm, hwparams); 9353a5a1b3Sopenharmony_ci assert(r == 0); 9453a5a1b3Sopenharmony_ci 9553a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_periods_near(pcm, hwparams, &periods, &dir); 9653a5a1b3Sopenharmony_ci assert(r == 0); 9753a5a1b3Sopenharmony_ci 9853a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_set_buffer_size_near(pcm, hwparams, &buffer_size); 9953a5a1b3Sopenharmony_ci assert(r == 0); 10053a5a1b3Sopenharmony_ci 10153a5a1b3Sopenharmony_ci r = snd_pcm_hw_params(pcm, hwparams); 10253a5a1b3Sopenharmony_ci assert(r == 0); 10353a5a1b3Sopenharmony_ci 10453a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_current(pcm, hwparams); 10553a5a1b3Sopenharmony_ci assert(r == 0); 10653a5a1b3Sopenharmony_ci 10753a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_current(pcm, swparams); 10853a5a1b3Sopenharmony_ci assert(r == 0); 10953a5a1b3Sopenharmony_ci 11053a5a1b3Sopenharmony_ci if (cap == 0) 11153a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_set_avail_min(pcm, swparams, 1); 11253a5a1b3Sopenharmony_ci else 11353a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_set_avail_min(pcm, swparams, 0); 11453a5a1b3Sopenharmony_ci assert(r == 0); 11553a5a1b3Sopenharmony_ci 11653a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_set_period_event(pcm, swparams, 0); 11753a5a1b3Sopenharmony_ci assert(r == 0); 11853a5a1b3Sopenharmony_ci 11953a5a1b3Sopenharmony_ci r = snd_pcm_hw_params_get_buffer_size(hwparams, &buffer_size); 12053a5a1b3Sopenharmony_ci assert(r == 0); 12153a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_set_start_threshold(pcm, swparams, buffer_size - (buffer_size % fillrate)); 12253a5a1b3Sopenharmony_ci assert(r == 0); 12353a5a1b3Sopenharmony_ci 12453a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_get_boundary(swparams, &boundary); 12553a5a1b3Sopenharmony_ci assert(r == 0); 12653a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_set_stop_threshold(pcm, swparams, boundary); 12753a5a1b3Sopenharmony_ci assert(r == 0); 12853a5a1b3Sopenharmony_ci 12953a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_set_tstamp_mode(pcm, swparams, SND_PCM_TSTAMP_ENABLE); 13053a5a1b3Sopenharmony_ci assert(r == 0); 13153a5a1b3Sopenharmony_ci 13253a5a1b3Sopenharmony_ci r = snd_pcm_sw_params(pcm, swparams); 13353a5a1b3Sopenharmony_ci assert(r == 0); 13453a5a1b3Sopenharmony_ci 13553a5a1b3Sopenharmony_ci r = snd_pcm_sw_params_current(pcm, swparams); 13653a5a1b3Sopenharmony_ci assert(r == 0); 13753a5a1b3Sopenharmony_ci 13853a5a1b3Sopenharmony_ci/* assert(snd_pcm_hw_params_is_monotonic(hwparams) > 0); */ 13953a5a1b3Sopenharmony_ci 14053a5a1b3Sopenharmony_ci n_pollfd = snd_pcm_poll_descriptors_count(pcm); 14153a5a1b3Sopenharmony_ci assert(n_pollfd > 0); 14253a5a1b3Sopenharmony_ci 14353a5a1b3Sopenharmony_ci pollfds = malloc(sizeof(struct pollfd) * n_pollfd); 14453a5a1b3Sopenharmony_ci assert(pollfds); 14553a5a1b3Sopenharmony_ci 14653a5a1b3Sopenharmony_ci r = snd_pcm_poll_descriptors(pcm, pollfds, n_pollfd); 14753a5a1b3Sopenharmony_ci assert(r == n_pollfd); 14853a5a1b3Sopenharmony_ci 14953a5a1b3Sopenharmony_ci printf("Starting. Buffer size is %u frames\n", (unsigned int) buffer_size); 15053a5a1b3Sopenharmony_ci 15153a5a1b3Sopenharmony_ci if (cap) { 15253a5a1b3Sopenharmony_ci r = snd_pcm_start(pcm); 15353a5a1b3Sopenharmony_ci assert(r == 0); 15453a5a1b3Sopenharmony_ci } 15553a5a1b3Sopenharmony_ci 15653a5a1b3Sopenharmony_ci for (;;) { 15753a5a1b3Sopenharmony_ci snd_pcm_sframes_t avail, delay; 15853a5a1b3Sopenharmony_ci struct timespec now, timestamp; 15953a5a1b3Sopenharmony_ci unsigned short revents; 16053a5a1b3Sopenharmony_ci int handled = 0; 16153a5a1b3Sopenharmony_ci uint64_t now_us, timestamp_us; 16253a5a1b3Sopenharmony_ci snd_pcm_state_t state; 16353a5a1b3Sopenharmony_ci unsigned long long pos; 16453a5a1b3Sopenharmony_ci 16553a5a1b3Sopenharmony_ci r = poll(pollfds, n_pollfd, 0); 16653a5a1b3Sopenharmony_ci assert(r >= 0); 16753a5a1b3Sopenharmony_ci 16853a5a1b3Sopenharmony_ci r = snd_pcm_poll_descriptors_revents(pcm, pollfds, n_pollfd, &revents); 16953a5a1b3Sopenharmony_ci assert(r == 0); 17053a5a1b3Sopenharmony_ci 17153a5a1b3Sopenharmony_ci if (cap == 0) 17253a5a1b3Sopenharmony_ci assert((revents & ~POLLOUT) == 0); 17353a5a1b3Sopenharmony_ci else 17453a5a1b3Sopenharmony_ci assert((revents & ~POLLIN) == 0); 17553a5a1b3Sopenharmony_ci 17653a5a1b3Sopenharmony_ci avail = snd_pcm_avail(pcm); 17753a5a1b3Sopenharmony_ci assert(avail >= 0); 17853a5a1b3Sopenharmony_ci 17953a5a1b3Sopenharmony_ci r = snd_pcm_status(pcm, status); 18053a5a1b3Sopenharmony_ci assert(r == 0); 18153a5a1b3Sopenharmony_ci 18253a5a1b3Sopenharmony_ci /* This assertion fails from time to time. ALSA seems to be broken */ 18353a5a1b3Sopenharmony_ci/* assert(avail == (snd_pcm_sframes_t) snd_pcm_status_get_avail(status)); */ 18453a5a1b3Sopenharmony_ci/* printf("%lu %lu\n", (unsigned long) avail, (unsigned long) snd_pcm_status_get_avail(status)); */ 18553a5a1b3Sopenharmony_ci 18653a5a1b3Sopenharmony_ci snd_pcm_status_get_htstamp(status, ×tamp); 18753a5a1b3Sopenharmony_ci delay = snd_pcm_status_get_delay(status); 18853a5a1b3Sopenharmony_ci state = snd_pcm_status_get_state(status); 18953a5a1b3Sopenharmony_ci 19053a5a1b3Sopenharmony_ci r = clock_gettime(CLOCK_MONOTONIC, &now); 19153a5a1b3Sopenharmony_ci assert(r == 0); 19253a5a1b3Sopenharmony_ci 19353a5a1b3Sopenharmony_ci assert(!revents || avail > 0); 19453a5a1b3Sopenharmony_ci 19553a5a1b3Sopenharmony_ci if ((!cap && (avail >= fillrate)) || (cap && (unsigned)avail >= buffer_size)) { 19653a5a1b3Sopenharmony_ci snd_pcm_sframes_t sframes; 19753a5a1b3Sopenharmony_ci 19853a5a1b3Sopenharmony_ci if (cap == 0) 19953a5a1b3Sopenharmony_ci sframes = snd_pcm_writei(pcm, samples, fillrate); 20053a5a1b3Sopenharmony_ci else 20153a5a1b3Sopenharmony_ci sframes = snd_pcm_readi(pcm, samples, fillrate); 20253a5a1b3Sopenharmony_ci assert(sframes == fillrate); 20353a5a1b3Sopenharmony_ci 20453a5a1b3Sopenharmony_ci handled = fillrate; 20553a5a1b3Sopenharmony_ci sample_count += fillrate; 20653a5a1b3Sopenharmony_ci } 20753a5a1b3Sopenharmony_ci 20853a5a1b3Sopenharmony_ci if (!handled && 20953a5a1b3Sopenharmony_ci memcmp(×tamp, &last_timestamp, sizeof(timestamp)) == 0 && 21053a5a1b3Sopenharmony_ci avail == last_avail && 21153a5a1b3Sopenharmony_ci delay == last_delay) { 21253a5a1b3Sopenharmony_ci /* This is boring */ 21353a5a1b3Sopenharmony_ci continue; 21453a5a1b3Sopenharmony_ci } 21553a5a1b3Sopenharmony_ci 21653a5a1b3Sopenharmony_ci now_us = timespec_us(&now); 21753a5a1b3Sopenharmony_ci timestamp_us = timespec_us(×tamp); 21853a5a1b3Sopenharmony_ci 21953a5a1b3Sopenharmony_ci if (cap == 0) 22053a5a1b3Sopenharmony_ci pos = (unsigned long long) ((sample_count - handled - delay) * 1000000LU / SAMPLE_RATE); 22153a5a1b3Sopenharmony_ci else 22253a5a1b3Sopenharmony_ci pos = (unsigned long long) ((sample_count - handled + delay) * 1000000LU / SAMPLE_RATE); 22353a5a1b3Sopenharmony_ci 22453a5a1b3Sopenharmony_ci if (count++ % 50 == 0) 22553a5a1b3Sopenharmony_ci printf("Elapsed\tCPU\tALSA\tPos\tSamples\tavail\tdelay\trevents\thandled\tstate\n"); 22653a5a1b3Sopenharmony_ci 22753a5a1b3Sopenharmony_ci printf("%llu\t%llu\t%llu\t%llu\t%llu\t%li\t%li\t%i\t%i\t%i\n", 22853a5a1b3Sopenharmony_ci (unsigned long long) (now_us - last_us), 22953a5a1b3Sopenharmony_ci (unsigned long long) (now_us - start_us), 23053a5a1b3Sopenharmony_ci (unsigned long long) (timestamp_us ? timestamp_us - start_us : 0), 23153a5a1b3Sopenharmony_ci pos, 23253a5a1b3Sopenharmony_ci (unsigned long long) sample_count, 23353a5a1b3Sopenharmony_ci (signed long) avail, 23453a5a1b3Sopenharmony_ci (signed long) delay, 23553a5a1b3Sopenharmony_ci revents, 23653a5a1b3Sopenharmony_ci handled, 23753a5a1b3Sopenharmony_ci state); 23853a5a1b3Sopenharmony_ci 23953a5a1b3Sopenharmony_ci if (cap == 0) 24053a5a1b3Sopenharmony_ci /** When this assert is hit, most likely something bad 24153a5a1b3Sopenharmony_ci * happened, i.e. the avail jumped suddenly. */ 24253a5a1b3Sopenharmony_ci assert((unsigned) avail <= buffer_size); 24353a5a1b3Sopenharmony_ci 24453a5a1b3Sopenharmony_ci last_avail = avail; 24553a5a1b3Sopenharmony_ci last_delay = delay; 24653a5a1b3Sopenharmony_ci last_timestamp = timestamp; 24753a5a1b3Sopenharmony_ci last_us = now_us; 24853a5a1b3Sopenharmony_ci } 24953a5a1b3Sopenharmony_ci 25053a5a1b3Sopenharmony_ci return 0; 25153a5a1b3Sopenharmony_ci} 252