#include #include #include #include #include #include #include #include #include #include #include #include #include "alsa-pcm.h" static struct spa_list cards = SPA_LIST_INIT(&cards); struct card { struct spa_list link; int ref; uint32_t index; snd_use_case_mgr_t *ucm; char *ucm_prefix; }; static struct card *find_card(uint32_t index) { struct card *c; spa_list_for_each(c, &cards, link) { if (c->index == index) { c->ref++; return c; } } return NULL; } static struct card *ensure_card(uint32_t index) { struct card *c; char card_name[64]; const char *alibpref = NULL; int err; if ((c = find_card(index)) != NULL) return c; c = calloc(1, sizeof(*c)); c->ref = 1; c->index = index; snprintf(card_name, sizeof(card_name), "hw:%i", index); err = snd_use_case_mgr_open(&c->ucm, card_name); if (err < 0) { char *name; err = snd_card_get_name(index, &name); if (err < 0) { errno = -err; return NULL; } snprintf(card_name, sizeof(card_name), "%s", name); free(name); err = snd_use_case_mgr_open(&c->ucm, card_name); if (err < 0) { errno = -err; return NULL; } } if ((snd_use_case_get(c->ucm, "_alibpref", &alibpref) != 0)) alibpref = NULL; c->ucm_prefix = (char*)alibpref; spa_list_append(&cards, &c->link); return c; } static void release_card(uint32_t index) { struct card *c; if ((c = find_card(index)) == NULL) return; if (--c->ref > 0) return; spa_list_remove(&c->link); free(c->ucm_prefix); snd_use_case_mgr_close(c->ucm); free(c); } int spa_alsa_init(struct state *state) { snd_config_update_free_global(); if (state->stream == SND_PCM_STREAM_PLAYBACK) { state->is_iec958 = spa_strstartswith(state->props.device, "iec958"); state->is_hdmi = spa_strstartswith(state->props.device, "hdmi"); state->iec958_codecs |= 1ULL << SPA_AUDIO_IEC958_CODEC_PCM; } if (state->open_ucm) { struct card *c; c = ensure_card(state->card_index); if (c == NULL) { spa_log_error(state->log, "UCM not available for card %d", state->card_index); return -errno; } state->ucm_prefix = c->ucm_prefix; } return 0; } int spa_alsa_clear(struct state *state) { state->ucm_prefix = NULL; release_card(state->card_index); return 0; } #define CHECK(s,msg,...) if ((err = (s)) < 0) { spa_log_error(state->log, msg ": %s", ##__VA_ARGS__, snd_strerror(err)); return err; } int spa_alsa_open(struct state *state, const char *params) { int err; struct props *props = &state->props; snd_pcm_info_t *pcminfo; char device_name[256]; if (state->opened) return 0; CHECK(snd_output_stdio_attach(&state->output, stderr, 0), "attach failed"); spa_scnprintf(device_name, sizeof(device_name), "%s%s%s", state->ucm_prefix ? state->ucm_prefix : "", props->device, params ? params : ""); spa_log_info(state->log, "%p: ALSA device open '%s' %s", state, device_name, state->stream == SND_PCM_STREAM_CAPTURE ? "capture" : "playback"); CHECK(snd_pcm_open(&state->hndl, device_name, state->stream, SND_PCM_NONBLOCK | SND_PCM_NO_AUTO_RESAMPLE | SND_PCM_NO_AUTO_CHANNELS | SND_PCM_NO_AUTO_FORMAT), "'%s': %s open failed", device_name, state->stream == SND_PCM_STREAM_CAPTURE ? "capture" : "playback"); if ((err = spa_system_timerfd_create(state->data_system, CLOCK_MONOTONIC, SPA_FD_CLOEXEC | SPA_FD_NONBLOCK)) < 0) goto error_exit_close; state->timerfd = err; snd_pcm_info_alloca(&pcminfo); snd_pcm_info(state->hndl, pcminfo); /* we would love to use the sync_id but it always returns 0, so use the * card id for now */ state->card = snd_pcm_info_get_card(pcminfo); if (state->clock) { snprintf(state->clock->name, sizeof(state->clock->name), "api.alsa.%d", state->card); } state->opened = true; state->sample_count = 0; state->sample_time = 0; return 0; error_exit_close: snd_pcm_close(state->hndl); return err; } int spa_alsa_close(struct state *state) { int err = 0; if (!state->opened) return 0; spa_log_info(state->log, "%p: Device '%s' closing", state, state->props.device); if ((err = snd_pcm_close(state->hndl)) < 0) spa_log_warn(state->log, "%s: close failed: %s", state->props.device, snd_strerror(err)); if ((err = snd_output_close(state->output)) < 0) spa_log_warn(state->log, "output close failed: %s", snd_strerror(err)); spa_system_close(state->data_system, state->timerfd); state->opened = false; return err; } struct format_info { uint32_t spa_format; uint32_t spa_pformat; snd_pcm_format_t format; }; static const struct format_info format_info[] = { { SPA_AUDIO_FORMAT_UNKNOWN, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_UNKNOWN}, { SPA_AUDIO_FORMAT_F32_LE, SPA_AUDIO_FORMAT_F32P, SND_PCM_FORMAT_FLOAT_LE}, { SPA_AUDIO_FORMAT_F32_BE, SPA_AUDIO_FORMAT_F32P, SND_PCM_FORMAT_FLOAT_BE}, { SPA_AUDIO_FORMAT_S32_LE, SPA_AUDIO_FORMAT_S32P, SND_PCM_FORMAT_S32_LE}, { SPA_AUDIO_FORMAT_S32_BE, SPA_AUDIO_FORMAT_S32P, SND_PCM_FORMAT_S32_BE}, { SPA_AUDIO_FORMAT_S24_32_LE, SPA_AUDIO_FORMAT_S24_32P, SND_PCM_FORMAT_S24_LE}, { SPA_AUDIO_FORMAT_S24_32_BE, SPA_AUDIO_FORMAT_S24_32P, SND_PCM_FORMAT_S24_BE}, { SPA_AUDIO_FORMAT_S24_LE, SPA_AUDIO_FORMAT_S24P, SND_PCM_FORMAT_S24_3LE}, { SPA_AUDIO_FORMAT_S24_BE, SPA_AUDIO_FORMAT_S24P, SND_PCM_FORMAT_S24_3BE}, { SPA_AUDIO_FORMAT_S16_LE, SPA_AUDIO_FORMAT_S16P, SND_PCM_FORMAT_S16_LE}, { SPA_AUDIO_FORMAT_S16_BE, SPA_AUDIO_FORMAT_S16P, SND_PCM_FORMAT_S16_BE}, { SPA_AUDIO_FORMAT_S8, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_S8}, { SPA_AUDIO_FORMAT_U8, SPA_AUDIO_FORMAT_U8P, SND_PCM_FORMAT_U8}, { SPA_AUDIO_FORMAT_U16_LE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U16_LE}, { SPA_AUDIO_FORMAT_U16_BE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U16_BE}, { SPA_AUDIO_FORMAT_U24_32_LE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U24_LE}, { SPA_AUDIO_FORMAT_U24_32_BE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U24_BE}, { SPA_AUDIO_FORMAT_U24_LE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U24_3LE}, { SPA_AUDIO_FORMAT_U24_BE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U24_3BE}, { SPA_AUDIO_FORMAT_U32_LE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U32_LE}, { SPA_AUDIO_FORMAT_U32_BE, SPA_AUDIO_FORMAT_UNKNOWN, SND_PCM_FORMAT_U32_BE}, { SPA_AUDIO_FORMAT_F64_LE, SPA_AUDIO_FORMAT_F64P, SND_PCM_FORMAT_FLOAT64_LE}, { SPA_AUDIO_FORMAT_F64_BE, SPA_AUDIO_FORMAT_F64P, SND_PCM_FORMAT_FLOAT64_BE}, }; static snd_pcm_format_t spa_format_to_alsa(uint32_t format, bool *planar) { size_t i; for (i = 0; i < SPA_N_ELEMENTS(format_info); i++) { *planar = format_info[i].spa_pformat == format; if (format_info[i].spa_format == format || *planar) return format_info[i].format; } return SND_PCM_FORMAT_UNKNOWN; } struct chmap_info { enum snd_pcm_chmap_position pos; enum spa_audio_channel channel; }; static const struct chmap_info chmap_info[] = { [SND_CHMAP_UNKNOWN] = { SND_CHMAP_UNKNOWN, SPA_AUDIO_CHANNEL_UNKNOWN }, [SND_CHMAP_NA] = { SND_CHMAP_NA, SPA_AUDIO_CHANNEL_NA }, [SND_CHMAP_MONO] = { SND_CHMAP_MONO, SPA_AUDIO_CHANNEL_MONO }, [SND_CHMAP_FL] = { SND_CHMAP_FL, SPA_AUDIO_CHANNEL_FL }, [SND_CHMAP_FR] = { SND_CHMAP_FR, SPA_AUDIO_CHANNEL_FR }, [SND_CHMAP_RL] = { SND_CHMAP_RL, SPA_AUDIO_CHANNEL_RL }, [SND_CHMAP_RR] = { SND_CHMAP_RR, SPA_AUDIO_CHANNEL_RR }, [SND_CHMAP_FC] = { SND_CHMAP_FC, SPA_AUDIO_CHANNEL_FC }, [SND_CHMAP_LFE] = { SND_CHMAP_LFE, SPA_AUDIO_CHANNEL_LFE }, [SND_CHMAP_SL] = { SND_CHMAP_SL, SPA_AUDIO_CHANNEL_SL }, [SND_CHMAP_SR] = { SND_CHMAP_SR, SPA_AUDIO_CHANNEL_SR }, [SND_CHMAP_RC] = { SND_CHMAP_RC, SPA_AUDIO_CHANNEL_RC }, [SND_CHMAP_FLC] = { SND_CHMAP_FLC, SPA_AUDIO_CHANNEL_FLC }, [SND_CHMAP_FRC] = { SND_CHMAP_FRC, SPA_AUDIO_CHANNEL_FRC }, [SND_CHMAP_RLC] = { SND_CHMAP_RLC, SPA_AUDIO_CHANNEL_RLC }, [SND_CHMAP_RRC] = { SND_CHMAP_RRC, SPA_AUDIO_CHANNEL_RRC }, [SND_CHMAP_FLW] = { SND_CHMAP_FLW, SPA_AUDIO_CHANNEL_FLW }, [SND_CHMAP_FRW] = { SND_CHMAP_FRW, SPA_AUDIO_CHANNEL_FRW }, [SND_CHMAP_FLH] = { SND_CHMAP_FLH, SPA_AUDIO_CHANNEL_FLH }, [SND_CHMAP_FCH] = { SND_CHMAP_FCH, SPA_AUDIO_CHANNEL_FCH }, [SND_CHMAP_FRH] = { SND_CHMAP_FRH, SPA_AUDIO_CHANNEL_FRH }, [SND_CHMAP_TC] = { SND_CHMAP_TC, SPA_AUDIO_CHANNEL_TC }, [SND_CHMAP_TFL] = { SND_CHMAP_TFL, SPA_AUDIO_CHANNEL_TFL }, [SND_CHMAP_TFR] = { SND_CHMAP_TFR, SPA_AUDIO_CHANNEL_TFR }, [SND_CHMAP_TFC] = { SND_CHMAP_TFC, SPA_AUDIO_CHANNEL_TFC }, [SND_CHMAP_TRL] = { SND_CHMAP_TRL, SPA_AUDIO_CHANNEL_TRL }, [SND_CHMAP_TRR] = { SND_CHMAP_TRR, SPA_AUDIO_CHANNEL_TRR }, [SND_CHMAP_TRC] = { SND_CHMAP_TRC, SPA_AUDIO_CHANNEL_TRC }, [SND_CHMAP_TFLC] = { SND_CHMAP_TFLC, SPA_AUDIO_CHANNEL_TFLC }, [SND_CHMAP_TFRC] = { SND_CHMAP_TFRC, SPA_AUDIO_CHANNEL_TFRC }, [SND_CHMAP_TSL] = { SND_CHMAP_TSL, SPA_AUDIO_CHANNEL_TSL }, [SND_CHMAP_TSR] = { SND_CHMAP_TSR, SPA_AUDIO_CHANNEL_TSR }, [SND_CHMAP_LLFE] = { SND_CHMAP_LLFE, SPA_AUDIO_CHANNEL_LLFE }, [SND_CHMAP_RLFE] = { SND_CHMAP_RLFE, SPA_AUDIO_CHANNEL_RLFE }, [SND_CHMAP_BC] = { SND_CHMAP_BC, SPA_AUDIO_CHANNEL_BC }, [SND_CHMAP_BLC] = { SND_CHMAP_BLC, SPA_AUDIO_CHANNEL_BLC }, [SND_CHMAP_BRC] = { SND_CHMAP_BRC, SPA_AUDIO_CHANNEL_BRC }, }; #define _M(ch) (1LL << SND_CHMAP_ ##ch) struct def_mask { int channels; uint64_t mask; }; static const struct def_mask default_layouts[] = { { 0, 0 }, { 1, _M(MONO) }, { 2, _M(FL) | _M(FR) }, { 3, _M(FL) | _M(FR) | _M(LFE) }, { 4, _M(FL) | _M(FR) | _M(RL) |_M(RR) }, { 5, _M(FL) | _M(FR) | _M(RL) |_M(RR) | _M(FC) }, { 6, _M(FL) | _M(FR) | _M(RL) |_M(RR) | _M(FC) | _M(LFE) }, { 7, _M(FL) | _M(FR) | _M(RL) |_M(RR) | _M(SL) | _M(SR) | _M(FC) }, { 8, _M(FL) | _M(FR) | _M(RL) |_M(RR) | _M(SL) | _M(SR) | _M(FC) | _M(LFE) }, }; #define _C(ch) (SPA_AUDIO_CHANNEL_ ##ch) static const struct channel_map default_map[] = { { 0, { 0, } } , { 1, { _C(MONO), } }, { 2, { _C(FL), _C(FR), } }, { 3, { _C(FL), _C(FR), _C(LFE) } }, { 4, { _C(FL), _C(FR), _C(RL), _C(RR), } }, { 5, { _C(FL), _C(FR), _C(RL), _C(RR), _C(FC) } }, { 6, { _C(FL), _C(FR), _C(RL), _C(RR), _C(FC), _C(LFE), } }, { 7, { _C(FL), _C(FR), _C(RL), _C(RR), _C(FC), _C(SL), _C(SR), } }, { 8, { _C(FL), _C(FR), _C(RL), _C(RR), _C(FC), _C(LFE), _C(SL), _C(SR), } }, }; static enum spa_audio_channel chmap_position_to_channel(enum snd_pcm_chmap_position pos) { return chmap_info[pos].channel; } static void sanitize_map(snd_pcm_chmap_t* map) { uint64_t mask = 0, p, dup = 0; const struct def_mask *def; uint32_t i, j, pos; for (i = 0; i < map->channels; i++) { if (map->pos[i] > SND_CHMAP_LAST) map->pos[i] = SND_CHMAP_UNKNOWN; p = 1LL << map->pos[i]; if (mask & p) { /* duplicate channel */ for (j = 0; j <= i; j++) if (map->pos[j] == map->pos[i]) map->pos[j] = SND_CHMAP_UNKNOWN; dup |= p; p = 1LL << SND_CHMAP_UNKNOWN; } mask |= p; } if ((mask & (1LL << SND_CHMAP_UNKNOWN)) == 0) return; def = &default_layouts[map->channels]; /* remove duplicates */ mask &= ~dup; /* keep unassigned channels */ mask = def->mask & ~mask; pos = 0; for (i = 0; i < map->channels; i++) { if (map->pos[i] == SND_CHMAP_UNKNOWN) { do { mask >>= 1; pos++; } while (mask != 0 && (mask & 1) == 0); map->pos[i] = mask ? pos : 0; } } } static int add_rate(struct state *state, uint32_t scale, bool all, uint32_t index, uint32_t *next, snd_pcm_hw_params_t *params, struct spa_pod_builder *b) { struct spa_pod_frame f[1]; int err, dir; unsigned int min, max; struct spa_pod_choice *choice; uint32_t rate; CHECK(snd_pcm_hw_params_get_rate_min(params, &min, &dir), "get_rate_min"); CHECK(snd_pcm_hw_params_get_rate_max(params, &max, &dir), "get_rate_max"); if (state->default_rate != 0 && !all) { if (min < state->default_rate) min = state->default_rate; if (max > state->default_rate) max = state->default_rate; } spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_rate, 0); spa_pod_builder_push_choice(b, &f[0], SPA_CHOICE_None, 0); choice = (struct spa_pod_choice*)spa_pod_builder_frame(b, &f[0]); rate = state->position ? state->position->clock.rate.denom : DEFAULT_RATE; spa_pod_builder_int(b, SPA_CLAMP(rate, min, max) * scale); if (min != max) { spa_pod_builder_int(b, min * scale); spa_pod_builder_int(b, max * scale); choice->body.type = SPA_CHOICE_Range; } spa_pod_builder_pop(b, &f[0]); return 1; } static int add_channels(struct state *state, bool all, uint32_t index, uint32_t *next, snd_pcm_hw_params_t *params, struct spa_pod_builder *b) { struct spa_pod_frame f[1]; size_t i; int err; snd_pcm_t *hndl = state->hndl; snd_pcm_chmap_query_t **maps; unsigned int min, max; CHECK(snd_pcm_hw_params_get_channels_min(params, &min), "get_channels_min"); CHECK(snd_pcm_hw_params_get_channels_max(params, &max), "get_channels_max"); spa_log_debug(state->log, "channels (%d %d)", min, max); if (state->default_channels != 0 && !all) { if (min < state->default_channels) min = state->default_channels; if (max > state->default_channels) max = state->default_channels; } min = SPA_MIN(min, SPA_AUDIO_MAX_CHANNELS); max = SPA_MIN(max, SPA_AUDIO_MAX_CHANNELS); spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_channels, 0); if (state->props.use_chmap && (maps = snd_pcm_query_chmaps(hndl)) != NULL) { uint32_t channel; snd_pcm_chmap_t* map; skip_channels: if (maps[index] == NULL) { snd_pcm_free_chmaps(maps); return 0; } map = &maps[index]->map; spa_log_debug(state->log, "map %d channels (%d %d)", map->channels, min, max); if (map->channels < min || map->channels > max) { index = (*next)++; goto skip_channels; } sanitize_map(map); spa_pod_builder_int(b, map->channels); spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_position, 0); spa_pod_builder_push_array(b, &f[0]); for (i = 0; i < map->channels; i++) { spa_log_debug(state->log, "%p: position %zd %d", state, i, map->pos[i]); channel = chmap_position_to_channel(map->pos[i]); spa_pod_builder_id(b, channel); } spa_pod_builder_pop(b, &f[0]); snd_pcm_free_chmaps(maps); } else { const struct channel_map *map = NULL; struct spa_pod_choice *choice; if (index > 0) return 0; spa_pod_builder_push_choice(b, &f[0], SPA_CHOICE_None, 0); choice = (struct spa_pod_choice*)spa_pod_builder_frame(b, &f[0]); spa_pod_builder_int(b, max); if (min != max) { spa_pod_builder_int(b, min); spa_pod_builder_int(b, max); choice->body.type = SPA_CHOICE_Range; } spa_pod_builder_pop(b, &f[0]); if (min == max) { if (state->default_pos.channels == min) map = &state->default_pos; else if (min == max && min <= 8) map = &default_map[min]; } if (map) { spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_position, 0); spa_pod_builder_push_array(b, &f[0]); for (i = 0; i < map->channels; i++) { spa_log_debug(state->log, "%p: position %zd %d", state, i, map->pos[i]); spa_pod_builder_id(b, map->pos[i]); } spa_pod_builder_pop(b, &f[0]); } } return 1; } static int enum_pcm_formats(struct state *state, uint32_t index, uint32_t *next, struct spa_pod **result, struct spa_pod_builder *b) { int res, err; size_t i, j; snd_pcm_t *hndl; snd_pcm_hw_params_t *params; struct spa_pod_frame f[2]; snd_pcm_format_mask_t *fmask; snd_pcm_access_mask_t *amask; unsigned int rrate, rchannels; struct spa_pod_choice *choice; hndl = state->hndl; snd_pcm_hw_params_alloca(¶ms); CHECK(snd_pcm_hw_params_any(hndl, params), "Broken configuration: no configurations available"); CHECK(snd_pcm_hw_params_set_rate_resample(hndl, params, 0), "set_rate_resample"); if (state->default_channels != 0) { rchannels = state->default_channels; CHECK(snd_pcm_hw_params_set_channels_near(hndl, params, &rchannels), "set_channels"); if (state->default_channels != rchannels) { spa_log_warn(state->log, "%s: Channels doesn't match (requested %u, got %u)", state->props.device, state->default_channels, rchannels); } } if (state->default_rate != 0) { rrate = state->default_rate; CHECK(snd_pcm_hw_params_set_rate_near(hndl, params, &rrate, 0), "set_rate_near"); if (state->default_rate != rrate) { spa_log_warn(state->log, "%s: Rate doesn't match (requested %u, got %u)", state->props.device, state->default_rate, rrate); } } spa_pod_builder_push_object(b, &f[0], SPA_TYPE_OBJECT_Format, SPA_PARAM_EnumFormat); spa_pod_builder_add(b, SPA_FORMAT_mediaType, SPA_POD_Id(SPA_MEDIA_TYPE_audio), SPA_FORMAT_mediaSubtype, SPA_POD_Id(SPA_MEDIA_SUBTYPE_raw), 0); snd_pcm_format_mask_alloca(&fmask); snd_pcm_hw_params_get_format_mask(params, fmask); snd_pcm_access_mask_alloca(&amask); snd_pcm_hw_params_get_access_mask(params, amask); spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_format, 0); spa_pod_builder_push_choice(b, &f[1], SPA_CHOICE_None, 0); choice = (struct spa_pod_choice*)spa_pod_builder_frame(b, &f[1]); for (i = 1, j = 0; i < SPA_N_ELEMENTS(format_info); i++) { const struct format_info *fi = &format_info[i]; if (snd_pcm_format_mask_test(fmask, fi->format)) { if ((snd_pcm_access_mask_test(amask, SND_PCM_ACCESS_MMAP_NONINTERLEAVED) || snd_pcm_access_mask_test(amask, SND_PCM_ACCESS_RW_NONINTERLEAVED)) && fi->spa_pformat != SPA_AUDIO_FORMAT_UNKNOWN && (state->default_format == 0 || state->default_format == fi->spa_pformat)) { if (j++ == 0) spa_pod_builder_id(b, fi->spa_pformat); spa_pod_builder_id(b, fi->spa_pformat); } if ((snd_pcm_access_mask_test(amask, SND_PCM_ACCESS_MMAP_INTERLEAVED) || snd_pcm_access_mask_test(amask, SND_PCM_ACCESS_RW_INTERLEAVED)) && (state->default_format == 0 || state->default_format == fi->spa_format)) { if (j++ == 0) spa_pod_builder_id(b, fi->spa_format); spa_pod_builder_id(b, fi->spa_format); } } } if (j == 0) { char buf[1024]; int i, r, offs; for (i = 0, offs = 0; i <= SND_PCM_FORMAT_LAST; i++) { if (snd_pcm_format_mask_test(fmask, (snd_pcm_format_t)i)) { r = snprintf(&buf[offs], sizeof(buf) - offs, "%s ", snd_pcm_format_name((snd_pcm_format_t)i)); if (r < 0 || r + offs >= (int)sizeof(buf)) return -ENOSPC; offs += r; } } spa_log_warn(state->log, "%s: unsupported card: formats:%s", state->props.device, buf); for (i = 0, offs = 0; i <= SND_PCM_ACCESS_LAST; i++) { if (snd_pcm_access_mask_test(amask, (snd_pcm_access_t)i)) { r = snprintf(&buf[offs], sizeof(buf) - offs, "%s ", snd_pcm_access_name((snd_pcm_access_t)i)); if (r < 0 || r + offs >= (int)sizeof(buf)) return -ENOSPC; offs += r; } } spa_log_warn(state->log, "%s: unsupported card: access:%s", state->props.device, buf); return -ENOTSUP; } if (j > 1) choice->body.type = SPA_CHOICE_Enum; spa_pod_builder_pop(b, &f[1]); if ((res = add_rate(state, 1, false, index & 0xffff, next, params, b)) != 1) return res; if ((res = add_channels(state, false, index & 0xffff, next, params, b)) != 1) return res; *result = spa_pod_builder_pop(b, &f[0]); return 1; } static bool codec_supported(uint32_t codec, unsigned int chmax, unsigned int rmax) { switch (codec) { case SPA_AUDIO_IEC958_CODEC_PCM: case SPA_AUDIO_IEC958_CODEC_DTS: case SPA_AUDIO_IEC958_CODEC_AC3: case SPA_AUDIO_IEC958_CODEC_MPEG: case SPA_AUDIO_IEC958_CODEC_MPEG2_AAC: if (chmax >= 2) return true; break; case SPA_AUDIO_IEC958_CODEC_EAC3: if (rmax >= 48000 * 4 && chmax >= 2) return true; break; case SPA_AUDIO_IEC958_CODEC_TRUEHD: case SPA_AUDIO_IEC958_CODEC_DTSHD: if (chmax >= 8) return true; break; } return false; } static int enum_iec958_formats(struct state *state, uint32_t index, uint32_t *next, struct spa_pod **result, struct spa_pod_builder *b) { int res, err, dir; snd_pcm_t *hndl; snd_pcm_hw_params_t *params; struct spa_pod_frame f[2]; unsigned int rmin, rmax; unsigned int chmin, chmax; uint32_t i, c, codecs[16], n_codecs; if ((index & 0xffff) > 0) return 0; if (!(state->is_iec958 || state->is_hdmi)) return 0; if (state->iec958_codecs == 0) return 0; hndl = state->hndl; snd_pcm_hw_params_alloca(¶ms); CHECK(snd_pcm_hw_params_any(hndl, params), "Broken configuration: no configurations available"); CHECK(snd_pcm_hw_params_set_rate_resample(hndl, params, 0), "set_rate_resample"); spa_pod_builder_push_object(b, &f[0], SPA_TYPE_OBJECT_Format, SPA_PARAM_EnumFormat); spa_pod_builder_add(b, SPA_FORMAT_mediaType, SPA_POD_Id(SPA_MEDIA_TYPE_audio), SPA_FORMAT_mediaSubtype, SPA_POD_Id(SPA_MEDIA_SUBTYPE_iec958), 0); CHECK(snd_pcm_hw_params_get_channels_min(params, &chmin), "get_channels_min"); CHECK(snd_pcm_hw_params_get_channels_max(params, &chmax), "get_channels_max"); spa_log_debug(state->log, "channels (%d %d)", chmin, chmax); CHECK(snd_pcm_hw_params_get_rate_min(params, &rmin, &dir), "get_rate_min"); CHECK(snd_pcm_hw_params_get_rate_max(params, &rmax, &dir), "get_rate_max"); spa_log_debug(state->log, "rate (%d %d)", rmin, rmax); if (state->default_rate != 0) { if (rmin < state->default_rate) rmin = state->default_rate; if (rmax > state->default_rate) rmax = state->default_rate; } spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_iec958Codec, 0); spa_pod_builder_push_choice(b, &f[1], SPA_CHOICE_Enum, 0); n_codecs = spa_alsa_get_iec958_codecs(state, codecs, SPA_N_ELEMENTS(codecs)); for (i = 0, c = 0; i < n_codecs; i++) { if (!codec_supported(codecs[i], chmax, rmax)) continue; if (c++ == 0) spa_pod_builder_id(b, codecs[i]); spa_pod_builder_id(b, codecs[i]); } spa_pod_builder_pop(b, &f[1]); if ((res = add_rate(state, 1, true, index & 0xffff, next, params, b)) != 1) return res; (*next)++; *result = spa_pod_builder_pop(b, &f[0]); return 1; } static int enum_dsd_formats(struct state *state, uint32_t index, uint32_t *next, struct spa_pod **result, struct spa_pod_builder *b) { int res, err; snd_pcm_t *hndl; snd_pcm_hw_params_t *params; snd_pcm_format_mask_t *fmask; struct spa_pod_frame f[2]; int32_t interleave; if ((index & 0xffff) > 0) return 0; hndl = state->hndl; snd_pcm_hw_params_alloca(¶ms); CHECK(snd_pcm_hw_params_any(hndl, params), "Broken configuration: no configurations available"); snd_pcm_format_mask_alloca(&fmask); snd_pcm_hw_params_get_format_mask(params, fmask); if (snd_pcm_format_mask_test(fmask, SND_PCM_FORMAT_DSD_U32_BE)) interleave = 4; else if (snd_pcm_format_mask_test(fmask, SND_PCM_FORMAT_DSD_U32_LE)) interleave = -4; else if (snd_pcm_format_mask_test(fmask, SND_PCM_FORMAT_DSD_U16_BE)) interleave = 2; else if (snd_pcm_format_mask_test(fmask, SND_PCM_FORMAT_DSD_U16_LE)) interleave = -2; else if (snd_pcm_format_mask_test(fmask, SND_PCM_FORMAT_DSD_U8)) interleave = 1; else return 0; CHECK(snd_pcm_hw_params_set_rate_resample(hndl, params, 0), "set_rate_resample"); spa_pod_builder_push_object(b, &f[0], SPA_TYPE_OBJECT_Format, SPA_PARAM_EnumFormat); spa_pod_builder_add(b, SPA_FORMAT_mediaType, SPA_POD_Id(SPA_MEDIA_TYPE_audio), SPA_FORMAT_mediaSubtype, SPA_POD_Id(SPA_MEDIA_SUBTYPE_dsd), 0); spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_bitorder, 0); spa_pod_builder_id(b, SPA_PARAM_BITORDER_msb); spa_pod_builder_prop(b, SPA_FORMAT_AUDIO_interleave, 0); spa_pod_builder_int(b, interleave); if ((res = add_rate(state, SPA_ABS(interleave), true, index & 0xffff, next, params, b)) != 1) return res; if ((res = add_channels(state, true, index & 0xffff, next, params, b)) != 1) return res; *result = spa_pod_builder_pop(b, &f[0]); return 1; } int spa_alsa_enum_format(struct state *state, int seq, uint32_t start, uint32_t num, const struct spa_pod *filter) { uint8_t buffer[4096]; struct spa_pod_builder b = { 0 }; struct spa_pod *fmt; int err, res; bool opened; struct spa_result_node_params result; uint32_t count = 0; opened = state->opened; if ((err = spa_alsa_open(state, NULL)) < 0) return err; result.id = SPA_PARAM_EnumFormat; result.next = start; next: result.index = result.next++; spa_pod_builder_init(&b, buffer, sizeof(buffer)); if (result.index < 0x10000) { if ((res = enum_pcm_formats(state, result.index, &result.next, &fmt, &b)) != 1) { result.next = 0x10000; goto next; } } else if (result.index < 0x20000) { if ((res = enum_iec958_formats(state, result.index, &result.next, &fmt, &b)) != 1) { result.next = 0x20000; goto next; } } else if (result.index < 0x30000) { if ((res = enum_dsd_formats(state, result.index, &result.next, &fmt, &b)) != 1) { result.next = 0x30000; goto next; } } else goto enum_end; if (spa_pod_filter(&b, &result.param, fmt, filter) < 0) goto next; spa_node_emit_result(&state->hooks, seq, 0, SPA_RESULT_TYPE_NODE_PARAMS, &result); if (++count != num) goto next; enum_end: res = 0; if (!opened) spa_alsa_close(state); return res; } int spa_alsa_set_format(struct state *state, struct spa_audio_info *fmt, uint32_t flags) { unsigned int rrate, rchannels, val; snd_pcm_uframes_t period_size; int err, dir; snd_pcm_hw_params_t *params; snd_pcm_format_t rformat; snd_pcm_access_mask_t *amask; snd_pcm_t *hndl; unsigned int periods; bool match = true, planar = false, is_batch; char spdif_params[128] = ""; state->use_mmap = !state->disable_mmap; switch (fmt->media_subtype) { case SPA_MEDIA_SUBTYPE_raw: { struct spa_audio_info_raw *f = &fmt->info.raw; rrate = f->rate; rchannels = f->channels; rformat = spa_format_to_alsa(f->format, &planar); break; } case SPA_MEDIA_SUBTYPE_iec958: { struct spa_audio_info_iec958 *f = &fmt->info.iec958; unsigned aes3; spa_log_info(state->log, "using IEC958 Codec:%s rate:%d", spa_debug_type_find_short_name(spa_type_audio_iec958_codec, f->codec), f->rate); rformat = SND_PCM_FORMAT_S16_LE; rchannels = 2; rrate = f->rate; switch (f->codec) { case SPA_AUDIO_IEC958_CODEC_PCM: case SPA_AUDIO_IEC958_CODEC_DTS: case SPA_AUDIO_IEC958_CODEC_AC3: case SPA_AUDIO_IEC958_CODEC_MPEG: case SPA_AUDIO_IEC958_CODEC_MPEG2_AAC: break; case SPA_AUDIO_IEC958_CODEC_EAC3: rrate *= 4; break; case SPA_AUDIO_IEC958_CODEC_TRUEHD: case SPA_AUDIO_IEC958_CODEC_DTSHD: rchannels = 8; break; default: return -ENOTSUP; } switch (rrate) { case 22050: aes3 = IEC958_AES3_CON_FS_22050; break; case 24000: aes3 = IEC958_AES3_CON_FS_24000; break; case 32000: aes3 = IEC958_AES3_CON_FS_32000; break; case 44100: aes3 = IEC958_AES3_CON_FS_44100; break; case 48000: aes3 = IEC958_AES3_CON_FS_48000; break; case 88200: aes3 = IEC958_AES3_CON_FS_88200; break; case 96000: aes3 = IEC958_AES3_CON_FS_96000; break; case 176400: aes3 = IEC958_AES3_CON_FS_176400; break; case 192000: aes3 = IEC958_AES3_CON_FS_192000; break; case 768000: aes3 = IEC958_AES3_CON_FS_768000; break; default: aes3 = IEC958_AES3_CON_FS_NOTID; break; } spa_scnprintf(spdif_params, sizeof(spdif_params), ",AES0=0x%x,AES1=0x%x,AES2=0x%x,AES3=0x%x", IEC958_AES0_CON_EMPHASIS_NONE | IEC958_AES0_NONAUDIO, IEC958_AES1_CON_ORIGINAL | IEC958_AES1_CON_PCM_CODER, 0, aes3); break; } case SPA_MEDIA_SUBTYPE_dsd: { struct spa_audio_info_dsd *f = &fmt->info.dsd; rrate = f->rate; rchannels = f->channels; switch (f->interleave) { case 4: rformat = SND_PCM_FORMAT_DSD_U32_BE; rrate /= 4; break; case -4: rformat = SND_PCM_FORMAT_DSD_U32_LE; rrate /= 4; break; case 2: rformat = SND_PCM_FORMAT_DSD_U16_BE; rrate /= 2; break; case -2: rformat = SND_PCM_FORMAT_DSD_U16_LE; rrate /= 2; break; case 1: rformat = SND_PCM_FORMAT_DSD_U8; break; default: return -ENOTSUP; } break; } default: return -ENOTSUP; } if (rformat == SND_PCM_FORMAT_UNKNOWN) { spa_log_warn(state->log, "%s: unknown format", state->props.device); return -EINVAL; } if ((err = spa_alsa_open(state, spdif_params)) < 0) return err; hndl = state->hndl; snd_pcm_hw_params_alloca(¶ms); /* choose all parameters */ CHECK(snd_pcm_hw_params_any(hndl, params), "Broken configuration for playback: no configurations available"); /* set hardware resampling, no resample */ CHECK(snd_pcm_hw_params_set_rate_resample(hndl, params, 0), "set_rate_resample"); /* set the interleaved/planar read/write format */ snd_pcm_access_mask_alloca(&amask); snd_pcm_hw_params_get_access_mask(params, amask); if (state->use_mmap) { if ((err = snd_pcm_hw_params_set_access(hndl, params, planar ? SND_PCM_ACCESS_MMAP_NONINTERLEAVED : SND_PCM_ACCESS_MMAP_INTERLEAVED)) < 0) { spa_log_debug(state->log, "%p: MMAP not possible: %s", state, snd_strerror(err)); state->use_mmap = false; } } if (!state->use_mmap) { if ((err = snd_pcm_hw_params_set_access(hndl, params, planar ? SND_PCM_ACCESS_RW_NONINTERLEAVED : SND_PCM_ACCESS_RW_INTERLEAVED)) < 0) { spa_log_error(state->log, "%s: RW not possible: %s", state->props.device, snd_strerror(err)); return err; } } /* set the sample format */ spa_log_debug(state->log, "%p: Stream parameters are %iHz fmt:%s access:%s-%s channels:%i", state, rrate, snd_pcm_format_name(rformat), state->use_mmap ? "mmap" : "rw", planar ? "planar" : "interleaved", rchannels); CHECK(snd_pcm_hw_params_set_format(hndl, params, rformat), "set_format"); /* set the count of channels */ val = rchannels; CHECK(snd_pcm_hw_params_set_channels_near(hndl, params, &val), "set_channels"); if (rchannels != val) { spa_log_warn(state->log, "%s: Channels doesn't match (requested %u, got %u)", state->props.device, rchannels, val); if (!SPA_FLAG_IS_SET(flags, SPA_NODE_PARAM_FLAG_NEAREST)) return -EINVAL; rchannels = val; match = false; } /* set the stream rate */ val = rrate; CHECK(snd_pcm_hw_params_set_rate_near(hndl, params, &val, 0), "set_rate_near"); if (rrate != val) { spa_log_warn(state->log, "%s: Rate doesn't match (requested %iHz, got %iHz)", state->props.device, rrate, val); if (!SPA_FLAG_IS_SET(flags, SPA_NODE_PARAM_FLAG_NEAREST)) return -EINVAL; rrate = val; match = false; } state->format = rformat; state->channels = rchannels; state->rate = rrate; state->frame_size = snd_pcm_format_physical_width(rformat) / 8; state->planar = planar; state->blocks = 1; if (planar) state->blocks *= rchannels; else state->frame_size *= rchannels; dir = 0; period_size = state->default_period_size ? state->default_period_size : 1024; is_batch = snd_pcm_hw_params_is_batch(params) && !state->disable_batch; if (is_batch) { /* batch devices get their hw pointers updated every period. Make * the period smaller and add one period of headroom */ period_size /= 2; spa_log_info(state->log, "%s: batch mode, period_size:%ld", state->props.device, period_size); } else { /* disable ALSA wakeups, we use a timer */ if (snd_pcm_hw_params_can_disable_period_wakeup(params)) CHECK(snd_pcm_hw_params_set_period_wakeup(hndl, params, 0), "set_period_wakeup"); } CHECK(snd_pcm_hw_params_set_period_size_near(hndl, params, &period_size, &dir), "set_period_size_near"); CHECK(snd_pcm_hw_params_get_buffer_size_max(params, &state->buffer_frames), "get_buffer_size_max"); CHECK(snd_pcm_hw_params_set_buffer_size_near(hndl, params, &state->buffer_frames), "set_buffer_size_near"); state->headroom = state->default_headroom; if (is_batch) state->headroom += period_size; state->headroom = SPA_MIN(state->headroom, state->buffer_frames); state->start_delay = state->default_start_delay; state->latency[state->port_direction].min_rate = state->headroom; state->latency[state->port_direction].max_rate = state->headroom; state->period_frames = period_size; periods = state->buffer_frames / state->period_frames; spa_log_info(state->log, "%s (%s): format:%s access:%s-%s rate:%d channels:%d " "buffer frames %lu, period frames %lu, periods %u, frame_size %zd " "headroom %u start-delay:%u", state->props.device, state->stream == SND_PCM_STREAM_CAPTURE ? "capture" : "playback", snd_pcm_format_name(state->format), state->use_mmap ? "mmap" : "rw", planar ? "planar" : "interleaved", state->rate, state->channels, state->buffer_frames, state->period_frames, periods, state->frame_size, state->headroom, state->start_delay); /* write the parameters to device */ CHECK(snd_pcm_hw_params(hndl, params), "set_hw_params"); return match ? 0 : 1; } static int set_swparams(struct state *state) { snd_pcm_t *hndl = state->hndl; int err = 0; snd_pcm_sw_params_t *params; snd_pcm_sw_params_alloca(¶ms); /* get the current params */ CHECK(snd_pcm_sw_params_current(hndl, params), "sw_params_current"); CHECK(snd_pcm_sw_params_set_tstamp_mode(hndl, params, SND_PCM_TSTAMP_ENABLE), "sw_params_set_tstamp_mode"); #if 0 snd_pcm_uframes_t boundary; CHECK(snd_pcm_sw_params_get_boundary(params, &boundary), "get_boundary"); CHECK(snd_pcm_sw_params_set_stop_threshold(hndl, params, boundary), "set_stop_threshold"); #endif /* start the transfer */ CHECK(snd_pcm_sw_params_set_start_threshold(hndl, params, LONG_MAX), "set_start_threshold"); CHECK(snd_pcm_sw_params_set_period_event(hndl, params, 0), "set_period_event"); /* write the parameters to the playback device */ CHECK(snd_pcm_sw_params(hndl, params), "sw_params"); return 0; } static int set_timeout(struct state *state, uint64_t time) { struct itimerspec ts; ts.it_value.tv_sec = time / SPA_NSEC_PER_SEC; ts.it_value.tv_nsec = time % SPA_NSEC_PER_SEC; ts.it_interval.tv_sec = 0; ts.it_interval.tv_nsec = 0; spa_system_timerfd_settime(state->data_system, state->timerfd, SPA_FD_TIMER_ABSTIME, &ts, NULL); return 0; } int spa_alsa_silence(struct state *state, snd_pcm_uframes_t silence) { snd_pcm_t *hndl = state->hndl; const snd_pcm_channel_area_t *my_areas; snd_pcm_uframes_t frames, offset; int i, res; if (state->use_mmap) { frames = state->buffer_frames; if (SPA_UNLIKELY((res = snd_pcm_mmap_begin(hndl, &my_areas, &offset, &frames)) < 0)) { spa_log_error(state->log, "%s: snd_pcm_mmap_begin error: %s", state->props.device, snd_strerror(res)); return res; } silence = SPA_MIN(silence, frames); spa_log_trace_fp(state->log, "%p: frames:%ld offset:%ld silence %ld", state, frames, offset, silence); snd_pcm_areas_silence(my_areas, offset, state->channels, silence, state->format); if (SPA_UNLIKELY((res = snd_pcm_mmap_commit(hndl, offset, silence)) < 0)) { spa_log_error(state->log, "%s: snd_pcm_mmap_commit error: %s", state->props.device, snd_strerror(res)); return res; } } else { uint8_t buffer[silence * state->frame_size]; memset(buffer, 0, silence * state->frame_size); if (state->planar) { void *bufs[state->channels]; for (i = 0; i < state->channels; i++) bufs[i] = buffer; snd_pcm_writen(hndl, bufs, silence); } else { snd_pcm_writei(hndl, buffer, silence); } } return 0; } static inline int do_start(struct state *state) { int res; if (SPA_UNLIKELY(!state->alsa_started)) { spa_log_trace(state->log, "%p: snd_pcm_start", state); if ((res = snd_pcm_start(state->hndl)) < 0) { spa_log_error(state->log, "%s: snd_pcm_start: %s", state->props.device, snd_strerror(res)); return res; } state->alsa_started = true; } return 0; } static int alsa_recover(struct state *state, int err) { int res, st; snd_pcm_status_t *status; snd_pcm_status_alloca(&status); if (SPA_UNLIKELY((res = snd_pcm_status(state->hndl, status)) < 0)) { spa_log_error(state->log, "%s: snd_pcm_status error: %s", state->props.device, snd_strerror(res)); goto recover; } st = snd_pcm_status_get_state(status); switch (st) { case SND_PCM_STATE_XRUN: { struct timeval now, trigger, diff; uint64_t delay, missing; snd_pcm_status_get_tstamp (status, &now); snd_pcm_status_get_trigger_tstamp (status, &trigger); timersub(&now, &trigger, &diff); delay = SPA_TIMEVAL_TO_USEC(&diff); missing = delay * state->rate / SPA_USEC_PER_SEC; spa_log_trace(state->log, "%p: xrun of %"PRIu64" usec %"PRIu64, state, delay, missing); spa_node_call_xrun(&state->callbacks, SPA_TIMEVAL_TO_USEC(&trigger), delay, NULL); state->sample_count += missing ? missing : state->threshold; break; } case SND_PCM_STATE_SUSPENDED: spa_log_info(state->log, "%s: recover from state %s", state->props.device, snd_pcm_state_name(st)); err = -ESTRPIPE; break; default: spa_log_error(state->log, "%s: recover from error state %s", state->props.device, snd_pcm_state_name(st)); break; } recover: if (SPA_UNLIKELY((res = snd_pcm_recover(state->hndl, err, true)) < 0)) { spa_log_error(state->log, "%s: snd_pcm_recover error: %s", state->props.device, snd_strerror(res)); return res; } spa_dll_init(&state->dll); state->alsa_recovering = true; state->alsa_started = false; if (state->stream == SND_PCM_STREAM_PLAYBACK) spa_alsa_silence(state, state->start_delay + state->threshold * 2 + state->headroom); return do_start(state); } static int get_status(struct state *state, snd_pcm_uframes_t *delay, snd_pcm_uframes_t *target) { snd_pcm_sframes_t avail; int res; if (SPA_UNLIKELY((avail = snd_pcm_avail(state->hndl)) < 0)) { if ((res = alsa_recover(state, avail)) < 0) return res; if ((avail = snd_pcm_avail(state->hndl)) < 0) { spa_log_warn(state->log, "%s: snd_pcm_avail after recover: %s", state->props.device, snd_strerror(avail)); avail = state->threshold * 2; } } else { state->alsa_recovering = false; } *target = state->threshold + state->headroom; if (state->resample && state->rate_match) { state->delay = state->rate_match->delay; state->read_size = state->rate_match->size; } else { state->delay = 0; state->read_size = state->threshold; } if (state->stream == SND_PCM_STREAM_PLAYBACK) { *delay = state->buffer_frames - avail; } else { *delay = avail; *target = SPA_MAX(*target, state->read_size); } return 0; } static int update_time(struct state *state, uint64_t nsec, snd_pcm_sframes_t delay, snd_pcm_sframes_t target, bool follower) { double err, corr; int32_t diff; if (state->stream == SND_PCM_STREAM_PLAYBACK) err = delay - target; else err = target - delay; if (SPA_UNLIKELY(state->dll.bw == 0.0)) { spa_dll_set_bw(&state->dll, SPA_DLL_BW_MAX, state->threshold, state->rate); state->next_time = nsec; state->base_time = nsec; } diff = (int32_t) (state->last_threshold - state->threshold); if (SPA_UNLIKELY(diff != 0)) { err -= diff; spa_log_trace(state->log, "%p: follower:%d quantum change %d -> %d (%d) %f", state, follower, state->last_threshold, state->threshold, diff, err); state->last_threshold = state->threshold; } err = SPA_CLAMP(err, -state->max_error, state->max_error); corr = spa_dll_update(&state->dll, err); if (diff < 0) state->next_time += diff / corr * 1e9 / state->rate; if (SPA_UNLIKELY((state->next_time - state->base_time) > BW_PERIOD)) { state->base_time = state->next_time; spa_log_debug(state->log, "%p: follower:%d match:%d rate:%f " "bw:%f thr:%d del:%ld target:%ld err:%f (%f %f %f)", state, follower, state->matching, corr, state->dll.bw, state->threshold, delay, target, err, state->dll.z1, state->dll.z2, state->dll.z3); } if (state->rate_match) { if (state->stream == SND_PCM_STREAM_PLAYBACK) state->rate_match->rate = corr; else state->rate_match->rate = 1.0/corr; SPA_FLAG_UPDATE(state->rate_match->flags, SPA_IO_RATE_MATCH_FLAG_ACTIVE, state->matching); } state->next_time += state->threshold / corr * 1e9 / state->rate; if (SPA_LIKELY(!follower && state->clock)) { state->clock->nsec = nsec; state->clock->position += state->duration; state->clock->duration = state->duration; state->clock->delay = delay + state->delay; state->clock->rate_diff = corr; state->clock->next_nsec = state->next_time; } spa_log_trace_fp(state->log, "%p: follower:%d %"PRIu64" %f %ld %f %f %d", state, follower, nsec, corr, delay, err, state->threshold * corr, state->threshold); return 0; } static inline bool is_following(struct state *state) { return state->position && state->clock && state->position->clock.id != state->clock->id; } static int setup_matching(struct state *state) { int card; state->matching = state->following; if (state->position == NULL) return -ENOTSUP; spa_log_debug(state->log, "clock:%s card:%d", state->position->clock.name, state->card); if (sscanf(state->position->clock.name, "api.alsa.%d", &card) == 1 && card == state->card) { state->matching = false; } state->resample = ((uint32_t)state->rate != state->rate_denom) || state->matching; return 0; } static inline void check_position_config(struct state *state) { if (SPA_UNLIKELY(state->position == NULL)) return; if (SPA_UNLIKELY((state->duration != state->position->clock.duration) || (state->rate_denom != state->position->clock.rate.denom))) { state->duration = state->position->clock.duration; state->rate_denom = state->position->clock.rate.denom; state->threshold = (state->duration * state->rate + state->rate_denom-1) / state->rate_denom; state->resample = ((uint32_t)state->rate != state->rate_denom) || state->matching; } } int spa_alsa_write(struct state *state) { snd_pcm_t *hndl = state->hndl; const snd_pcm_channel_area_t *my_areas; snd_pcm_uframes_t written, frames, offset, off, to_write, total_written; snd_pcm_sframes_t commitres; int res = 0; check_position_config(state); if (state->following && state->alsa_started) { uint64_t nsec; snd_pcm_uframes_t delay, target; if (SPA_UNLIKELY((res = get_status(state, &delay, &target)) < 0)) return res; if (SPA_UNLIKELY(!state->alsa_recovering && delay > target + state->threshold)) { spa_log_warn(state->log, "%s: follower delay:%ld target:%ld resync %f %f %f", state->props.device, delay, target + state->threshold, state->dll.z1, state->dll.z2, state->dll.z3); spa_dll_init(&state->dll); state->alsa_sync = true; } if (SPA_UNLIKELY(state->alsa_sync)) { if (delay > target) snd_pcm_rewind(state->hndl, delay - target); else snd_pcm_forward(state->hndl, target - delay); delay = target; state->alsa_sync = false; } nsec = state->position->clock.nsec; if (SPA_UNLIKELY((res = update_time(state, nsec, delay, target, true)) < 0)) return res; } total_written = 0; again: frames = state->buffer_frames; if (state->use_mmap) { if (SPA_UNLIKELY((res = snd_pcm_mmap_begin(hndl, &my_areas, &offset, &frames)) < 0)) { spa_log_error(state->log, "%s: snd_pcm_mmap_begin error: %s", state->props.device, snd_strerror(res)); return res; } spa_log_trace_fp(state->log, "%p: begin %ld %ld %d", state, offset, frames, state->threshold); off = offset; } else { off = 0; } to_write = frames; written = 0; while (!spa_list_is_empty(&state->ready) && to_write > 0) { uint8_t *dst, *src; size_t n_bytes, n_frames; struct buffer *b; struct spa_data *d; uint32_t i, index, offs, avail, size, maxsize, l0, l1; b = spa_list_first(&state->ready, struct buffer, link); d = b->buf->datas; size = d[0].chunk->size; maxsize = d[0].maxsize; index = d[0].chunk->offset + state->ready_offset; avail = size - state->ready_offset; avail /= state->frame_size; n_frames = SPA_MIN(avail, to_write); n_bytes = n_frames * state->frame_size; offs = index % maxsize; l0 = SPA_MIN(n_bytes, maxsize - offs); l1 = n_bytes - l0; if (SPA_LIKELY(state->use_mmap)) { for (i = 0; i < b->buf->n_datas; i++) { dst = SPA_PTROFF(my_areas[i].addr, off * state->frame_size, uint8_t); src = d[i].data; spa_memcpy(dst, src + offs, l0); if (SPA_UNLIKELY(l1 > 0)) spa_memcpy(dst + l0, src, l1); } } else { if (state->planar) { void *bufs[b->buf->n_datas]; for (i = 0; i < b->buf->n_datas; i++) bufs[i] = SPA_PTROFF(d[i].data, offs, void); snd_pcm_writen(hndl, bufs, l0 / state->frame_size); if (SPA_UNLIKELY(l1 > 0)) { for (i = 0; i < b->buf->n_datas; i++) bufs[i] = d[i].data; snd_pcm_writen(hndl, bufs, l1 / state->frame_size); } } else { src = d[0].data; snd_pcm_writei(hndl, src + offs, l0 / state->frame_size); if (SPA_UNLIKELY(l1 > 0)) snd_pcm_writei(hndl, src, l1 / state->frame_size); } } state->ready_offset += n_bytes; if (state->ready_offset >= size) { spa_list_remove(&b->link); SPA_FLAG_SET(b->flags, BUFFER_FLAG_OUT); state->io->buffer_id = b->id; spa_log_trace_fp(state->log, "%p: reuse buffer %u", state, b->id); spa_node_call_reuse_buffer(&state->callbacks, 0, b->id); state->ready_offset = 0; } written += n_frames; off += n_frames; to_write -= n_frames; } spa_log_trace_fp(state->log, "%p: commit %ld %ld %"PRIi64, state, offset, written, state->sample_count); total_written += written; if (state->use_mmap) { if (SPA_UNLIKELY((commitres = snd_pcm_mmap_commit(hndl, offset, written)) < 0)) { spa_log_error(state->log, "%s: snd_pcm_mmap_commit error: %s", state->props.device, snd_strerror(commitres)); if (commitres != -EPIPE && commitres != -ESTRPIPE) return res; } if (commitres > 0 && written != (snd_pcm_uframes_t) commitres) { spa_log_warn(state->log, "%s: mmap_commit wrote %ld instead of %ld", state->props.device, commitres, written); } } if (!spa_list_is_empty(&state->ready) && written > 0) goto again; state->sample_count += total_written; if (SPA_UNLIKELY(!state->alsa_started && total_written > 0)) do_start(state); return 0; } void spa_alsa_recycle_buffer(struct state *this, uint32_t buffer_id) { struct buffer *b = &this->buffers[buffer_id]; if (SPA_FLAG_IS_SET(b->flags, BUFFER_FLAG_OUT)) { spa_log_trace_fp(this->log, "%p: recycle buffer %u", this, buffer_id); spa_list_append(&this->free, &b->link); SPA_FLAG_CLEAR(b->flags, BUFFER_FLAG_OUT); } } static snd_pcm_uframes_t push_frames(struct state *state, const snd_pcm_channel_area_t *my_areas, snd_pcm_uframes_t offset, snd_pcm_uframes_t frames) { snd_pcm_uframes_t total_frames = 0; if (spa_list_is_empty(&state->free)) { spa_log_warn(state->log, "%s: no more buffers", state->props.device); total_frames = frames; } else { uint8_t *src; size_t n_bytes, left; struct buffer *b; struct spa_data *d; uint32_t i, avail, l0, l1; b = spa_list_first(&state->free, struct buffer, link); spa_list_remove(&b->link); if (b->h) { b->h->seq = state->sample_count; b->h->pts = state->next_time; b->h->dts_offset = 0; } d = b->buf->datas; avail = d[0].maxsize / state->frame_size; total_frames = SPA_MIN(avail, frames); n_bytes = total_frames * state->frame_size; if (my_areas) { left = state->buffer_frames - offset; l0 = SPA_MIN(n_bytes, left * state->frame_size); l1 = n_bytes - l0; for (i = 0; i < b->buf->n_datas; i++) { src = SPA_PTROFF(my_areas[i].addr, offset * state->frame_size, uint8_t); spa_memcpy(d[i].data, src, l0); if (l1 > 0) spa_memcpy(SPA_PTROFF(d[i].data, l0, void), my_areas[i].addr, l1); d[i].chunk->offset = 0; d[i].chunk->size = n_bytes; d[i].chunk->stride = state->frame_size; } } else { void *bufs[b->buf->n_datas]; for (i = 0; i < b->buf->n_datas; i++) { bufs[i] = d[i].data; d[i].chunk->offset = 0; d[i].chunk->size = n_bytes; d[i].chunk->stride = state->frame_size; } if (state->planar) { snd_pcm_readn(state->hndl, bufs, total_frames); } else { snd_pcm_readi(state->hndl, bufs[0], total_frames); } } spa_log_trace_fp(state->log, "%p: wrote %ld frames into buffer %d", state, total_frames, b->id); spa_list_append(&state->ready, &b->link); } return total_frames; } int spa_alsa_read(struct state *state) { snd_pcm_t *hndl = state->hndl; snd_pcm_uframes_t total_read = 0, to_read; const snd_pcm_channel_area_t *my_areas; snd_pcm_uframes_t read, frames, offset; snd_pcm_sframes_t commitres; int res = 0; if (state->position) { check_position_config(state); if (!state->following) { uint64_t position; position = state->position->clock.position; if (state->last_position && state->last_position + state->last_duration != position) { state->alsa_sync = true; spa_log_info(state->log, "%s: discont, resync %"PRIu64" %"PRIu64" %d", state->props.device, state->last_position, position, state->last_duration); } state->last_position = position; state->last_duration = state->duration; } } if (state->following && state->alsa_started) { uint64_t nsec; snd_pcm_uframes_t delay, target; uint32_t threshold = state->threshold; if ((res = get_status(state, &delay, &target)) < 0) return res; if (!state->alsa_recovering && (delay < target / 2 || delay > target * 2)) { spa_log_warn(state->log, "%s: follower delay:%lu target:%lu resync %f %f %f", state->props.device, delay, target, state->dll.z1, state->dll.z2, state->dll.z3); spa_dll_init(&state->dll); state->alsa_sync = true; } if (state->alsa_sync) { spa_log_warn(state->log, "%s: follower resync %ld %d %ld", state->props.device, delay, threshold, target); if (delay < target) snd_pcm_rewind(state->hndl, target - delay); else if (delay > target) snd_pcm_forward(state->hndl, delay - target); delay = target; state->alsa_sync = false; } nsec = state->position->clock.nsec; if ((res = update_time(state, nsec, delay, target, true)) < 0) return res; } frames = state->read_size; if (state->use_mmap) { to_read = state->buffer_frames; if ((res = snd_pcm_mmap_begin(hndl, &my_areas, &offset, &to_read)) < 0) { spa_log_error(state->log, "%s: snd_pcm_mmap_begin error: %s", state->props.device, snd_strerror(res)); return res; } spa_log_trace_fp(state->log, "%p: begin offs:%ld frames:%ld to_read:%ld thres:%d", state, offset, frames, to_read, state->threshold); } else { my_areas = NULL; offset = 0; } read = push_frames(state, my_areas, offset, frames); total_read += read; if (state->use_mmap) { spa_log_trace_fp(state->log, "%p: commit offs:%ld read:%ld count:%"PRIi64, state, offset, read, state->sample_count); if ((commitres = snd_pcm_mmap_commit(hndl, offset, read)) < 0) { spa_log_error(state->log, "%s: snd_pcm_mmap_commit error: %s", state->props.device, snd_strerror(commitres)); if (commitres != -EPIPE && commitres != -ESTRPIPE) return res; } if (commitres > 0 && read != (snd_pcm_uframes_t) commitres) { spa_log_warn(state->log, "%s: mmap_commit read %ld instead of %ld", state->props.device, commitres, read); } } state->sample_count += total_read; return 0; } int spa_alsa_skip(struct state *state) { struct buffer *b; struct spa_data *d; uint32_t i, avail, total_frames, n_bytes, frames; if (spa_list_is_empty(&state->free)) { spa_log_warn(state->log, "%s: no more buffers", state->props.device); return -EPIPE; } frames = state->read_size; b = spa_list_first(&state->free, struct buffer, link); spa_list_remove(&b->link); d = b->buf->datas; avail = d[0].maxsize / state->frame_size; total_frames = SPA_MIN(avail, frames); n_bytes = total_frames * state->frame_size; for (i = 0; i < b->buf->n_datas; i++) { memset(d[i].data, 0, n_bytes); d[i].chunk->offset = 0; d[i].chunk->size = n_bytes; d[i].chunk->stride = state->frame_size; } spa_list_append(&state->ready, &b->link); return 0; } static int handle_play(struct state *state, uint64_t nsec, snd_pcm_uframes_t delay, snd_pcm_uframes_t target) { int res; if (SPA_UNLIKELY(delay > target + state->max_error)) { spa_log_trace(state->log, "%p: early wakeup %lu %lu", state, delay, target); if (delay > target * 3) delay = target * 3; state->next_time = nsec + (delay - target) * SPA_NSEC_PER_SEC / state->rate; return -EAGAIN; } if (SPA_UNLIKELY((res = update_time(state, nsec, delay, target, false)) < 0)) return res; if (spa_list_is_empty(&state->ready)) { struct spa_io_buffers *io = state->io; spa_log_trace_fp(state->log, "%p: %d", state, io->status); io->status = SPA_STATUS_NEED_DATA; res = spa_node_call_ready(&state->callbacks, SPA_STATUS_NEED_DATA); } else { res = spa_alsa_write(state); } return res; } static int handle_capture(struct state *state, uint64_t nsec, snd_pcm_uframes_t delay, snd_pcm_uframes_t target) { int res; struct spa_io_buffers *io; if (SPA_UNLIKELY(delay < target)) { spa_log_trace(state->log, "%p: early wakeup %ld %ld", state, delay, target); state->next_time = nsec + (target - delay) * SPA_NSEC_PER_SEC / state->rate; return -EAGAIN; } if (SPA_UNLIKELY(res = update_time(state, nsec, delay, target, false)) < 0) return res; if ((res = spa_alsa_read(state)) < 0) return res; if (spa_list_is_empty(&state->ready)) return 0; io = state->io; if (io != NULL && (io->status != SPA_STATUS_HAVE_DATA || state->rate_match != NULL)) { struct buffer *b; if (io->buffer_id < state->n_buffers) spa_alsa_recycle_buffer(state, io->buffer_id); b = spa_list_first(&state->ready, struct buffer, link); spa_list_remove(&b->link); SPA_FLAG_SET(b->flags, BUFFER_FLAG_OUT); io->buffer_id = b->id; io->status = SPA_STATUS_HAVE_DATA; spa_log_trace_fp(state->log, "%p: output buffer:%d", state, b->id); } spa_node_call_ready(&state->callbacks, SPA_STATUS_HAVE_DATA); return 0; } static void alsa_on_timeout_event(struct spa_source *source) { struct state *state = source->data; snd_pcm_uframes_t delay, target; uint64_t expire; if (SPA_UNLIKELY(state->started && spa_system_timerfd_read(state->data_system, state->timerfd, &expire) < 0)) spa_log_warn(state->log, "%p: error reading timerfd: %m", state); check_position_config(state); if (SPA_UNLIKELY(get_status(state, &delay, &target) < 0)) return; state->current_time = state->next_time; #ifndef FASTPATH if (SPA_UNLIKELY(spa_log_level_enabled(state->log, SPA_LOG_LEVEL_TRACE))) { struct timespec now; uint64_t nsec; if (spa_system_clock_gettime(state->data_system, CLOCK_MONOTONIC, &now) < 0) return; nsec = SPA_TIMESPEC_TO_NSEC(&now); spa_log_trace_fp(state->log, "%p: timeout %lu %lu %"PRIu64" %"PRIu64" %"PRIi64 " %d %"PRIi64, state, delay, target, nsec, state->current_time, nsec - state->current_time, state->threshold, state->sample_count); } #endif if (state->stream == SND_PCM_STREAM_PLAYBACK) handle_play(state, state->current_time, delay, target); else handle_capture(state, state->current_time, delay, target); set_timeout(state, state->next_time); } static void reset_buffers(struct state *this) { uint32_t i; spa_list_init(&this->free); spa_list_init(&this->ready); for (i = 0; i < this->n_buffers; i++) { struct buffer *b = &this->buffers[i]; if (this->stream == SND_PCM_STREAM_PLAYBACK) { SPA_FLAG_SET(b->flags, BUFFER_FLAG_OUT); spa_node_call_reuse_buffer(&this->callbacks, 0, b->id); } else { spa_list_append(&this->free, &b->link); SPA_FLAG_CLEAR(b->flags, BUFFER_FLAG_OUT); } } } static int set_timers(struct state *state) { struct timespec now; int res; if ((res = spa_system_clock_gettime(state->data_system, CLOCK_MONOTONIC, &now)) < 0) return res; state->next_time = SPA_TIMESPEC_TO_NSEC(&now); if (state->following) { set_timeout(state, 0); } else { set_timeout(state, state->next_time); } return 0; } int spa_alsa_start(struct state *state) { int err; if (state->started) return 0; if (state->position) { state->duration = state->position->clock.duration; state->rate_denom = state->position->clock.rate.denom; } else { spa_log_warn(state->log, "%s: no position set, using defaults", state->props.device); state->duration = state->props.min_latency; state->rate_denom = state->rate; } state->following = is_following(state); setup_matching(state); state->threshold = (state->duration * state->rate + state->rate_denom-1) / state->rate_denom; state->last_threshold = state->threshold; spa_dll_init(&state->dll); state->max_error = (256.0 * state->rate) / state->rate_denom; spa_log_debug(state->log, "%p: start %d duration:%d rate:%d follower:%d match:%d resample:%d", state, state->threshold, state->duration, state->rate_denom, state->following, state->matching, state->resample); CHECK(set_swparams(state), "swparams"); if (SPA_UNLIKELY(spa_log_level_enabled(state->log, SPA_LOG_LEVEL_DEBUG))) snd_pcm_dump(state->hndl, state->output); if ((err = snd_pcm_prepare(state->hndl)) < 0 && err != -EBUSY) { spa_log_error(state->log, "%s: snd_pcm_prepare error: %s", state->props.device, snd_strerror(err)); return err; } state->source.func = alsa_on_timeout_event; state->source.data = state; state->source.fd = state->timerfd; state->source.mask = SPA_IO_IN; state->source.rmask = 0; spa_loop_add_source(state->data_loop, &state->source); reset_buffers(state); state->alsa_sync = true; state->alsa_recovering = false; state->alsa_started = false; if (state->stream == SND_PCM_STREAM_PLAYBACK) spa_alsa_silence(state, state->start_delay + state->threshold * 2 + state->headroom); if ((err = do_start(state)) < 0) return err; set_timers(state); state->started = true; return 0; } static int do_reassign_follower(struct spa_loop *loop, bool async, uint32_t seq, const void *data, size_t size, void *user_data) { struct state *state = user_data; set_timers(state); spa_dll_init(&state->dll); return 0; } int spa_alsa_reassign_follower(struct state *state) { bool following, freewheel; if (!state->started) return 0; following = is_following(state); if (following != state->following) { spa_log_debug(state->log, "%p: reassign follower %d->%d", state, state->following, following); state->following = following; spa_loop_invoke(state->data_loop, do_reassign_follower, 0, NULL, 0, true, state); } setup_matching(state); freewheel = state->position && SPA_FLAG_IS_SET(state->position->clock.flags, SPA_IO_CLOCK_FLAG_FREEWHEEL); if (state->freewheel != freewheel) { spa_log_debug(state->log, "%p: freewheel %d->%d", state, state->freewheel, freewheel); state->freewheel = freewheel; if (freewheel) snd_pcm_pause(state->hndl, 1); else snd_pcm_pause(state->hndl, 0); } return 0; } static int do_remove_source(struct spa_loop *loop, bool async, uint32_t seq, const void *data, size_t size, void *user_data) { struct state *state = user_data; struct itimerspec ts; spa_loop_remove_source(state->data_loop, &state->source); ts.it_value.tv_sec = 0; ts.it_value.tv_nsec = 0; ts.it_interval.tv_sec = 0; ts.it_interval.tv_nsec = 0; spa_system_timerfd_settime(state->data_system, state->timerfd, 0, &ts, NULL); return 0; } int spa_alsa_pause(struct state *state) { int err; if (!state->started) return 0; spa_log_debug(state->log, "%p: pause", state); spa_loop_invoke(state->data_loop, do_remove_source, 0, NULL, 0, true, state); if ((err = snd_pcm_drop(state->hndl)) < 0) spa_log_error(state->log, "%s: snd_pcm_drop %s", state->props.device, snd_strerror(err)); state->started = false; return 0; }