/* Spi * Copyright (C) 2016 Wim Taymans * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Library General Public * License as published by the Free Software Foundation; either * version 2 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Library General Public License for more details. * * You should have received a copy of the GNU Library General Public * License along with this library; if not, write to the * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, * Boston, MA 02110-1301, USA. */ #include #include typedef struct _SpiVolume SpiVolume; typedef struct { SpiParams param; double volume; bool mute; } SpiVolumeParams; typedef struct { SpiParams param; char media_type[32]; uint32_t unset_mask; char format[16]; int32_t layout; int32_t samplerate; int32_t channels; int32_t position[16]; } SpiVolumeFormat; struct _SpiVolume { SpiNode node; SpiVolumeParams params; SpiEvent *event; SpiEvent last_event; SpiEventCallback event_cb; gpointer user_data; bool have_format; SpiVolumeFormat current_format; bool have_input; SpiBuffer *input_buffer; SpiData data; }; static const double default_volume = 1.0; static const uint32_t min_volume = 0.0; static const uint32_t max_volume = 10.0; static const bool default_mute = false; static const SpiParamRangeInfo volume_range[] = { { "min", "Minimum value", 4, &min_volume }, { "max", "Maximum value", 4, &max_volume }, { NULL, NULL, 0, NULL } }; enum { PARAM_ID_VOLUME, PARAM_ID_MUTE, }; static const SpiParamInfo param_info[] = { { PARAM_ID_VOLUME, "volume", "The Volume factor", SPI_PARAM_FLAG_READWRITE, SPI_PARAM_TYPE_DOUBLE, sizeof (double), sizeof (double), &default_volume, SPI_PARAM_RANGE_TYPE_MIN_MAX, volume_range, NULL, NULL }, { PARAM_ID_MUTE , "mute", "Mute", SPI_PARAM_FLAG_READWRITE, SPI_PARAM_TYPE_BOOL, sizeof (bool), sizeof (bool), &default_mute, SPI_PARAM_RANGE_TYPE_NONE, NULL, NULL, NULL }, }; #define CHECK_TYPE(type,expected) if (type != expected) return SPI_RESULT_WRONG_PARAM_TYPE; #define CHECK_UNSET(mask,idx) if (mask & (1 << idx)) return SPI_RESULT_PARAM_UNSET; static SpiResult get_param_info (const SpiParams *params, int idx, const SpiParamInfo **info) { if (idx < 0 || idx >= 2) return SPI_RESULT_NO_MORE_PARAM_INFO; *info = ¶m_info[idx]; return SPI_RESULT_OK; } static SpiResult set_param (SpiParams *params, int id, SpiParamType type, size_t size, const void *value) { SpiResult res = SPI_RESULT_OK; SpiVolumeParams *p = (SpiVolumeParams *) params; switch (id) { case 0: CHECK_TYPE (type, SPI_PARAM_TYPE_DOUBLE); memcpy (&p->volume, value, MIN (sizeof (double), size)); break; case 1: CHECK_TYPE (type, SPI_PARAM_TYPE_BOOL); memcpy (&p->mute, value, MIN (sizeof (bool), size)); break; default: res = SPI_RESULT_INVALID_PARAM_ID; break; } return res; } static SpiResult get_param (const SpiParams *params, int id, SpiParamType *type, size_t *size, const void **value) { SpiResult res = SPI_RESULT_OK; SpiVolumeParams *p = (SpiVolumeParams *) params; switch (id) { case 0: *type = SPI_PARAM_TYPE_DOUBLE; *value = &p->volume; *size = sizeof (double); break; case 1: *type = SPI_PARAM_TYPE_BOOL; *value = &p->mute; *size = sizeof (bool); break; default: res = SPI_RESULT_INVALID_PARAM_ID; break; } return res; } static SpiResult spi_volume_node_get_params (SpiNode *node, SpiParams **params) { static SpiVolumeParams p; SpiVolume *this = (SpiVolume *) node; memcpy (&p, &this->params, sizeof (p)); *params = &p.param; return SPI_RESULT_OK; } static SpiResult spi_volume_node_set_params (SpiNode *node, const SpiParams *params) { SpiVolume *this = (SpiVolume *) node; SpiVolumeParams *p = &this->params; SpiParamType type; size_t size; const void *value; if (params->get_param (params, 0, &type, &size, &value) == 0) { if (type != SPI_PARAM_TYPE_DOUBLE) return SPI_RESULT_WRONG_PARAM_TYPE; memcpy (&p->volume, value, MIN (size, sizeof (double))); } if (params->get_param (params, 1, &type, &size, &value) == 0) { if (type != SPI_PARAM_TYPE_BOOL) return SPI_RESULT_WRONG_PARAM_TYPE; memcpy (&p->mute, value, MIN (sizeof (bool), size)); } return SPI_RESULT_OK; } static SpiResult spi_volume_node_send_command (SpiNode *node, SpiCommand *command) { SpiVolume *this = (SpiVolume *) node; SpiResult res = SPI_RESULT_NOT_IMPLEMENTED; switch (command->type) { case SPI_COMMAND_INVALID: res = SPI_RESULT_INVALID_COMMAND; break; case SPI_COMMAND_ACTIVATE: this->last_event.type = SPI_EVENT_TYPE_ACTIVATED; this->last_event.data = NULL; this->last_event.size = 0; this->event = &this->last_event; res = SPI_RESULT_HAVE_EVENT; break; case SPI_COMMAND_DEACTIVATE: this->last_event.type = SPI_EVENT_TYPE_DEACTIVATED; this->last_event.data = NULL; this->last_event.size = 0; this->event = &this->last_event; res = SPI_RESULT_HAVE_EVENT; break; case SPI_COMMAND_START: break; case SPI_COMMAND_STOP: break; case SPI_COMMAND_FLUSH: break; case SPI_COMMAND_DRAIN: break; case SPI_COMMAND_MARKER: break; } return res; } static SpiResult spi_volume_node_get_event (SpiNode *node, SpiEvent **event) { SpiVolume *this = (SpiVolume *) node; if (this->event == NULL) return SPI_RESULT_ERROR; *event = this->event; this->event = NULL; return SPI_RESULT_OK; } static SpiResult spi_volume_node_set_event_callback (SpiNode *node, SpiEventCallback event, void *user_data) { SpiVolume *this = (SpiVolume *) node; this->event_cb = event; this->user_data = user_data; return SPI_RESULT_OK; } static SpiResult spi_volume_node_get_n_ports (SpiNode *node, int *n_input_ports, int *max_input_ports, int *n_output_ports, int *max_output_ports) { *n_input_ports = 1; *n_output_ports = 1; *max_input_ports = 1; *max_output_ports = 1; return SPI_RESULT_OK; } static SpiResult spi_volume_node_get_port_ids (SpiNode *node, int n_input_ports, int *input_ids, int n_output_ports, int *output_ids) { if (n_input_ports > 0) input_ids[0] = 0; if (n_output_ports > 0) output_ids[0] = 1; return SPI_RESULT_OK; } static SpiResult spi_volume_node_add_port (SpiNode *node, SpiDirection direction, int *port_id) { return SPI_RESULT_NOT_IMPLEMENTED; } static SpiResult spi_volume_node_remove_port (SpiNode *node, int port_id) { return SPI_RESULT_NOT_IMPLEMENTED; } static const SpiParamRangeInfo format_format_range[] = { { "S8", "S8", 2, "S8" }, { "U8", "U8", 2, "U8" }, { "S16LE", "S16LE", 5, "S16LE" }, { "S16BE", "S16BE", 5, "S16BE" }, { "U16LE", "U16LE", 5, "U16LE" }, { "U16BE", "U16BE", 5, "U16BE" }, { "S24_32LE", "S24_32LE", 8, "S24_32LE" }, { "S24_32BE", "S24_32BE", 8, "S24_32BE" }, { "U24_32LE", "U24_32LE", 8, "U24_32LE" }, { "U24_32BE", "U24_32BE", 8, "U24_32BE" }, { "S32LE", "S32LE", 5, "S32LE" }, { "S32BE", "S32BE", 5, "S32BE" }, { "U32LE", "U32LE", 5, "U32LE" }, { "U32BE", "U32BE", 5, "U32BE" }, { "S24LE", "S24LE", 5, "S24LE" }, { "S24BE", "S24BE", 5, "S24BE" }, { "U24LE", "U24LE", 5, "U24LE" }, { "U24BE", "U24BE", 5, "U24BE" }, { "S20LE", "S20LE", 5, "S20LE" }, { "S20BE", "S20BE", 5, "S20BE" }, { "U20LE", "U20LE", 5, "U20LE" }, { "U20BE", "U20BE", 5, "U20BE" }, { "S18LE", "S18LE", 5, "S18LE" }, { "S18BE", "S18BE", 5, "S18BE" }, { "U18LE", "U18LE", 5, "U18LE" }, { "U18BE", "U18BE", 5, "U18BE" }, { "F32LE", "F32LE", 5, "F32LE" }, { "F32BE", "F32BE", 5, "F32BE" }, { "F64LE", "F64LE", 5, "F64LE" }, { "F64BE", "F64BE", 5, "F64BE" }, { NULL, NULL, 0, NULL } }; static const uint32_t min_uint32 = 1; static const uint32_t max_uint32 = UINT32_MAX; static const SpiParamRangeInfo int32_range[] = { { "min", "Minimum value", 4, &min_uint32 }, { "max", "Maximum value", 4, &max_uint32 }, { NULL, NULL, 0, NULL } }; enum { SPI_PARAM_ID_INVALID, SPI_PARAM_ID_MEDIA_TYPE, SPI_PARAM_ID_FORMAT, SPI_PARAM_ID_LAYOUT, SPI_PARAM_ID_SAMPLERATE, SPI_PARAM_ID_CHANNELS, }; static const int32_t format_default_layout = 1; static const SpiParamInfo raw_format_param_info[] = { { SPI_PARAM_ID_MEDIA_TYPE, "media-type", "The media type", SPI_PARAM_FLAG_READABLE, SPI_PARAM_TYPE_STRING, 32, 12, "audio/x-raw", SPI_PARAM_RANGE_TYPE_NONE, NULL, NULL, NULL }, { SPI_PARAM_ID_FORMAT, "format", "The media format", SPI_PARAM_FLAG_READWRITE, SPI_PARAM_TYPE_STRING, 16, 0, NULL, SPI_PARAM_RANGE_TYPE_ENUM, format_format_range, NULL, NULL }, { SPI_PARAM_ID_LAYOUT, "layout", "Sample Layout", SPI_PARAM_FLAG_READABLE, SPI_PARAM_TYPE_UINT32, sizeof (uint32_t), sizeof (uint32_t), &format_default_layout, SPI_PARAM_RANGE_TYPE_NONE, NULL, NULL, NULL }, { SPI_PARAM_ID_SAMPLERATE, "rate", "Audio sample rate", SPI_PARAM_FLAG_READWRITE, SPI_PARAM_TYPE_UINT32, sizeof (uint32_t), 0, NULL, SPI_PARAM_RANGE_TYPE_MIN_MAX, int32_range, NULL, NULL }, { SPI_PARAM_ID_CHANNELS, "channels", "Audio channels", SPI_PARAM_FLAG_READWRITE, SPI_PARAM_TYPE_UINT32, sizeof (uint32_t), 0, NULL, SPI_PARAM_RANGE_TYPE_MIN_MAX, int32_range, NULL, NULL }, }; static SpiResult get_raw_format_param_info (const SpiParams *params, int idx, const SpiParamInfo **info) { if (idx < 0 || idx >= 4) return SPI_RESULT_NO_MORE_PARAM_INFO; *info = &raw_format_param_info[idx]; return SPI_RESULT_OK; } #define CHECK_TYPE(type,expected) if (type != expected) return SPI_RESULT_WRONG_PARAM_TYPE; #define MARK_SET(mask,idx) (mask &= ~(1 << idx)) static SpiResult set_format_param (SpiParams *params, int id, SpiParamType type, size_t size, const void *value) { SpiVolumeFormat *f = (SpiVolumeFormat *) params; switch (id) { case SPI_PARAM_ID_FORMAT: CHECK_TYPE (type, SPI_PARAM_TYPE_STRING); memcpy (f->format, value, MIN (16, size)); MARK_SET (f->unset_mask, 1); break; case SPI_PARAM_ID_LAYOUT: CHECK_TYPE (type, SPI_PARAM_TYPE_UINT32); memcpy (&f->layout, value, MIN (4, size)); MARK_SET (f->unset_mask, 2); break; case SPI_PARAM_ID_SAMPLERATE: CHECK_TYPE (type, SPI_PARAM_TYPE_UINT32); memcpy (&f->samplerate, value, MIN (4, size)); MARK_SET (f->unset_mask, 3); break; case SPI_PARAM_ID_CHANNELS: CHECK_TYPE (type, SPI_PARAM_TYPE_UINT32); memcpy (&f->channels, value, MIN (4, size)); MARK_SET (f->unset_mask, 4); break; default: return SPI_RESULT_INVALID_PARAM_ID; } return SPI_RESULT_OK; } static SpiResult get_format_param (const SpiParams *params, int id, SpiParamType *type, size_t *size, const void **value) { SpiVolumeFormat *f = (SpiVolumeFormat *) params; switch (id) { case SPI_PARAM_ID_MEDIA_TYPE: CHECK_UNSET (f->unset_mask, 0); *type = SPI_PARAM_TYPE_STRING; *value = f->media_type; *size = strlen (f->media_type); break; case SPI_PARAM_ID_FORMAT: CHECK_UNSET (f->unset_mask, 1); *type = SPI_PARAM_TYPE_STRING; *value = f->format; *size = strlen (f->format); break; case SPI_PARAM_ID_LAYOUT: CHECK_UNSET (f->unset_mask, 2); *type = SPI_PARAM_TYPE_UINT32; *value = &f->layout; *size = 4; break; case SPI_PARAM_ID_SAMPLERATE: CHECK_UNSET (f->unset_mask, 3); *type = SPI_PARAM_TYPE_UINT32; *value = &f->samplerate; *size = 4; break; case SPI_PARAM_ID_CHANNELS: CHECK_UNSET (f->unset_mask, 4); *type = SPI_PARAM_TYPE_UINT32; *value = &f->channels; *size = 4; break; default: return SPI_RESULT_INVALID_PARAM_ID; } return SPI_RESULT_OK; } static SpiResult spi_volume_node_get_port_formats (SpiNode *node, int port_id, int format_idx, SpiParams **format) { static SpiVolumeFormat fmt; if (port_id != 0) return SPI_RESULT_INVALID_PORT; switch (format_idx) { case 0: strcpy (fmt.media_type, "audio/x-raw"); fmt.unset_mask = (1 << 1) | (1 << 2) | (1 << 3) | (1 << 4); fmt.param.get_param_info = get_raw_format_param_info; fmt.param.set_param = set_format_param; fmt.param.get_param = get_format_param; break; default: return SPI_RESULT_NO_MORE_FORMATS; } *format = &fmt.param; return SPI_RESULT_OK; } static SpiResult spi_volume_node_set_port_format (SpiNode *node, int port_id, int test_only, const SpiParams *format) { SpiVolume *this = (SpiVolume *) node; SpiParamType type; size_t size; const void *value; SpiVolumeFormat *fmt = &this->current_format; if (port_id != 0) return SPI_RESULT_INVALID_PORT; if (format == NULL) { fmt->param.get_param = NULL; this->have_format = false; return SPI_RESULT_OK; } if (format->get_param (format, SPI_PARAM_ID_MEDIA_TYPE, &type, &size, &value) < 0) return SPI_RESULT_INVALID_MEDIA_TYPE; if (type != SPI_PARAM_TYPE_STRING) return SPI_RESULT_INVALID_MEDIA_TYPE; memcpy (fmt->media_type, value, MIN (size, 32)); if (format->get_param (format, SPI_PARAM_ID_FORMAT, &type, &size, &value) < 0) return SPI_RESULT_INVALID_FORMAT_PARAMS; if (type != SPI_PARAM_TYPE_STRING) return SPI_RESULT_INVALID_FORMAT_PARAMS; memcpy (fmt->format, value, MIN (size, 16)); if (format->get_param (format, SPI_PARAM_ID_LAYOUT, &type, &size, &value) < 0) return SPI_RESULT_INVALID_FORMAT_PARAMS; if (type != SPI_PARAM_TYPE_UINT32) return SPI_RESULT_INVALID_FORMAT_PARAMS; memcpy (&fmt->layout, value, MIN (size, 4)); if (format->get_param (format, SPI_PARAM_ID_SAMPLERATE, &type, &size, &value) < 0) return SPI_RESULT_INVALID_FORMAT_PARAMS; if (type != SPI_PARAM_TYPE_UINT32) return SPI_RESULT_INVALID_FORMAT_PARAMS; memcpy (&fmt->samplerate, value, MIN (size, 4)); if (format->get_param (format, SPI_PARAM_ID_CHANNELS, &type, &size, &value) < 0) return SPI_RESULT_INVALID_FORMAT_PARAMS; if (type != SPI_PARAM_TYPE_UINT32) return SPI_RESULT_INVALID_FORMAT_PARAMS; memcpy (&fmt->channels, value, MIN (size, 4)); fmt->param.get_param_info = get_raw_format_param_info; fmt->param.set_param = NULL; fmt->param.get_param = get_format_param; this->have_format = true; return SPI_RESULT_OK; } static SpiResult spi_volume_node_get_port_format (SpiNode *node, int port_id, const SpiParams **format) { SpiVolume *this = (SpiVolume *) node; if (port_id != 0) return SPI_RESULT_INVALID_PORT; if (!this->have_format) return SPI_RESULT_NO_FORMAT; *format = &this->current_format.param; return SPI_RESULT_OK; } static SpiResult spi_volume_node_get_port_info (SpiNode *node, int port_id, SpiPortInfo *info) { if (port_id != 0) return SPI_RESULT_INVALID_PORT; info->flags = SPI_PORT_INFO_FLAG_NONE; return SPI_RESULT_OK; } static SpiResult spi_volume_node_get_port_params (SpiNode *node, int port_id, SpiParams **params) { return SPI_RESULT_NOT_IMPLEMENTED; } static SpiResult spi_volume_node_set_port_params (SpiNode *node, int port_id, const SpiParams *params) { return SPI_RESULT_NOT_IMPLEMENTED; } static SpiResult spi_volume_node_get_port_status (SpiNode *node, int port_id, SpiPortStatus *status) { SpiVolume *this = (SpiVolume *) node; SpiPortStatusFlags flags = 0; if (!this->have_format) return SPI_RESULT_NO_FORMAT; switch (port_id) { case 0: if (this->input_buffer == NULL) flags |= SPI_PORT_STATUS_FLAG_ACCEPT_INPUT; break; case 1: if (this->input_buffer != NULL) flags |= SPI_PORT_STATUS_FLAG_HAVE_OUTPUT; break; default: return SPI_RESULT_INVALID_PORT; } status->flags = flags; return SPI_RESULT_OK; } static SpiResult spi_volume_node_send_port_data (SpiNode *node, SpiDataInfo *data) { SpiVolume *this = (SpiVolume *) node; SpiBuffer *buffer = data->buffer; SpiEvent *event = data->event; if (data->port_id != 0) return SPI_RESULT_INVALID_PORT; if (buffer == NULL && event == NULL) return SPI_RESULT_INVALID_ARGUMENTS; if (!this->have_format) return SPI_RESULT_NO_FORMAT; if (buffer) { if (this->input_buffer != NULL) return SPI_RESULT_HAVE_ENOUGH_INPUT; buffer->refcount++; this->input_buffer = buffer; } if (event) { switch (event->type) { default: break; } } return SPI_RESULT_OK; } static SpiResult spi_volume_node_receive_port_data (SpiNode *node, int n_data, SpiDataInfo *data) { SpiVolume *this = (SpiVolume *) node; int i, n_samples; if (data->port_id != 1) return SPI_RESULT_INVALID_PORT; if (!this->have_format) return SPI_RESULT_NO_FORMAT; if (this->input_buffer == NULL) return SPI_RESULT_NEED_MORE_INPUT; n_samples = 4096; for (i = 0; i < n_samples; i++) { } data->buffer = this->input_buffer; this->input_buffer = NULL; return SPI_RESULT_OK; } static SpiNode * spi_volume_new (void) { SpiNode *node; SpiVolume *this; node = calloc (1, sizeof (SpiVolume)); node->get_params = spi_volume_node_get_params; node->set_params = spi_volume_node_set_params; node->send_command = spi_volume_node_send_command; node->get_event = spi_volume_node_get_event; node->set_event_callback = spi_volume_node_set_event_callback; node->get_n_ports = spi_volume_node_get_n_ports; node->get_port_ids = spi_volume_node_get_port_ids; node->add_port = spi_volume_node_add_port; node->remove_port = spi_volume_node_remove_port; node->get_port_formats = spi_volume_node_get_port_formats; node->set_port_format = spi_volume_node_set_port_format; node->get_port_format = spi_volume_node_get_port_format; node->get_port_info = spi_volume_node_get_port_info; node->get_port_params = spi_volume_node_get_port_params; node->set_port_params = spi_volume_node_set_port_params; node->get_port_status = spi_volume_node_get_port_status; node->send_port_data = spi_volume_node_send_port_data; node->receive_port_data = spi_volume_node_receive_port_data; this = (SpiVolume *) node; this->params.param.get_param_info = get_param_info; this->params.param.set_param = set_param; this->params.param.get_param = get_param; return node; }