| /* |
| * VIRTIO Sound Device conforming to |
| * |
| * "Virtual I/O Device (VIRTIO) Version 1.2 |
| * Committee Specification Draft 01 |
| * 09 May 2022" |
| * |
| * <https://docs.oasis-open.org/virtio/virtio/v1.2/csd01/virtio-v1.2-csd01.html#x1-52900014> |
| * |
| * Copyright (c) 2023 Emmanouil Pitsidianakis <manos.pitsidianakis@linaro.org> |
| * Copyright (C) 2019 OpenSynergy GmbH |
| * |
| * This work is licensed under the terms of the GNU GPL, version 2 or |
| * (at your option) any later version. See the COPYING file in the |
| * top-level directory. |
| */ |
| |
| #include "qemu/osdep.h" |
| #include "qemu/iov.h" |
| #include "qemu/log.h" |
| #include "qemu/error-report.h" |
| #include "include/qemu/lockable.h" |
| #include "sysemu/runstate.h" |
| #include "trace.h" |
| #include "qapi/error.h" |
| #include "hw/audio/virtio-snd.h" |
| #include "hw/core/cpu.h" |
| |
| #define VIRTIO_SOUND_VM_VERSION 1 |
| #define VIRTIO_SOUND_JACK_DEFAULT 0 |
| #define VIRTIO_SOUND_STREAM_DEFAULT 2 |
| #define VIRTIO_SOUND_CHMAP_DEFAULT 0 |
| #define VIRTIO_SOUND_HDA_FN_NID 0 |
| |
| static void virtio_snd_pcm_out_cb(void *data, int available); |
| static void virtio_snd_process_cmdq(VirtIOSound *s); |
| static void virtio_snd_pcm_flush(VirtIOSoundPCMStream *stream); |
| static void virtio_snd_pcm_in_cb(void *data, int available); |
| |
| static uint32_t supported_formats = BIT(VIRTIO_SND_PCM_FMT_S8) |
| | BIT(VIRTIO_SND_PCM_FMT_U8) |
| | BIT(VIRTIO_SND_PCM_FMT_S16) |
| | BIT(VIRTIO_SND_PCM_FMT_U16) |
| | BIT(VIRTIO_SND_PCM_FMT_S32) |
| | BIT(VIRTIO_SND_PCM_FMT_U32) |
| | BIT(VIRTIO_SND_PCM_FMT_FLOAT); |
| |
| static uint32_t supported_rates = BIT(VIRTIO_SND_PCM_RATE_5512) |
| | BIT(VIRTIO_SND_PCM_RATE_8000) |
| | BIT(VIRTIO_SND_PCM_RATE_11025) |
| | BIT(VIRTIO_SND_PCM_RATE_16000) |
| | BIT(VIRTIO_SND_PCM_RATE_22050) |
| | BIT(VIRTIO_SND_PCM_RATE_32000) |
| | BIT(VIRTIO_SND_PCM_RATE_44100) |
| | BIT(VIRTIO_SND_PCM_RATE_48000) |
| | BIT(VIRTIO_SND_PCM_RATE_64000) |
| | BIT(VIRTIO_SND_PCM_RATE_88200) |
| | BIT(VIRTIO_SND_PCM_RATE_96000) |
| | BIT(VIRTIO_SND_PCM_RATE_176400) |
| | BIT(VIRTIO_SND_PCM_RATE_192000) |
| | BIT(VIRTIO_SND_PCM_RATE_384000); |
| |
| static const VMStateDescription vmstate_virtio_snd_device = { |
| .name = TYPE_VIRTIO_SND, |
| .version_id = VIRTIO_SOUND_VM_VERSION, |
| .minimum_version_id = VIRTIO_SOUND_VM_VERSION, |
| }; |
| |
| static const VMStateDescription vmstate_virtio_snd = { |
| .name = TYPE_VIRTIO_SND, |
| .minimum_version_id = VIRTIO_SOUND_VM_VERSION, |
| .version_id = VIRTIO_SOUND_VM_VERSION, |
| .fields = (VMStateField[]) { |
| VMSTATE_VIRTIO_DEVICE, |
| VMSTATE_END_OF_LIST() |
| }, |
| }; |
| |
| static Property virtio_snd_properties[] = { |
| DEFINE_AUDIO_PROPERTIES(VirtIOSound, card), |
| DEFINE_PROP_UINT32("jacks", VirtIOSound, snd_conf.jacks, |
| VIRTIO_SOUND_JACK_DEFAULT), |
| DEFINE_PROP_UINT32("streams", VirtIOSound, snd_conf.streams, |
| VIRTIO_SOUND_STREAM_DEFAULT), |
| DEFINE_PROP_UINT32("chmaps", VirtIOSound, snd_conf.chmaps, |
| VIRTIO_SOUND_CHMAP_DEFAULT), |
| DEFINE_PROP_END_OF_LIST(), |
| }; |
| |
| static void |
| virtio_snd_get_config(VirtIODevice *vdev, uint8_t *config) |
| { |
| VirtIOSound *s = VIRTIO_SND(vdev); |
| virtio_snd_config *sndconfig = |
| (virtio_snd_config *)config; |
| trace_virtio_snd_get_config(vdev, |
| s->snd_conf.jacks, |
| s->snd_conf.streams, |
| s->snd_conf.chmaps); |
| |
| memcpy(sndconfig, &s->snd_conf, sizeof(s->snd_conf)); |
| cpu_to_le32s(&sndconfig->jacks); |
| cpu_to_le32s(&sndconfig->streams); |
| cpu_to_le32s(&sndconfig->chmaps); |
| |
| } |
| |
| static void |
| virtio_snd_set_config(VirtIODevice *vdev, const uint8_t *config) |
| { |
| VirtIOSound *s = VIRTIO_SND(vdev); |
| const virtio_snd_config *sndconfig = |
| (const virtio_snd_config *)config; |
| |
| |
| trace_virtio_snd_set_config(vdev, |
| s->snd_conf.jacks, |
| sndconfig->jacks, |
| s->snd_conf.streams, |
| sndconfig->streams, |
| s->snd_conf.chmaps, |
| sndconfig->chmaps); |
| |
| memcpy(&s->snd_conf, sndconfig, sizeof(virtio_snd_config)); |
| le32_to_cpus(&s->snd_conf.jacks); |
| le32_to_cpus(&s->snd_conf.streams); |
| le32_to_cpus(&s->snd_conf.chmaps); |
| |
| } |
| |
| static void |
| virtio_snd_pcm_buffer_free(VirtIOSoundPCMBuffer *buffer) |
| { |
| g_free(buffer->elem); |
| g_free(buffer); |
| } |
| |
| static void |
| virtio_snd_ctrl_cmd_free(virtio_snd_ctrl_command *cmd) |
| { |
| g_free(cmd->elem); |
| g_free(cmd); |
| } |
| |
| /* |
| * Get a specific stream from the virtio sound card device. |
| * Returns NULL if @stream_id is invalid or not allocated. |
| * |
| * @s: VirtIOSound device |
| * @stream_id: stream id |
| */ |
| static VirtIOSoundPCMStream *virtio_snd_pcm_get_stream(VirtIOSound *s, |
| uint32_t stream_id) |
| { |
| return stream_id >= s->snd_conf.streams ? NULL : |
| s->pcm->streams[stream_id]; |
| } |
| |
| /* |
| * Get params for a specific stream. |
| * |
| * @s: VirtIOSound device |
| * @stream_id: stream id |
| */ |
| static virtio_snd_pcm_set_params *virtio_snd_pcm_get_params(VirtIOSound *s, |
| uint32_t stream_id) |
| { |
| return stream_id >= s->snd_conf.streams ? NULL |
| : &s->pcm->pcm_params[stream_id]; |
| } |
| |
| /* |
| * Handle the VIRTIO_SND_R_PCM_INFO request. |
| * The function writes the info structs to the request element. |
| * |
| * @s: VirtIOSound device |
| * @cmd: The request command queue element from VirtIOSound cmdq field |
| */ |
| static void virtio_snd_handle_pcm_info(VirtIOSound *s, |
| virtio_snd_ctrl_command *cmd) |
| { |
| uint32_t stream_id, start_id, count, size; |
| virtio_snd_pcm_info val; |
| virtio_snd_query_info req; |
| VirtIOSoundPCMStream *stream = NULL; |
| g_autofree virtio_snd_pcm_info *pcm_info = NULL; |
| size_t msg_sz = iov_to_buf(cmd->elem->out_sg, |
| cmd->elem->out_num, |
| 0, |
| &req, |
| sizeof(virtio_snd_query_info)); |
| |
| if (msg_sz != sizeof(virtio_snd_query_info)) { |
| /* |
| * TODO: do we need to set DEVICE_NEEDS_RESET? |
| */ |
| qemu_log_mask(LOG_GUEST_ERROR, |
| "%s: virtio-snd command size incorrect %zu vs \ |
| %zu\n", __func__, msg_sz, sizeof(virtio_snd_query_info)); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| |
| start_id = le32_to_cpu(req.start_id); |
| count = le32_to_cpu(req.count); |
| size = le32_to_cpu(req.size); |
| |
| if (iov_size(cmd->elem->in_sg, cmd->elem->in_num) < |
| sizeof(virtio_snd_hdr) + size * count) { |
| /* |
| * TODO: do we need to set DEVICE_NEEDS_RESET? |
| */ |
| error_report("pcm info: buffer too small, got: %zu, needed: %zu", |
| iov_size(cmd->elem->in_sg, cmd->elem->in_num), |
| sizeof(virtio_snd_pcm_info)); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| |
| pcm_info = g_new0(virtio_snd_pcm_info, count); |
| for (uint32_t i = 0; i < count; i++) { |
| stream_id = i + start_id; |
| trace_virtio_snd_handle_pcm_info(stream_id); |
| stream = virtio_snd_pcm_get_stream(s, stream_id); |
| if (!stream) { |
| error_report("Invalid stream id: %"PRIu32, stream_id); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| val = stream->info; |
| val.hdr.hda_fn_nid = cpu_to_le32(val.hdr.hda_fn_nid); |
| val.features = cpu_to_le32(val.features); |
| val.formats = cpu_to_le64(val.formats); |
| val.rates = cpu_to_le64(val.rates); |
| /* |
| * 5.14.6.6.2.1 Device Requirements: Stream Information The device MUST |
| * NOT set undefined feature, format, rate and direction values. The |
| * device MUST initialize the padding bytes to 0. |
| */ |
| pcm_info[i] = val; |
| memset(&pcm_info[i].padding, 0, 5); |
| } |
| |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_OK); |
| iov_from_buf(cmd->elem->in_sg, |
| cmd->elem->in_num, |
| sizeof(virtio_snd_hdr), |
| pcm_info, |
| sizeof(virtio_snd_pcm_info) * count); |
| } |
| |
| /* |
| * Set the given stream params. |
| * Called by both virtio_snd_handle_pcm_set_params and during device |
| * initialization. |
| * Returns the response status code. (VIRTIO_SND_S_*). |
| * |
| * @s: VirtIOSound device |
| * @params: The PCM params as defined in the virtio specification |
| */ |
| static |
| uint32_t virtio_snd_set_pcm_params(VirtIOSound *s, |
| uint32_t stream_id, |
| virtio_snd_pcm_set_params *params) |
| { |
| virtio_snd_pcm_set_params *st_params; |
| |
| if (stream_id >= s->snd_conf.streams || s->pcm->pcm_params == NULL) { |
| /* |
| * TODO: do we need to set DEVICE_NEEDS_RESET? |
| */ |
| virtio_error(VIRTIO_DEVICE(s), "Streams have not been initialized.\n"); |
| return cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| } |
| |
| st_params = virtio_snd_pcm_get_params(s, stream_id); |
| |
| if (params->channels < 1 || params->channels > AUDIO_MAX_CHANNELS) { |
| error_report("Number of channels is not supported."); |
| return cpu_to_le32(VIRTIO_SND_S_NOT_SUPP); |
| } |
| if (!(supported_formats & BIT(params->format))) { |
| error_report("Stream format is not supported."); |
| return cpu_to_le32(VIRTIO_SND_S_NOT_SUPP); |
| } |
| if (!(supported_rates & BIT(params->rate))) { |
| error_report("Stream rate is not supported."); |
| return cpu_to_le32(VIRTIO_SND_S_NOT_SUPP); |
| } |
| |
| st_params->buffer_bytes = le32_to_cpu(params->buffer_bytes); |
| st_params->period_bytes = le32_to_cpu(params->period_bytes); |
| st_params->features = le32_to_cpu(params->features); |
| /* the following are uint8_t, so there's no need to bswap the values. */ |
| st_params->channels = params->channels; |
| st_params->format = params->format; |
| st_params->rate = params->rate; |
| |
| return cpu_to_le32(VIRTIO_SND_S_OK); |
| } |
| |
| /* |
| * Handles the VIRTIO_SND_R_PCM_SET_PARAMS request. |
| * |
| * @s: VirtIOSound device |
| * @cmd: The request command queue element from VirtIOSound cmdq field |
| */ |
| static void virtio_snd_handle_pcm_set_params(VirtIOSound *s, |
| virtio_snd_ctrl_command *cmd) |
| { |
| virtio_snd_pcm_set_params req = { 0 }; |
| uint32_t stream_id; |
| size_t msg_sz = iov_to_buf(cmd->elem->out_sg, |
| cmd->elem->out_num, |
| 0, |
| &req, |
| sizeof(virtio_snd_pcm_set_params)); |
| |
| if (msg_sz != sizeof(virtio_snd_pcm_set_params)) { |
| /* |
| * TODO: do we need to set DEVICE_NEEDS_RESET? |
| */ |
| qemu_log_mask(LOG_GUEST_ERROR, |
| "%s: virtio-snd command size incorrect %zu vs \ |
| %zu\n", __func__, msg_sz, sizeof(virtio_snd_pcm_set_params)); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| stream_id = le32_to_cpu(req.hdr.stream_id); |
| trace_virtio_snd_handle_pcm_set_params(stream_id); |
| cmd->resp.code = virtio_snd_set_pcm_params(s, stream_id, &req); |
| } |
| |
| /* |
| * Get a QEMU Audiosystem compatible format value from a VIRTIO_SND_PCM_FMT_* |
| */ |
| static AudioFormat virtio_snd_get_qemu_format(uint32_t format) |
| { |
| #define CASE(FMT) \ |
| case VIRTIO_SND_PCM_FMT_##FMT: \ |
| return AUDIO_FORMAT_##FMT; |
| |
| switch (format) { |
| CASE(U8) |
| CASE(S8) |
| CASE(U16) |
| CASE(S16) |
| CASE(U32) |
| CASE(S32) |
| case VIRTIO_SND_PCM_FMT_FLOAT: |
| return AUDIO_FORMAT_F32; |
| default: |
| g_assert_not_reached(); |
| } |
| |
| #undef CASE |
| } |
| |
| /* |
| * Get a QEMU Audiosystem compatible frequency value from a |
| * VIRTIO_SND_PCM_RATE_* |
| */ |
| static uint32_t virtio_snd_get_qemu_freq(uint32_t rate) |
| { |
| #define CASE(RATE) \ |
| case VIRTIO_SND_PCM_RATE_##RATE: \ |
| return RATE; |
| |
| switch (rate) { |
| CASE(5512) |
| CASE(8000) |
| CASE(11025) |
| CASE(16000) |
| CASE(22050) |
| CASE(32000) |
| CASE(44100) |
| CASE(48000) |
| CASE(64000) |
| CASE(88200) |
| CASE(96000) |
| CASE(176400) |
| CASE(192000) |
| CASE(384000) |
| default: |
| g_assert_not_reached(); |
| } |
| |
| #undef CASE |
| } |
| |
| /* |
| * Get QEMU Audiosystem compatible audsettings from virtio based pcm stream |
| * params. |
| */ |
| static void virtio_snd_get_qemu_audsettings(audsettings *as, |
| virtio_snd_pcm_set_params *params) |
| { |
| as->nchannels = MIN(AUDIO_MAX_CHANNELS, params->channels); |
| as->fmt = virtio_snd_get_qemu_format(params->format); |
| as->freq = virtio_snd_get_qemu_freq(params->rate); |
| as->endianness = target_words_bigendian() ? 1 : 0; |
| } |
| |
| /* |
| * Close a stream and free all its resources. |
| * |
| * @stream: VirtIOSoundPCMStream *stream |
| */ |
| static void virtio_snd_pcm_close(VirtIOSoundPCMStream *stream) |
| { |
| if (stream) { |
| virtio_snd_pcm_flush(stream); |
| if (stream->info.direction == VIRTIO_SND_D_OUTPUT) { |
| AUD_close_out(&stream->pcm->snd->card, stream->voice.out); |
| stream->voice.out = NULL; |
| } else if (stream->info.direction == VIRTIO_SND_D_INPUT) { |
| AUD_close_in(&stream->pcm->snd->card, stream->voice.in); |
| stream->voice.in = NULL; |
| } |
| } |
| } |
| |
| /* |
| * Prepares a VirtIOSound card stream. |
| * Returns the response status code. (VIRTIO_SND_S_*). |
| * |
| * @s: VirtIOSound device |
| * @stream_id: stream id |
| */ |
| static uint32_t virtio_snd_pcm_prepare(VirtIOSound *s, uint32_t stream_id) |
| { |
| audsettings as; |
| virtio_snd_pcm_set_params *params; |
| VirtIOSoundPCMStream *stream; |
| |
| if (s->pcm->streams == NULL || |
| s->pcm->pcm_params == NULL || |
| stream_id >= s->snd_conf.streams) { |
| return cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| } |
| |
| params = virtio_snd_pcm_get_params(s, stream_id); |
| if (params == NULL) { |
| return cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| } |
| |
| stream = virtio_snd_pcm_get_stream(s, stream_id); |
| if (stream == NULL) { |
| stream = g_new0(VirtIOSoundPCMStream, 1); |
| stream->active = false; |
| stream->id = stream_id; |
| stream->pcm = s->pcm; |
| stream->s = s; |
| qemu_mutex_init(&stream->queue_mutex); |
| QSIMPLEQ_INIT(&stream->queue); |
| QSIMPLEQ_INIT(&stream->invalid); |
| |
| /* |
| * stream_id >= s->snd_conf.streams was checked before so this is |
| * in-bounds |
| */ |
| s->pcm->streams[stream_id] = stream; |
| } |
| |
| virtio_snd_get_qemu_audsettings(&as, params); |
| stream->info.direction = stream_id < s->snd_conf.streams / 2 + |
| (s->snd_conf.streams & 1) ? VIRTIO_SND_D_OUTPUT : VIRTIO_SND_D_INPUT; |
| stream->info.hdr.hda_fn_nid = VIRTIO_SOUND_HDA_FN_NID; |
| stream->info.features = 0; |
| stream->info.channels_min = 1; |
| stream->info.channels_max = as.nchannels; |
| stream->info.formats = supported_formats; |
| stream->info.rates = supported_rates; |
| stream->params = *params; |
| |
| stream->positions[0] = VIRTIO_SND_CHMAP_FL; |
| stream->positions[1] = VIRTIO_SND_CHMAP_FR; |
| stream->as = as; |
| |
| if (stream->info.direction == VIRTIO_SND_D_OUTPUT) { |
| stream->voice.out = AUD_open_out(&s->card, |
| stream->voice.out, |
| "virtio-sound.out", |
| stream, |
| virtio_snd_pcm_out_cb, |
| &as); |
| AUD_set_volume_out(stream->voice.out, 0, 255, 255); |
| } else { |
| stream->voice.in = AUD_open_in(&s->card, |
| stream->voice.in, |
| "virtio-sound.in", |
| stream, |
| virtio_snd_pcm_in_cb, |
| &as); |
| AUD_set_volume_in(stream->voice.in, 0, 255, 255); |
| } |
| |
| return cpu_to_le32(VIRTIO_SND_S_OK); |
| } |
| |
| static const char *print_code(uint32_t code) |
| { |
| #define CASE(CODE) \ |
| case VIRTIO_SND_R_##CODE: \ |
| return "VIRTIO_SND_R_"#CODE |
| |
| switch (code) { |
| CASE(JACK_INFO); |
| CASE(JACK_REMAP); |
| CASE(PCM_INFO); |
| CASE(PCM_SET_PARAMS); |
| CASE(PCM_PREPARE); |
| CASE(PCM_RELEASE); |
| CASE(PCM_START); |
| CASE(PCM_STOP); |
| CASE(CHMAP_INFO); |
| default: |
| return "invalid code"; |
| } |
| |
| #undef CASE |
| }; |
| |
| /* |
| * Handles VIRTIO_SND_R_PCM_PREPARE. |
| * |
| * @s: VirtIOSound device |
| * @cmd: The request command queue element from VirtIOSound cmdq field |
| */ |
| static void virtio_snd_handle_pcm_prepare(VirtIOSound *s, |
| virtio_snd_ctrl_command *cmd) |
| { |
| uint32_t stream_id; |
| size_t msg_sz = iov_to_buf(cmd->elem->out_sg, |
| cmd->elem->out_num, |
| sizeof(virtio_snd_hdr), |
| &stream_id, |
| sizeof(stream_id)); |
| |
| stream_id = le32_to_cpu(stream_id); |
| cmd->resp.code = msg_sz == sizeof(stream_id) |
| ? virtio_snd_pcm_prepare(s, stream_id) |
| : cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| } |
| |
| /* |
| * Handles VIRTIO_SND_R_PCM_START. |
| * |
| * @s: VirtIOSound device |
| * @cmd: The request command queue element from VirtIOSound cmdq field |
| * @start: whether to start or stop the device |
| */ |
| static void virtio_snd_handle_pcm_start_stop(VirtIOSound *s, |
| virtio_snd_ctrl_command *cmd, |
| bool start) |
| { |
| VirtIOSoundPCMStream *stream; |
| virtio_snd_pcm_hdr req; |
| uint32_t stream_id; |
| size_t msg_sz = iov_to_buf(cmd->elem->out_sg, |
| cmd->elem->out_num, |
| 0, |
| &req, |
| sizeof(virtio_snd_pcm_hdr)); |
| |
| if (msg_sz != sizeof(virtio_snd_pcm_hdr)) { |
| qemu_log_mask(LOG_GUEST_ERROR, |
| "%s: virtio-snd command size incorrect %zu vs \ |
| %zu\n", __func__, msg_sz, sizeof(virtio_snd_pcm_hdr)); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| |
| stream_id = le32_to_cpu(req.stream_id); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_OK); |
| trace_virtio_snd_handle_pcm_start_stop(start ? "VIRTIO_SND_R_PCM_START" : |
| "VIRTIO_SND_R_PCM_STOP", stream_id); |
| |
| stream = virtio_snd_pcm_get_stream(s, stream_id); |
| if (stream) { |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| stream->active = start; |
| } |
| if (stream->info.direction == VIRTIO_SND_D_OUTPUT) { |
| AUD_set_active_out(stream->voice.out, start); |
| } else { |
| AUD_set_active_in(stream->voice.in, start); |
| } |
| } else { |
| error_report("Invalid stream id: %"PRIu32, stream_id); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| stream->active = start; |
| } |
| |
| /* |
| * Returns the number of I/O messages that are being processed. |
| * |
| * @stream: VirtIOSoundPCMStream |
| */ |
| static size_t virtio_snd_pcm_get_io_msgs_count(VirtIOSoundPCMStream *stream) |
| { |
| VirtIOSoundPCMBuffer *buffer, *next; |
| size_t count = 0; |
| |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| QSIMPLEQ_FOREACH_SAFE(buffer, &stream->queue, entry, next) { |
| count += 1; |
| } |
| QSIMPLEQ_FOREACH_SAFE(buffer, &stream->invalid, entry, next) { |
| count += 1; |
| } |
| } |
| return count; |
| } |
| |
| /* |
| * Handles VIRTIO_SND_R_PCM_RELEASE. |
| * |
| * @s: VirtIOSound device |
| * @cmd: The request command queue element from VirtIOSound cmdq field |
| */ |
| static void virtio_snd_handle_pcm_release(VirtIOSound *s, |
| virtio_snd_ctrl_command *cmd) |
| { |
| uint32_t stream_id; |
| VirtIOSoundPCMStream *stream; |
| size_t msg_sz = iov_to_buf(cmd->elem->out_sg, |
| cmd->elem->out_num, |
| sizeof(virtio_snd_hdr), |
| &stream_id, |
| sizeof(stream_id)); |
| |
| if (msg_sz != sizeof(stream_id)) { |
| /* |
| * TODO: do we need to set DEVICE_NEEDS_RESET? |
| */ |
| qemu_log_mask(LOG_GUEST_ERROR, |
| "%s: virtio-snd command size incorrect %zu vs \ |
| %zu\n", __func__, msg_sz, sizeof(stream_id)); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| |
| stream_id = le32_to_cpu(stream_id); |
| trace_virtio_snd_handle_pcm_release(stream_id); |
| stream = virtio_snd_pcm_get_stream(s, stream_id); |
| if (stream == NULL) { |
| /* |
| * TODO: do we need to set DEVICE_NEEDS_RESET? |
| */ |
| error_report("already released stream %"PRIu32, stream_id); |
| virtio_error(VIRTIO_DEVICE(s), |
| "already released stream %"PRIu32, |
| stream_id); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| return; |
| } |
| |
| if (virtio_snd_pcm_get_io_msgs_count(stream)) { |
| /* |
| * virtio-v1.2-csd01, 5.14.6.6.5.1, |
| * Device Requirements: Stream Release |
| * |
| * - The device MUST complete all pending I/O messages for the |
| * specified stream ID. |
| * - The device MUST NOT complete the control request while there |
| * are pending I/O messages for the specified stream ID. |
| */ |
| trace_virtio_snd_pcm_stream_flush(stream_id); |
| virtio_snd_pcm_flush(stream); |
| } |
| |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_OK); |
| } |
| |
| /* |
| * The actual processing done in virtio_snd_process_cmdq(). |
| * |
| * @s: VirtIOSound device |
| * @cmd: control command request |
| */ |
| static inline void |
| process_cmd(VirtIOSound *s, virtio_snd_ctrl_command *cmd) |
| { |
| uint32_t code; |
| size_t msg_sz = iov_to_buf(cmd->elem->out_sg, |
| cmd->elem->out_num, |
| 0, |
| &cmd->ctrl, |
| sizeof(virtio_snd_hdr)); |
| |
| if (msg_sz != sizeof(virtio_snd_hdr)) { |
| /* |
| * TODO: do we need to set DEVICE_NEEDS_RESET? |
| */ |
| qemu_log_mask(LOG_GUEST_ERROR, |
| "%s: virtio-snd command size incorrect %zu vs \ |
| %zu\n", __func__, msg_sz, sizeof(virtio_snd_hdr)); |
| return; |
| } |
| |
| code = le32_to_cpu(cmd->ctrl.code); |
| |
| trace_virtio_snd_handle_code(code, print_code(code)); |
| |
| switch (code) { |
| case VIRTIO_SND_R_JACK_INFO: |
| case VIRTIO_SND_R_JACK_REMAP: |
| qemu_log_mask(LOG_UNIMP, |
| "virtio_snd: jack functionality is unimplemented.\n"); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_NOT_SUPP); |
| break; |
| case VIRTIO_SND_R_PCM_INFO: |
| virtio_snd_handle_pcm_info(s, cmd); |
| break; |
| case VIRTIO_SND_R_PCM_START: |
| virtio_snd_handle_pcm_start_stop(s, cmd, true); |
| break; |
| case VIRTIO_SND_R_PCM_STOP: |
| virtio_snd_handle_pcm_start_stop(s, cmd, false); |
| break; |
| case VIRTIO_SND_R_PCM_SET_PARAMS: |
| virtio_snd_handle_pcm_set_params(s, cmd); |
| break; |
| case VIRTIO_SND_R_PCM_PREPARE: |
| virtio_snd_handle_pcm_prepare(s, cmd); |
| break; |
| case VIRTIO_SND_R_PCM_RELEASE: |
| virtio_snd_handle_pcm_release(s, cmd); |
| break; |
| case VIRTIO_SND_R_CHMAP_INFO: |
| qemu_log_mask(LOG_UNIMP, |
| "virtio_snd: chmap info functionality is unimplemented.\n"); |
| trace_virtio_snd_handle_chmap_info(); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_NOT_SUPP); |
| break; |
| default: |
| /* error */ |
| error_report("virtio snd header not recognized: %"PRIu32, code); |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| } |
| |
| iov_from_buf(cmd->elem->in_sg, |
| cmd->elem->in_num, |
| 0, |
| &cmd->resp, |
| sizeof(virtio_snd_hdr)); |
| virtqueue_push(cmd->vq, cmd->elem, sizeof(virtio_snd_hdr)); |
| virtio_notify(VIRTIO_DEVICE(s), cmd->vq); |
| } |
| |
| /* |
| * Consume all elements in command queue. |
| * |
| * @s: VirtIOSound device |
| */ |
| static void virtio_snd_process_cmdq(VirtIOSound *s) |
| { |
| virtio_snd_ctrl_command *cmd; |
| |
| if (unlikely(qatomic_read(&s->processing_cmdq))) { |
| return; |
| } |
| |
| WITH_QEMU_LOCK_GUARD(&s->cmdq_mutex) { |
| qatomic_set(&s->processing_cmdq, true); |
| while (!QTAILQ_EMPTY(&s->cmdq)) { |
| cmd = QTAILQ_FIRST(&s->cmdq); |
| |
| /* process command */ |
| process_cmd(s, cmd); |
| |
| QTAILQ_REMOVE(&s->cmdq, cmd, next); |
| |
| virtio_snd_ctrl_cmd_free(cmd); |
| } |
| qatomic_set(&s->processing_cmdq, false); |
| } |
| } |
| |
| /* |
| * The control message handler. Pops an element from the control virtqueue, |
| * and stores them to VirtIOSound's cmdq queue and finally calls |
| * virtio_snd_process_cmdq() for processing. |
| * |
| * @vdev: VirtIOSound device |
| * @vq: Control virtqueue |
| */ |
| static void virtio_snd_handle_ctrl(VirtIODevice *vdev, VirtQueue *vq) |
| { |
| VirtIOSound *s = VIRTIO_SND(vdev); |
| VirtQueueElement *elem; |
| virtio_snd_ctrl_command *cmd; |
| |
| trace_virtio_snd_handle_ctrl(vdev, vq); |
| |
| if (!virtio_queue_ready(vq)) { |
| return; |
| } |
| |
| elem = virtqueue_pop(vq, sizeof(VirtQueueElement)); |
| while (elem) { |
| cmd = g_new0(virtio_snd_ctrl_command, 1); |
| cmd->elem = elem; |
| cmd->vq = vq; |
| cmd->resp.code = cpu_to_le32(VIRTIO_SND_S_OK); |
| QTAILQ_INSERT_TAIL(&s->cmdq, cmd, next); |
| elem = virtqueue_pop(vq, sizeof(VirtQueueElement)); |
| } |
| |
| virtio_snd_process_cmdq(s); |
| } |
| |
| /* |
| * The event virtqueue handler. |
| * Not implemented yet. |
| * |
| * @vdev: VirtIOSound device |
| * @vq: event vq |
| */ |
| static void virtio_snd_handle_event(VirtIODevice *vdev, VirtQueue *vq) |
| { |
| qemu_log_mask(LOG_UNIMP, "virtio_snd: event queue is unimplemented.\n"); |
| trace_virtio_snd_handle_event(); |
| } |
| |
| static inline void empty_invalid_queue(VirtIODevice *vdev, VirtQueue *vq) |
| { |
| VirtIOSoundPCMBuffer *buffer = NULL; |
| VirtIOSoundPCMStream *stream = NULL; |
| virtio_snd_pcm_status resp = { 0 }; |
| VirtIOSound *vsnd = VIRTIO_SND(vdev); |
| bool any = false; |
| |
| for (uint32_t i = 0; i < vsnd->snd_conf.streams; i++) { |
| stream = vsnd->pcm->streams[i]; |
| if (stream) { |
| any = false; |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| while (!QSIMPLEQ_EMPTY(&stream->invalid)) { |
| buffer = QSIMPLEQ_FIRST(&stream->invalid); |
| if (buffer->vq != vq) { |
| break; |
| } |
| any = true; |
| resp.status = cpu_to_le32(VIRTIO_SND_S_BAD_MSG); |
| iov_from_buf(buffer->elem->in_sg, |
| buffer->elem->in_num, |
| 0, |
| &resp, |
| sizeof(virtio_snd_pcm_status)); |
| virtqueue_push(vq, |
| buffer->elem, |
| sizeof(virtio_snd_pcm_status)); |
| QSIMPLEQ_REMOVE_HEAD(&stream->invalid, entry); |
| virtio_snd_pcm_buffer_free(buffer); |
| } |
| if (any) { |
| /* |
| * Notify vq about virtio_snd_pcm_status responses. |
| * Buffer responses must be notified separately later. |
| */ |
| virtio_notify(vdev, vq); |
| } |
| } |
| } |
| } |
| } |
| |
| /* |
| * The tx virtqueue handler. Makes the buffers available to their respective |
| * streams for consumption. |
| * |
| * @vdev: VirtIOSound device |
| * @vq: tx virtqueue |
| */ |
| static void virtio_snd_handle_tx_xfer(VirtIODevice *vdev, VirtQueue *vq) |
| { |
| VirtIOSound *s = VIRTIO_SND(vdev); |
| VirtIOSoundPCMStream *stream = NULL; |
| VirtIOSoundPCMBuffer *buffer; |
| VirtQueueElement *elem; |
| size_t msg_sz, size; |
| virtio_snd_pcm_xfer hdr; |
| uint32_t stream_id; |
| /* |
| * If any of the I/O messages are invalid, put them in stream->invalid and |
| * return them after the for loop. |
| */ |
| bool must_empty_invalid_queue = false; |
| |
| if (!virtio_queue_ready(vq)) { |
| return; |
| } |
| trace_virtio_snd_handle_tx_xfer(); |
| |
| for (;;) { |
| elem = virtqueue_pop(vq, sizeof(VirtQueueElement)); |
| if (!elem) { |
| break; |
| } |
| /* get the message hdr object */ |
| msg_sz = iov_to_buf(elem->out_sg, |
| elem->out_num, |
| 0, |
| &hdr, |
| sizeof(virtio_snd_pcm_xfer)); |
| if (msg_sz != sizeof(virtio_snd_pcm_xfer)) { |
| goto tx_err; |
| } |
| stream_id = le32_to_cpu(hdr.stream_id); |
| |
| if (stream_id >= s->snd_conf.streams |
| || s->pcm->streams[stream_id] == NULL) { |
| goto tx_err; |
| } |
| |
| stream = s->pcm->streams[stream_id]; |
| if (stream->info.direction != VIRTIO_SND_D_OUTPUT) { |
| goto tx_err; |
| } |
| |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| size = iov_size(elem->out_sg, elem->out_num) - msg_sz; |
| |
| buffer = g_malloc0(sizeof(VirtIOSoundPCMBuffer) + size); |
| buffer->elem = elem; |
| buffer->populated = false; |
| buffer->vq = vq; |
| buffer->size = size; |
| buffer->offset = 0; |
| |
| QSIMPLEQ_INSERT_TAIL(&stream->queue, buffer, entry); |
| } |
| continue; |
| |
| tx_err: |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| must_empty_invalid_queue = true; |
| buffer = g_malloc0(sizeof(VirtIOSoundPCMBuffer)); |
| buffer->elem = elem; |
| buffer->vq = vq; |
| QSIMPLEQ_INSERT_TAIL(&stream->invalid, buffer, entry); |
| } |
| } |
| |
| if (must_empty_invalid_queue) { |
| empty_invalid_queue(vdev, vq); |
| } |
| } |
| |
| /* |
| * The rx virtqueue handler. Makes the buffers available to their respective |
| * streams for consumption. |
| * |
| * @vdev: VirtIOSound device |
| * @vq: rx virtqueue |
| */ |
| static void virtio_snd_handle_rx_xfer(VirtIODevice *vdev, VirtQueue *vq) |
| { |
| VirtIOSound *s = VIRTIO_SND(vdev); |
| VirtIOSoundPCMStream *stream = NULL; |
| VirtIOSoundPCMBuffer *buffer; |
| VirtQueueElement *elem; |
| size_t msg_sz, size; |
| virtio_snd_pcm_xfer hdr; |
| uint32_t stream_id; |
| /* |
| * if any of the I/O messages are invalid, put them in stream->invalid and |
| * return them after the for loop. |
| */ |
| bool must_empty_invalid_queue = false; |
| |
| if (!virtio_queue_ready(vq)) { |
| return; |
| } |
| trace_virtio_snd_handle_rx_xfer(); |
| |
| for (;;) { |
| elem = virtqueue_pop(vq, sizeof(VirtQueueElement)); |
| if (!elem) { |
| break; |
| } |
| /* get the message hdr object */ |
| msg_sz = iov_to_buf(elem->out_sg, |
| elem->out_num, |
| 0, |
| &hdr, |
| sizeof(virtio_snd_pcm_xfer)); |
| if (msg_sz != sizeof(virtio_snd_pcm_xfer)) { |
| goto rx_err; |
| } |
| stream_id = le32_to_cpu(hdr.stream_id); |
| |
| if (stream_id >= s->snd_conf.streams |
| || !s->pcm->streams[stream_id]) { |
| goto rx_err; |
| } |
| |
| stream = s->pcm->streams[stream_id]; |
| if (stream == NULL || stream->info.direction != VIRTIO_SND_D_INPUT) { |
| goto rx_err; |
| } |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| size = iov_size(elem->in_sg, elem->in_num) - |
| sizeof(virtio_snd_pcm_status); |
| buffer = g_malloc0(sizeof(VirtIOSoundPCMBuffer) + size); |
| buffer->elem = elem; |
| buffer->vq = vq; |
| buffer->size = 0; |
| buffer->offset = 0; |
| QSIMPLEQ_INSERT_TAIL(&stream->queue, buffer, entry); |
| } |
| continue; |
| |
| rx_err: |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| must_empty_invalid_queue = true; |
| buffer = g_malloc0(sizeof(VirtIOSoundPCMBuffer)); |
| buffer->elem = elem; |
| buffer->vq = vq; |
| QSIMPLEQ_INSERT_TAIL(&stream->invalid, buffer, entry); |
| } |
| } |
| |
| if (must_empty_invalid_queue) { |
| empty_invalid_queue(vdev, vq); |
| } |
| } |
| |
| static uint64_t get_features(VirtIODevice *vdev, uint64_t features, |
| Error **errp) |
| { |
| /* |
| * virtio-v1.2-csd01, 5.14.3, |
| * Feature Bits |
| * None currently defined. |
| */ |
| VirtIOSound *s = VIRTIO_SND(vdev); |
| features |= s->features; |
| |
| trace_virtio_snd_get_features(vdev, features); |
| |
| return features; |
| } |
| |
| static void |
| virtio_snd_vm_state_change(void *opaque, bool running, |
| RunState state) |
| { |
| if (running) { |
| trace_virtio_snd_vm_state_running(); |
| } else { |
| trace_virtio_snd_vm_state_stopped(); |
| } |
| } |
| |
| static void virtio_snd_realize(DeviceState *dev, Error **errp) |
| { |
| ERRP_GUARD(); |
| VirtIOSound *vsnd = VIRTIO_SND(dev); |
| VirtIODevice *vdev = VIRTIO_DEVICE(dev); |
| virtio_snd_pcm_set_params default_params = { 0 }; |
| uint32_t status; |
| |
| vsnd->pcm = NULL; |
| vsnd->vmstate = |
| qemu_add_vm_change_state_handler(virtio_snd_vm_state_change, vsnd); |
| |
| trace_virtio_snd_realize(vsnd); |
| |
| vsnd->pcm = g_new0(VirtIOSoundPCM, 1); |
| vsnd->pcm->snd = vsnd; |
| vsnd->pcm->streams = |
| g_new0(VirtIOSoundPCMStream *, vsnd->snd_conf.streams); |
| vsnd->pcm->pcm_params = |
| g_new0(virtio_snd_pcm_set_params, vsnd->snd_conf.streams); |
| |
| virtio_init(vdev, VIRTIO_ID_SOUND, sizeof(virtio_snd_config)); |
| virtio_add_feature(&vsnd->features, VIRTIO_F_VERSION_1); |
| |
| /* set number of jacks and streams */ |
| if (vsnd->snd_conf.jacks > 8) { |
| error_setg(errp, |
| "Invalid number of jacks: %"PRIu32, |
| vsnd->snd_conf.jacks); |
| return; |
| } |
| if (vsnd->snd_conf.streams < 1 || vsnd->snd_conf.streams > 10) { |
| error_setg(errp, |
| "Invalid number of streams: %"PRIu32, |
| vsnd->snd_conf.streams); |
| return; |
| } |
| |
| if (vsnd->snd_conf.chmaps > VIRTIO_SND_CHMAP_MAX_SIZE) { |
| error_setg(errp, |
| "Invalid number of channel maps: %"PRIu32, |
| vsnd->snd_conf.chmaps); |
| return; |
| } |
| |
| AUD_register_card("virtio-sound", &vsnd->card, errp); |
| |
| /* set default params for all streams */ |
| default_params.features = 0; |
| default_params.buffer_bytes = cpu_to_le32(8192); |
| default_params.period_bytes = cpu_to_le32(2048); |
| default_params.channels = 2; |
| default_params.format = VIRTIO_SND_PCM_FMT_S16; |
| default_params.rate = VIRTIO_SND_PCM_RATE_48000; |
| vsnd->queues[VIRTIO_SND_VQ_CONTROL] = |
| virtio_add_queue(vdev, 64, virtio_snd_handle_ctrl); |
| vsnd->queues[VIRTIO_SND_VQ_EVENT] = |
| virtio_add_queue(vdev, 64, virtio_snd_handle_event); |
| vsnd->queues[VIRTIO_SND_VQ_TX] = |
| virtio_add_queue(vdev, 64, virtio_snd_handle_tx_xfer); |
| vsnd->queues[VIRTIO_SND_VQ_RX] = |
| virtio_add_queue(vdev, 64, virtio_snd_handle_rx_xfer); |
| qemu_mutex_init(&vsnd->cmdq_mutex); |
| QTAILQ_INIT(&vsnd->cmdq); |
| |
| for (uint32_t i = 0; i < vsnd->snd_conf.streams; i++) { |
| status = virtio_snd_set_pcm_params(vsnd, i, &default_params); |
| if (status != cpu_to_le32(VIRTIO_SND_S_OK)) { |
| error_setg(errp, |
| "Can't initialize stream params, device responded with %s.", |
| print_code(status)); |
| return; |
| } |
| status = virtio_snd_pcm_prepare(vsnd, i); |
| if (status != cpu_to_le32(VIRTIO_SND_S_OK)) { |
| error_setg(errp, |
| "Can't prepare streams, device responded with %s.", |
| print_code(status)); |
| return; |
| } |
| } |
| } |
| |
| static inline void return_tx_buffer(VirtIOSoundPCMStream *stream, |
| VirtIOSoundPCMBuffer *buffer) |
| { |
| virtio_snd_pcm_status resp = { 0 }; |
| resp.status = cpu_to_le32(VIRTIO_SND_S_OK); |
| resp.latency_bytes = cpu_to_le32((uint32_t)buffer->size); |
| iov_from_buf(buffer->elem->in_sg, |
| buffer->elem->in_num, |
| 0, |
| &resp, |
| sizeof(virtio_snd_pcm_status)); |
| virtqueue_push(buffer->vq, |
| buffer->elem, |
| sizeof(virtio_snd_pcm_status)); |
| virtio_notify(VIRTIO_DEVICE(stream->s), buffer->vq); |
| QSIMPLEQ_REMOVE(&stream->queue, |
| buffer, |
| VirtIOSoundPCMBuffer, |
| entry); |
| virtio_snd_pcm_buffer_free(buffer); |
| } |
| |
| /* |
| * AUD_* output callback. |
| * |
| * @data: VirtIOSoundPCMStream stream |
| * @available: number of bytes that can be written with AUD_write() |
| */ |
| static void virtio_snd_pcm_out_cb(void *data, int available) |
| { |
| VirtIOSoundPCMStream *stream = data; |
| VirtIOSoundPCMBuffer *buffer; |
| size_t size; |
| |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| while (!QSIMPLEQ_EMPTY(&stream->queue)) { |
| buffer = QSIMPLEQ_FIRST(&stream->queue); |
| if (!virtio_queue_ready(buffer->vq)) { |
| return; |
| } |
| if (!stream->active) { |
| /* Stream has stopped, so do not perform AUD_write. */ |
| return_tx_buffer(stream, buffer); |
| continue; |
| } |
| if (!buffer->populated) { |
| iov_to_buf(buffer->elem->out_sg, |
| buffer->elem->out_num, |
| sizeof(virtio_snd_pcm_xfer), |
| buffer->data, |
| buffer->size); |
| buffer->populated = true; |
| } |
| for (;;) { |
| size = AUD_write(stream->voice.out, |
| buffer->data + buffer->offset, |
| MIN(buffer->size, available)); |
| assert(size <= MIN(buffer->size, available)); |
| if (size == 0) { |
| /* break out of both loops */ |
| available = 0; |
| break; |
| } |
| buffer->size -= size; |
| buffer->offset += size; |
| available -= size; |
| if (buffer->size < 1) { |
| return_tx_buffer(stream, buffer); |
| break; |
| } |
| if (!available) { |
| break; |
| } |
| } |
| if (!available) { |
| break; |
| } |
| } |
| } |
| } |
| |
| /* |
| * Flush all buffer data from this input stream's queue into the driver's |
| * virtual queue. |
| * |
| * @stream: VirtIOSoundPCMStream *stream |
| */ |
| static inline void return_rx_buffer(VirtIOSoundPCMStream *stream, |
| VirtIOSoundPCMBuffer *buffer) |
| { |
| virtio_snd_pcm_status resp = { 0 }; |
| resp.status = cpu_to_le32(VIRTIO_SND_S_OK); |
| resp.latency_bytes = 0; |
| /* Copy data -if any- to guest */ |
| iov_from_buf(buffer->elem->in_sg, |
| buffer->elem->in_num, |
| 0, |
| buffer->data, |
| buffer->size); |
| iov_from_buf(buffer->elem->in_sg, |
| buffer->elem->in_num, |
| buffer->size, |
| &resp, |
| sizeof(virtio_snd_pcm_status)); |
| virtqueue_push(buffer->vq, |
| buffer->elem, |
| sizeof(virtio_snd_pcm_status) + buffer->size); |
| virtio_notify(VIRTIO_DEVICE(stream->s), buffer->vq); |
| QSIMPLEQ_REMOVE(&stream->queue, |
| buffer, |
| VirtIOSoundPCMBuffer, |
| entry); |
| virtio_snd_pcm_buffer_free(buffer); |
| } |
| |
| |
| /* |
| * AUD_* input callback. |
| * |
| * @data: VirtIOSoundPCMStream stream |
| * @available: number of bytes that can be read with AUD_read() |
| */ |
| static void virtio_snd_pcm_in_cb(void *data, int available) |
| { |
| VirtIOSoundPCMStream *stream = data; |
| VirtIOSoundPCMBuffer *buffer; |
| size_t size; |
| |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| while (!QSIMPLEQ_EMPTY(&stream->queue)) { |
| buffer = QSIMPLEQ_FIRST(&stream->queue); |
| if (!virtio_queue_ready(buffer->vq)) { |
| return; |
| } |
| if (!stream->active) { |
| /* Stream has stopped, so do not perform AUD_read. */ |
| return_rx_buffer(stream, buffer); |
| continue; |
| } |
| |
| for (;;) { |
| size = AUD_read(stream->voice.in, |
| buffer->data + buffer->size, |
| MIN(available, (stream->params.period_bytes - |
| buffer->size))); |
| if (!size) { |
| available = 0; |
| break; |
| } |
| buffer->size += size; |
| available -= size; |
| if (buffer->size >= stream->params.period_bytes) { |
| return_rx_buffer(stream, buffer); |
| break; |
| } |
| if (!available) { |
| break; |
| } |
| } |
| if (!available) { |
| break; |
| } |
| } |
| } |
| } |
| |
| /* |
| * Flush all buffer data from this output stream's queue into the driver's |
| * virtual queue. |
| * |
| * @stream: VirtIOSoundPCMStream *stream |
| */ |
| static inline void virtio_snd_pcm_flush(VirtIOSoundPCMStream *stream) |
| { |
| VirtIOSoundPCMBuffer *buffer; |
| void (*cb)(VirtIOSoundPCMStream *, VirtIOSoundPCMBuffer *) = |
| (stream->info.direction == VIRTIO_SND_D_OUTPUT) ? return_tx_buffer : |
| return_rx_buffer; |
| |
| WITH_QEMU_LOCK_GUARD(&stream->queue_mutex) { |
| while (!QSIMPLEQ_EMPTY(&stream->queue)) { |
| buffer = QSIMPLEQ_FIRST(&stream->queue); |
| cb(stream, buffer); |
| } |
| } |
| } |
| |
| static void virtio_snd_unrealize(DeviceState *dev) |
| { |
| VirtIODevice *vdev = VIRTIO_DEVICE(dev); |
| VirtIOSound *vsnd = VIRTIO_SND(dev); |
| VirtIOSoundPCMStream *stream; |
| |
| qemu_del_vm_change_state_handler(vsnd->vmstate); |
| trace_virtio_snd_unrealize(vsnd); |
| |
| if (vsnd->pcm) { |
| if (vsnd->pcm->streams) { |
| for (uint32_t i = 0; i < vsnd->snd_conf.streams; i++) { |
| stream = vsnd->pcm->streams[i]; |
| if (stream) { |
| virtio_snd_process_cmdq(stream->s); |
| virtio_snd_pcm_close(stream); |
| qemu_mutex_destroy(&stream->queue_mutex); |
| g_free(stream); |
| } |
| } |
| g_free(vsnd->pcm->streams); |
| } |
| g_free(vsnd->pcm->pcm_params); |
| g_free(vsnd->pcm); |
| vsnd->pcm = NULL; |
| } |
| AUD_remove_card(&vsnd->card); |
| qemu_mutex_destroy(&vsnd->cmdq_mutex); |
| virtio_delete_queue(vsnd->queues[VIRTIO_SND_VQ_CONTROL]); |
| virtio_delete_queue(vsnd->queues[VIRTIO_SND_VQ_EVENT]); |
| virtio_delete_queue(vsnd->queues[VIRTIO_SND_VQ_TX]); |
| virtio_delete_queue(vsnd->queues[VIRTIO_SND_VQ_RX]); |
| virtio_cleanup(vdev); |
| } |
| |
| |
| static void virtio_snd_reset(VirtIODevice *vdev) |
| { |
| VirtIOSound *s = VIRTIO_SND(vdev); |
| virtio_snd_ctrl_command *cmd; |
| |
| WITH_QEMU_LOCK_GUARD(&s->cmdq_mutex) { |
| while (!QTAILQ_EMPTY(&s->cmdq)) { |
| cmd = QTAILQ_FIRST(&s->cmdq); |
| QTAILQ_REMOVE(&s->cmdq, cmd, next); |
| virtio_snd_ctrl_cmd_free(cmd); |
| } |
| } |
| } |
| |
| static void virtio_snd_class_init(ObjectClass *klass, void *data) |
| { |
| DeviceClass *dc = DEVICE_CLASS(klass); |
| VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass); |
| |
| |
| set_bit(DEVICE_CATEGORY_SOUND, dc->categories); |
| device_class_set_props(dc, virtio_snd_properties); |
| |
| dc->vmsd = &vmstate_virtio_snd; |
| vdc->vmsd = &vmstate_virtio_snd_device; |
| vdc->realize = virtio_snd_realize; |
| vdc->unrealize = virtio_snd_unrealize; |
| vdc->get_config = virtio_snd_get_config; |
| vdc->set_config = virtio_snd_set_config; |
| vdc->get_features = get_features; |
| vdc->reset = virtio_snd_reset; |
| vdc->legacy_features = 0; |
| } |
| |
| static const TypeInfo virtio_snd_types[] = { |
| { |
| .name = TYPE_VIRTIO_SND, |
| .parent = TYPE_VIRTIO_DEVICE, |
| .instance_size = sizeof(VirtIOSound), |
| .class_init = virtio_snd_class_init, |
| } |
| }; |
| |
| DEFINE_TYPES(virtio_snd_types) |