--- /dev/null
+From c1d18d46b48d056b6458ec6ac1075cb74411145a Mon Sep 17 00:00:00 2001
+From: Julian Bouzas <julian.bouzas@collabora.com>
+Date: Tue, 23 Jul 2019 12:52:46 -0400
+Subject: [PATCH] bluez5: add sco-sink and sco-src nodes
+
+Upstream-Status: Backport [de031b42b1d5e89dfb23d39317955c4b56f17c1b]
+---
+ spa/plugins/bluez5/bluez5-device.c | 140 +---
+ spa/plugins/bluez5/bluez5-monitor.c | 24 +-
+ spa/plugins/bluez5/meson.build | 2 +
+ spa/plugins/bluez5/sco-sink.c | 1200 +++++++++++++++++++++++++++
+ spa/plugins/bluez5/sco-source.c | 1136 +++++++++++++++++++++++++
+ 5 files changed, 2396 insertions(+), 106 deletions(-)
+ create mode 100644 spa/plugins/bluez5/sco-sink.c
+ create mode 100644 spa/plugins/bluez5/sco-source.c
+
+diff --git a/spa/plugins/bluez5/bluez5-device.c b/spa/plugins/bluez5/bluez5-device.c
+index d6ea467e..40a340c9 100644
+--- a/spa/plugins/bluez5/bluez5-device.c
++++ b/spa/plugins/bluez5/bluez5-device.c
+@@ -44,6 +44,8 @@
+
+ extern const struct spa_handle_factory spa_a2dp_source_factory;
+ extern const struct spa_handle_factory spa_a2dp_sink_factory;
++extern const struct spa_handle_factory spa_sco_sink_factory;
++extern const struct spa_handle_factory spa_sco_source_factory;
+
+ static const char default_device[] = "";
+
+@@ -68,117 +70,61 @@ struct impl {
+ struct props props;
+
+ struct spa_bt_device *bt_dev;
++
++ uint32_t next_id;
+ };
+
+-static int emit_source_node(struct impl *this)
++static void emit_node (struct impl *this, struct spa_bt_transport *t, const struct spa_handle_factory *factory)
+ {
+- struct spa_dict_item items[1];
+- struct spa_bt_transport *t;
+- struct spa_bt_device *device = this->bt_dev;
+- enum spa_bt_profile profile = SPA_BT_PROFILE_NULL;
+-
+- if (device->connected_profiles & SPA_BT_PROFILE_A2DP_SOURCE) {
+- spa_log_info(this->log, "A2DP (source) profile found");
+- profile = SPA_BT_PROFILE_A2DP_SOURCE;
+- } else if (device->connected_profiles & SPA_BT_PROFILE_HSP_HS) {
+- spa_log_info(this->log, "HSP (source) profile found (Not implemented yet)");
+- profile = SPA_BT_PROFILE_HSP_HS;
+- return -ENODEV;
+- } else if (device->connected_profiles & SPA_BT_PROFILE_HFP_HF) {
+- spa_log_info(this->log, "HFP (source) profile found (Not implemented yet)");
+- profile = SPA_BT_PROFILE_HFP_HF;
+- return -ENODEV;
+- }
+-
+- /* Return if no profiles are connected */
+- if (profile == SPA_BT_PROFILE_NULL)
+- return -ENODEV;
+-
+- spa_list_for_each(t, &device->transport_list, device_link) {
+- if (t->profile == profile) {
+- struct spa_device_object_info info;
+- char transport[16];
+-
+- snprintf(transport, 16, "%p", t);
+- items[0] = SPA_DICT_ITEM_INIT("bluez5.transport", transport);
+-
+- spa_bt_transport_acquire(t, true);
+-
+- info = SPA_DEVICE_OBJECT_INFO_INIT();
+- info.type = SPA_TYPE_INTERFACE_Node;
+- info.factory = &spa_a2dp_source_factory;
+- info.change_mask = SPA_DEVICE_OBJECT_CHANGE_MASK_PROPS;
+- info.props = &SPA_DICT_INIT_ARRAY(items);
+-
+- spa_device_emit_object_info(&this->hooks, 0, &info);
+- break;
+- }
+- }
+-
+- spa_log_info (this->log, "bluez5 source nodes emitted");
+- return 0;
++ struct spa_device_object_info info;
++ struct spa_dict_item items[1];
++ char transport[16];
++
++ /* Set the info */
++ info = SPA_DEVICE_OBJECT_INFO_INIT();
++ info.type = SPA_TYPE_INTERFACE_Node;
++ info.factory = factory;
++ info.change_mask = SPA_DEVICE_OBJECT_CHANGE_MASK_PROPS;
++
++ /* Pass the transport pointer as a property */
++ snprintf(transport, 16, "%p", t);
++ items[0] = SPA_DICT_ITEM_INIT("bluez5.transport", transport);
++ info.props = &SPA_DICT_INIT_ARRAY(items);
++
++ /* Emit the node */
++ spa_device_emit_object_info(&this->hooks, this->next_id++, &info);
+ }
+
+-static int emit_sink_node(struct impl *this)
++static int emit_nodes(struct impl *this)
+ {
+- struct spa_dict_item items[1];
+- struct spa_bt_transport *t;
+ struct spa_bt_device *device = this->bt_dev;
+- enum spa_bt_profile profile = SPA_BT_PROFILE_NULL;
+-
+- if (device->connected_profiles & SPA_BT_PROFILE_A2DP_SINK) {
+- spa_log_info(this->log, "A2DP (sink) profile found");
+- profile = SPA_BT_PROFILE_A2DP_SINK;
+- } else if (device->connected_profiles & SPA_BT_PROFILE_HSP_AG) {
+- spa_log_info(this->log, "HSP (sink) profile found (Not implemented yet)");
+- profile = SPA_BT_PROFILE_HSP_AG;
+- return -ENODEV;
+- } else if (device->connected_profiles & SPA_BT_PROFILE_HFP_AG) {
+- spa_log_info(this->log, "HFP (sink) profile found (Not implemented yet)");
+- profile = SPA_BT_PROFILE_HFP_AG;
+- return -ENODEV;
+- }
+-
+- /* Return if no profiles are connected */
+- if (profile == SPA_BT_PROFILE_NULL)
+- return -ENODEV;
++ struct spa_bt_transport *t;
+
+ spa_list_for_each(t, &device->transport_list, device_link) {
+- if (t->profile == profile) {
+- struct spa_device_object_info info;
+- char transport[16];
+-
+- snprintf(transport, 16, "%p", t);
+- items[0] = SPA_DICT_ITEM_INIT("bluez5.transport", transport);
+-
+- info = SPA_DEVICE_OBJECT_INFO_INIT();
+- info.type = SPA_TYPE_INTERFACE_Node;
+- info.factory = &spa_a2dp_sink_factory;
+- info.change_mask = SPA_DEVICE_OBJECT_CHANGE_MASK_PROPS;
+- info.props = &SPA_DICT_INIT_ARRAY(items);
+-
+- spa_device_emit_object_info(&this->hooks, 0, &info);
+- break;
++ if (t->profile & device->connected_profiles) {
++ switch (t->profile) {
++ case SPA_BT_PROFILE_A2DP_SOURCE:
++ emit_node (this, t, &spa_a2dp_source_factory);
++ break;
++ case SPA_BT_PROFILE_A2DP_SINK:
++ emit_node (this, t, &spa_a2dp_sink_factory);
++ break;
++ case SPA_BT_PROFILE_HSP_HS:
++ case SPA_BT_PROFILE_HSP_AG:
++ case SPA_BT_PROFILE_HFP_HF:
++ case SPA_BT_PROFILE_HFP_AG:
++ emit_node (this, t, &spa_sco_source_factory);
++ emit_node (this, t, &spa_sco_sink_factory);
++ break;
++ default:
++ return -EINVAL;
++ }
+ }
+ }
+
+- spa_log_info(this->log, "bluez5 sink nodes emitted");
+ return 0;
+ }
+
+-static int emit_nodes(struct impl *this)
+-{
+- int sink, src;
+-
+- sink = emit_sink_node(this);
+- src = emit_source_node(this);
+-
+- if (sink == -ENODEV && src == -ENODEV)
+- spa_log_warn(this->log, "no profile available");
+-
+- return SPA_MAX(sink, src);
+-}
+-
+ static const struct spa_dict_item info_items[] = {
+ { "media.class", "Audio/Device" },
+ };
+@@ -314,6 +260,8 @@ impl_init(const struct spa_handle_factory *factory,
+
+ reset_props(&this->props);
+
++ this->next_id = 0;
++
+ return 0;
+ }
+
+diff --git a/spa/plugins/bluez5/bluez5-monitor.c b/spa/plugins/bluez5/bluez5-monitor.c
+index 5b8ff495..2a243715 100644
+--- a/spa/plugins/bluez5/bluez5-monitor.c
++++ b/spa/plugins/bluez5/bluez5-monitor.c
+@@ -1392,7 +1392,10 @@ static void rfcomm_event(struct spa_source *source)
+ {
+ struct spa_bt_transport *t = source->data;
+ struct spa_bt_monitor *monitor = t->monitor;
++ char buf[512];
++ ssize_t len;
+
++ /* Check for errors */
+ if (source->rmask & (SPA_IO_HUP | SPA_IO_ERR)) {
+ spa_log_info(monitor->log, "lost RFCOMM connection.");
+ if (source->loop)
+@@ -1400,20 +1403,19 @@ static void rfcomm_event(struct spa_source *source)
+ goto fail;
+ }
+
++ /* Read the command */
++ len = read(source->fd, buf, 511);
++ if (len < 0) {
++ spa_log_error(monitor->log, "RFCOMM read error: %s", strerror(errno));
++ goto fail;
++ }
++ buf[len] = 0;
++ printf ("RFCOMM AT COMMAND: %s\n", buf);
++
+ if (source->rmask & SPA_IO_IN) {
+- char buf[512];
+- ssize_t len;
+ int gain, dummy;
+ bool do_reply = false;
+
+- len = read(source->fd, buf, 511);
+- if (len < 0) {
+- spa_log_error(monitor->log, "RFCOMM read error: %s", strerror(errno));
+- goto fail;
+- }
+- buf[len] = 0;
+- spa_log_debug(monitor->log, "RFCOMM << %s", buf);
+-
+ /* There are only four HSP AT commands:
+ * AT+VGS=value: value between 0 and 15, sent by the HS to AG to set the speaker gain.
+ * +VGS=value is sent by AG to HS as a response to an AT+VGS command or when the gain
+@@ -1669,12 +1671,14 @@ static int sco_destroy_cb(void *data)
+ spa_loop_remove_source(td->sco.loop, &td->sco);
+ shutdown(td->sco.fd, SHUT_RDWR);
+ close (td->sco.fd);
++ td->sco.fd = -1;
+ }
+ if (td->rfcomm.data) {
+ if (td->rfcomm.loop)
+ spa_loop_remove_source(td->rfcomm.loop, &td->rfcomm);
+ shutdown(td->rfcomm.fd, SHUT_RDWR);
+ close (td->rfcomm.fd);
++ td->rfcomm.fd = -1;
+ }
+ return 0;
+ }
+diff --git a/spa/plugins/bluez5/meson.build b/spa/plugins/bluez5/meson.build
+index 5fb285ec..ddcc74fa 100644
+--- a/spa/plugins/bluez5/meson.build
++++ b/spa/plugins/bluez5/meson.build
+@@ -3,6 +3,8 @@ bluez5_sources = ['plugin.c',
+ 'a2dp-codecs.c',
+ 'a2dp-sink.c',
+ 'a2dp-source.c',
++ 'sco-sink.c',
++ 'sco-source.c',
+ 'bluez5-device.c',
+ 'bluez5-monitor.c']
+
+diff --git a/spa/plugins/bluez5/sco-sink.c b/spa/plugins/bluez5/sco-sink.c
+new file mode 100644
+index 00000000..52307e10
+--- /dev/null
++++ b/spa/plugins/bluez5/sco-sink.c
+@@ -0,0 +1,1200 @@
++/* Spa SCO Sink
++ *
++ * Copyright © 2018 Wim Taymans
++ * Copyright © 2019 Collabora Ltd.
++ *
++ * Permission is hereby granted, free of charge, to any person obtaining a
++ * copy of this software and associated documentation files (the "Software"),
++ * to deal in the Software without restriction, including without limitation
++ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
++ * and/or sell copies of the Software, and to permit persons to whom the
++ * Software is furnished to do so, subject to the following conditions:
++ *
++ * The above copyright notice and this permission notice (including the next
++ * paragraph) shall be included in all copies or substantial portions of the
++ * Software.
++ *
++ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
++ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
++ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
++ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
++ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
++ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
++ * DEALINGS IN THE SOFTWARE.
++ */
++
++#include <unistd.h>
++#include <stddef.h>
++#include <stdio.h>
++#include <sys/timerfd.h>
++#include <arpa/inet.h>
++#include <sys/ioctl.h>
++
++#include <spa/support/loop.h>
++#include <spa/support/log.h>
++#include <spa/utils/list.h>
++
++#include <spa/node/node.h>
++#include <spa/node/io.h>
++#include <spa/param/param.h>
++#include <spa/param/audio/format.h>
++#include <spa/param/audio/format-utils.h>
++#include <spa/pod/filter.h>
++
++#include <sbc/sbc.h>
++
++#include "defs.h"
++
++struct props {
++ uint32_t min_latency;
++ uint32_t max_latency;
++};
++
++#define MAX_BUFFERS 32
++
++struct buffer {
++ uint32_t id;
++ unsigned int outstanding:1;
++ struct spa_buffer *buf;
++ struct spa_meta_header *h;
++ struct spa_list link;
++};
++
++struct port {
++ struct spa_audio_info current_format;
++ int frame_size;
++ unsigned int have_format:1;
++
++ uint64_t info_all;
++ struct spa_port_info info;
++ struct spa_io_buffers *io;
++ struct spa_param_info params[8];
++
++ struct buffer buffers[MAX_BUFFERS];
++ uint32_t n_buffers;
++
++ struct spa_list free;
++ struct spa_list ready;
++};
++
++struct impl {
++ struct spa_handle handle;
++ struct spa_node node;
++
++ /* Support */
++ struct spa_log *log;
++ struct spa_loop *main_loop;
++ struct spa_loop *data_loop;
++
++ /* Hooks and callbacks */
++ struct spa_hook_list hooks;
++ struct spa_callbacks callbacks;
++
++ /* Info */
++ uint64_t info_all;
++ struct spa_node_info info;
++ struct spa_param_info params[8];
++ struct props props;
++
++ /* Transport */
++ struct spa_bt_transport *transport;
++ struct spa_hook transport_listener;
++ int sock_fd;
++
++ /* Port */
++ struct port port;
++
++ /* Flags */
++ unsigned int started:1;
++ unsigned int slaved:1;
++
++ /* Sources */
++ struct spa_source source;
++ struct spa_source flush_source;
++
++ /* Timer */
++ int timerfd;
++ struct timespec now;
++ struct spa_io_clock *clock;
++ struct spa_io_position *position;
++ int threshold;
++
++ /* Times */
++ uint64_t start_time;
++
++ /* Counts */
++ uint64_t sample_count;
++};
++
++#define NAME "sco-sink"
++
++#define CHECK_PORT(this,d,p) ((d) == SPA_DIRECTION_INPUT && (p) == 0)
++
++static const uint32_t default_min_latency = 128;
++static const uint32_t default_max_latency = 1024;
++
++static void reset_props(struct props *props)
++{
++ props->min_latency = default_min_latency;
++ props->max_latency = default_max_latency;
++}
++
++static int impl_node_enum_params(struct spa_node *node, int seq,
++ uint32_t id, uint32_t start, uint32_t num,
++ const struct spa_pod *filter)
++{
++ struct impl *this;
++ struct spa_pod *param;
++ struct spa_pod_builder b = { 0 };
++ uint8_t buffer[1024];
++ struct spa_result_node_params result;
++ uint32_t count = 0;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(num != 0, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ result.id = id;
++ result.next = start;
++ next:
++ result.index = result.next++;
++
++ spa_pod_builder_init(&b, buffer, sizeof(buffer));
++
++ switch (id) {
++ case SPA_PARAM_PropInfo:
++ {
++ struct props *p = &this->props;
++
++ switch (result.index) {
++ case 0:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_PropInfo, id,
++ SPA_PROP_INFO_id, SPA_POD_Id(SPA_PROP_minLatency),
++ SPA_PROP_INFO_name, SPA_POD_String("The minimum latency"),
++ SPA_PROP_INFO_type, SPA_POD_CHOICE_RANGE_Int(p->min_latency, 1, INT32_MAX));
++ break;
++ case 1:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_PropInfo, id,
++ SPA_PROP_INFO_id, SPA_POD_Id(SPA_PROP_maxLatency),
++ SPA_PROP_INFO_name, SPA_POD_String("The maximum latency"),
++ SPA_PROP_INFO_type, SPA_POD_CHOICE_RANGE_Int(p->max_latency, 1, INT32_MAX));
++ break;
++ default:
++ return 0;
++ }
++ break;
++ }
++ case SPA_PARAM_Props:
++ {
++ struct props *p = &this->props;
++
++ switch (result.index) {
++ case 0:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_Props, id,
++ SPA_PROP_minLatency, SPA_POD_Int(p->min_latency),
++ SPA_PROP_maxLatency, SPA_POD_Int(p->max_latency));
++ break;
++ default:
++ return 0;
++ }
++ break;
++ }
++ default:
++ return -ENOENT;
++ }
++
++ if (spa_pod_filter(&b, &result.param, param, filter) < 0)
++ goto next;
++
++ spa_node_emit_result(&this->hooks, seq, 0, &result);
++
++ if (++count != num)
++ goto next;
++
++ return 0;
++}
++
++static void set_timeout(struct impl *this, time_t sec, long nsec)
++{
++ struct itimerspec ts;
++
++ ts.it_value.tv_sec = sec;
++ ts.it_value.tv_nsec = nsec;
++ ts.it_interval.tv_sec = 0;
++ ts.it_interval.tv_nsec = 0;
++
++ timerfd_settime(this->timerfd, TFD_TIMER_ABSTIME, &ts, NULL);
++ this->source.mask = SPA_IO_IN;
++ spa_loop_update_source(this->data_loop, &this->source);
++}
++
++static void reset_timeout(struct impl *this)
++{
++ set_timeout(this, 0, this->slaved ? 0 : 1);
++}
++
++
++static void set_next_timeout(struct impl *this, uint64_t now_time)
++{
++ struct port *port = &this->port;
++
++ /* Set the next timeout if not slaved, otherwise reset values */
++ if (!this->slaved) {
++ /* Get the elapsed time */
++ const uint64_t elapsed_time = now_time - this->start_time;
++
++ /* Get the elapsed samples */
++ const uint64_t elapsed_samples = elapsed_time * port->current_format.info.raw.rate / SPA_NSEC_PER_SEC;
++
++ /* Get the queued samples (processed - elapsed) */
++ const uint64_t queued_samples = this->sample_count - elapsed_samples;
++
++ /* Get the queued time */
++ const uint64_t queued_time = (queued_samples * SPA_NSEC_PER_SEC) / port->current_format.info.raw.rate;
++
++ /* Get the next time */
++ const uint64_t next_time = now_time + queued_time;
++
++ /* Set the next timeout */
++ set_timeout (this, next_time / SPA_NSEC_PER_SEC, next_time % SPA_NSEC_PER_SEC);
++ } else {
++ this->start_time = now_time;
++ this->sample_count = 0;
++ }
++}
++
++static int do_reslave(struct spa_loop *loop,
++ bool async,
++ uint32_t seq,
++ const void *data,
++ size_t size,
++ void *user_data)
++{
++ struct impl *this = user_data;
++ reset_timeout(this);
++ return 0;
++}
++
++static inline bool is_slaved(struct impl *this)
++{
++ return this->position && this->clock && this->position->clock.id != this->clock->id;
++}
++
++static int impl_node_set_io(struct spa_node *node, uint32_t id, void *data, size_t size)
++{
++ struct impl *this;
++ bool slaved;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ switch (id) {
++ case SPA_IO_Clock:
++ this->clock = data;
++ break;
++ case SPA_IO_Position:
++ this->position = data;
++ break;
++ default:
++ return -ENOENT;
++ }
++
++ slaved = is_slaved(this);
++ if (this->started && slaved != this->slaved) {
++ spa_log_debug(this->log, "sco-sink %p: reslave %d->%d", this, this->slaved, slaved);
++ this->slaved = slaved;
++ spa_loop_invoke(this->data_loop, do_reslave, 0, NULL, 0, true, this);
++ }
++ return 0;
++}
++
++static int impl_node_set_param(struct spa_node *node, uint32_t id, uint32_t flags,
++ const struct spa_pod *param)
++{
++ struct impl *this;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ switch (id) {
++ case SPA_PARAM_Props:
++ {
++ struct props *p = &this->props;
++
++ if (param == NULL) {
++ reset_props(p);
++ return 0;
++ }
++ spa_pod_parse_object(param,
++ SPA_TYPE_OBJECT_Props, NULL,
++ SPA_PROP_minLatency, SPA_POD_OPT_Int(&p->min_latency),
++ SPA_PROP_maxLatency, SPA_POD_OPT_Int(&p->max_latency));
++ break;
++ }
++ default:
++ return -ENOENT;
++ }
++
++ return 0;
++}
++
++static bool write_data(struct impl *this, uint8_t *data, uint32_t size, uint32_t *total_written)
++{
++ uint32_t local_total_written = 0;
++ const uint32_t mtu_size = this->transport->write_mtu;
++
++ /* TODO: For now we assume the size is always a mutliple of mtu_size */
++ while (local_total_written < (size - mtu_size)) {
++ const int bytes_written = write(this->sock_fd, data, mtu_size);
++ if (bytes_written < 0) {
++ spa_log_warn(this->log, "error writting data: %s", strerror(errno));
++ return false;
++ }
++
++ data += bytes_written;
++ local_total_written += bytes_written;
++ }
++
++ if (total_written)
++ *total_written = local_total_written;
++ return true;
++}
++
++static int render_buffers(struct impl *this, uint64_t now_time)
++{
++ struct port *port = &this->port;
++
++ /* Render the buffer */
++ while (!spa_list_is_empty(&port->ready)) {
++ uint8_t *src;
++ struct buffer *b;
++ struct spa_data *d;
++ uint32_t offset, size;
++ uint32_t total_written = 0;
++
++ /* Get the buffer and datas */
++ b = spa_list_first(&port->ready, struct buffer, link);
++ d = b->buf->datas;
++
++ /* Get the data, offset and size */
++ src = d[0].data;
++ offset = d[0].chunk->offset;
++ size = d[0].chunk->size;
++
++ /* Write data */
++ write_data(this, src + offset, size, &total_written);
++
++ /* Update the cample count */
++ this->sample_count += total_written / port->frame_size;
++
++ /* Remove the buffer and mark it as reusable */
++ spa_list_remove(&b->link);
++ b->outstanding = true;
++ spa_node_call_reuse_buffer(&this->callbacks, 0, b->id);
++ }
++
++ /* Set next timeout */
++ set_next_timeout(this, now_time);
++
++ return 0;
++}
++
++static void sco_on_flush(struct spa_source *source)
++{
++ struct impl *this = source->data;
++ uint64_t now_time;
++
++ if ((source->rmask & SPA_IO_OUT) == 0) {
++ spa_log_warn(this->log, "error %d", source->rmask);
++ if (this->flush_source.loop)
++ spa_loop_remove_source(this->data_loop, &this->flush_source);
++ this->source.mask = 0;
++ spa_loop_update_source(this->data_loop, &this->source);
++ return;
++ }
++
++ /* Get the current time */
++ clock_gettime(CLOCK_MONOTONIC, &this->now);
++ now_time = SPA_TIMESPEC_TO_NSEC(&this->now);
++
++ /* Render buffers */
++ render_buffers(this, now_time);
++}
++
++static void sco_on_timeout(struct spa_source *source)
++{
++ struct impl *this = source->data;
++ struct port *port = &this->port;
++ uint64_t exp, now_time;
++ struct spa_io_buffers *io = port->io;
++
++ /* Read the timerfd */
++ if (this->started && read(this->timerfd, &exp, sizeof(uint64_t)) != sizeof(uint64_t))
++ spa_log_warn(this->log, "error reading timerfd: %s", strerror(errno));
++
++ /* Get the current time */
++ clock_gettime(CLOCK_MONOTONIC, &this->now);
++ now_time = SPA_TIMESPEC_TO_NSEC(&this->now);
++
++ /* Set the start time to the current time */
++ if (this->start_time == 0)
++ this->start_time = now_time;
++
++ /* Notify we need a new buffer if we have processed all of them */
++ if (spa_list_is_empty(&port->ready)) {
++ io->status = SPA_STATUS_NEED_BUFFER;
++ spa_node_call_ready(&this->callbacks, SPA_STATUS_NEED_BUFFER);
++ }
++
++ /* Render the buffers */
++ render_buffers(this, now_time);
++}
++
++static int do_start(struct impl *this)
++{
++ int val;
++ bool do_accept;
++
++ /* Dont do anything if the node has already started */
++ if (this->started)
++ return 0;
++
++ /* Make sure the transport is valid */
++ spa_return_val_if_fail (this->transport != NULL, -EIO);
++
++ /* Set the slaved flag */
++ this->slaved = is_slaved(this);
++
++ /* Do accept if Gateway; otherwise do connect for Head Unit */
++ do_accept = this->transport->profile & SPA_BT_PROFILE_HEADSET_AUDIO_GATEWAY;
++
++ /* acquire the socked fd (false -> connect | true -> accept) */
++ this->sock_fd = spa_bt_transport_acquire(this->transport, do_accept);
++ if (this->sock_fd < 0)
++ return -1;
++
++ /* Set the write MTU */
++ val = this->transport->write_mtu;
++ if (setsockopt(this->sock_fd, SOL_SOCKET, SO_SNDBUF, &val, sizeof(val)) < 0)
++ spa_log_warn(this->log, "sco-sink %p: SO_SNDBUF %m", this);
++
++ /* Set the read MTU */
++ val = this->transport->read_mtu;
++ if (setsockopt(this->sock_fd, SOL_SOCKET, SO_RCVBUF, &val, sizeof(val)) < 0)
++ spa_log_warn(this->log, "sco-sink %p: SO_RCVBUF %m", this);
++
++ /* Set the priority */
++ val = 6;
++ if (setsockopt(this->sock_fd, SOL_SOCKET, SO_PRIORITY, &val, sizeof(val)) < 0)
++ spa_log_warn(this->log, "SO_PRIORITY failed: %m");
++
++ /* Add the timeout callback */
++ this->source.data = this;
++ this->source.fd = this->timerfd;
++ this->source.func = sco_on_timeout;
++ this->source.mask = SPA_IO_IN;
++ this->source.rmask = 0;
++ spa_loop_add_source(this->data_loop, &this->source);
++
++ /* Add the flush callback */
++ this->flush_source.data = this;
++ this->flush_source.fd = this->sock_fd;
++ this->flush_source.func = sco_on_flush;
++ this->flush_source.mask = 0;
++ this->flush_source.rmask = 0;
++ spa_loop_add_source(this->data_loop, &this->flush_source);
++
++ /* Reset timeout to start processing */
++ reset_timeout(this);
++
++ /* Set the started flag */
++ this->started = true;
++
++ 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 impl *this = user_data;
++ struct itimerspec ts;
++
++ if (this->source.loop)
++ spa_loop_remove_source(this->data_loop, &this->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;
++ timerfd_settime(this->timerfd, 0, &ts, NULL);
++ if (this->flush_source.loop)
++ spa_loop_remove_source(this->data_loop, &this->flush_source);
++
++ return 0;
++}
++
++static int do_stop(struct impl *this)
++{
++ int res = 0;
++
++ if (!this->started)
++ return 0;
++
++ spa_log_trace(this->log, "sco-sink %p: stop", this);
++
++ spa_loop_invoke(this->data_loop, do_remove_source, 0, NULL, 0, true, this);
++
++ this->started = false;
++
++ if (this->transport) {
++ /* Release the transport */
++ res = spa_bt_transport_release(this->transport);
++
++ /* Shutdown and close the socket */
++ shutdown(this->sock_fd, SHUT_RDWR);
++ close(this->sock_fd);
++ this->sock_fd = -1;
++ }
++
++ return res;
++}
++
++static int impl_node_send_command(struct spa_node *node, const struct spa_command *command)
++{
++ struct impl *this;
++ struct port *port;
++ int res;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(command != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++ port = &this->port;
++
++ switch (SPA_NODE_COMMAND_ID(command)) {
++ case SPA_NODE_COMMAND_Start:
++ if (!port->have_format)
++ return -EIO;
++ if (port->n_buffers == 0)
++ return -EIO;
++ if ((res = do_start(this)) < 0)
++ return res;
++ break;
++ case SPA_NODE_COMMAND_Pause:
++ if ((res = do_stop(this)) < 0)
++ return res;
++ break;
++ default:
++ return -ENOTSUP;
++ }
++ return 0;
++}
++
++static const struct spa_dict_item node_info_items[] = {
++ { "media.class", "Audio/Sink" },
++ { "node.driver", "true" },
++};
++
++static void emit_node_info(struct impl *this, bool full)
++{
++ if (full)
++ this->info.change_mask = this->info_all;
++ if (this->info.change_mask) {
++ this->info.props = &SPA_DICT_INIT_ARRAY(node_info_items);
++ spa_node_emit_info(&this->hooks, &this->info);
++ this->info.change_mask = 0;
++ }
++}
++
++static void emit_port_info(struct impl *this, struct port *port, bool full)
++{
++ if (full)
++ port->info.change_mask = port->info_all;
++ if (port->info.change_mask) {
++ spa_node_emit_port_info(&this->hooks,
++ SPA_DIRECTION_INPUT, 0, &port->info);
++ port->info.change_mask = 0;
++ }
++}
++
++static int
++impl_node_add_listener(struct spa_node *node,
++ struct spa_hook *listener,
++ const struct spa_node_events *events,
++ void *data)
++{
++ struct impl *this;
++ struct spa_hook_list save;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++ spa_hook_list_isolate(&this->hooks, &save, listener, events, data);
++
++ emit_node_info(this, true);
++ emit_port_info(this, &this->port, true);
++
++ spa_hook_list_join(&this->hooks, &save);
++
++ return 0;
++}
++
++static int
++impl_node_set_callbacks(struct spa_node *node,
++ const struct spa_node_callbacks *callbacks,
++ void *data)
++{
++ struct impl *this;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ this->callbacks = SPA_CALLBACKS_INIT(callbacks, data);
++
++ return 0;
++}
++
++static int impl_node_add_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id,
++ const struct spa_dict *props)
++{
++ return -ENOTSUP;
++}
++
++static int impl_node_remove_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id)
++{
++ return -ENOTSUP;
++}
++
++static int
++impl_node_port_enum_params(struct spa_node *node, int seq,
++ enum spa_direction direction, uint32_t port_id,
++ uint32_t id, uint32_t start, uint32_t num,
++ const struct spa_pod *filter)
++{
++
++ struct impl *this;
++ struct port *port;
++ struct spa_pod *param;
++ struct spa_pod_builder b = { 0 };
++ uint8_t buffer[1024];
++ struct spa_result_node_params result;
++ uint32_t count = 0;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(num != 0, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ result.id = id;
++ result.next = start;
++ next:
++ result.index = result.next++;
++
++ spa_pod_builder_init(&b, buffer, sizeof(buffer));
++
++ switch (id) {
++ case SPA_PARAM_EnumFormat:
++ if (result.index > 0)
++ return 0;
++
++ /* set the info structure */
++ struct spa_audio_info_raw info = { 0, };
++ info.format = SPA_AUDIO_FORMAT_S16;
++ info.channels = 1;
++ info.position[0] = SPA_AUDIO_CHANNEL_MONO;
++
++ /* TODO: For now we only handle HSP profiles which has always CVSD format,
++ * but we eventually need to support HFP that can have both CVSD and MSBC formats */
++
++ /* CVSD format has a rate of 8kHz
++ * MSBC format has a rate of 16kHz */
++ info.rate = 8000;
++
++ /* build the param */
++ param = spa_format_audio_raw_build(&b, id, &info);
++
++ break;
++
++ case SPA_PARAM_Format:
++ if (!port->have_format)
++ return -EIO;
++ if (result.index > 0)
++ return 0;
++
++ param = spa_format_audio_raw_build(&b, id, &port->current_format.info.raw);
++ break;
++
++ case SPA_PARAM_Buffers:
++ if (!port->have_format)
++ return -EIO;
++ if (result.index > 0)
++ return 0;
++
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_ParamBuffers, id,
++ SPA_PARAM_BUFFERS_buffers, SPA_POD_CHOICE_RANGE_Int(2, 2, MAX_BUFFERS),
++ SPA_PARAM_BUFFERS_blocks, SPA_POD_Int(1),
++ SPA_PARAM_BUFFERS_size, SPA_POD_CHOICE_RANGE_Int(
++ this->props.min_latency * port->frame_size,
++ this->props.min_latency * port->frame_size,
++ INT32_MAX),
++ SPA_PARAM_BUFFERS_stride, SPA_POD_Int(port->frame_size),
++ SPA_PARAM_BUFFERS_align, SPA_POD_Int(16));
++ break;
++
++ case SPA_PARAM_Meta:
++ switch (result.index) {
++ case 0:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_ParamMeta, id,
++ SPA_PARAM_META_type, SPA_POD_Id(SPA_META_Header),
++ SPA_PARAM_META_size, SPA_POD_Int(sizeof(struct spa_meta_header)));
++ break;
++ default:
++ return 0;
++ }
++ break;
++
++ default:
++ return -ENOENT;
++ }
++
++ if (spa_pod_filter(&b, &result.param, param, filter) < 0)
++ goto next;
++
++ spa_node_emit_result(&this->hooks, seq, 0, &result);
++
++ if (++count != num)
++ goto next;
++
++ return 0;
++}
++
++static int clear_buffers(struct impl *this, struct port *port)
++{
++ do_stop(this);
++ if (port->n_buffers > 0) {
++ spa_list_init(&port->ready);
++ port->n_buffers = 0;
++ }
++ return 0;
++}
++
++static int port_set_format(struct impl *this, struct port *port,
++ uint32_t flags,
++ const struct spa_pod *format)
++{
++ int err;
++
++ if (format == NULL) {
++ spa_log_info(this->log, "clear format");
++ clear_buffers(this, port);
++ port->have_format = false;
++ } else {
++ struct spa_audio_info info = { 0 };
++
++ if ((err = spa_format_parse(format, &info.media_type, &info.media_subtype)) < 0)
++ return err;
++
++ if (info.media_type != SPA_MEDIA_TYPE_audio ||
++ info.media_subtype != SPA_MEDIA_SUBTYPE_raw)
++ return -EINVAL;
++
++ if (spa_format_audio_raw_parse(format, &info.info.raw) < 0)
++ return -EINVAL;
++
++ port->frame_size = info.info.raw.channels * 2;
++ port->current_format = info;
++ port->have_format = true;
++ this->threshold = this->props.min_latency;
++ }
++
++ port->info.change_mask |= SPA_PORT_CHANGE_MASK_PARAMS;
++ if (port->have_format) {
++ port->info.change_mask |= SPA_PORT_CHANGE_MASK_FLAGS;
++ port->info.flags = SPA_PORT_FLAG_CAN_USE_BUFFERS | SPA_PORT_FLAG_LIVE;
++ port->info.change_mask |= SPA_PORT_CHANGE_MASK_RATE;
++ port->info.rate = SPA_FRACTION(1, port->current_format.info.raw.rate);
++ port->params[3] = SPA_PARAM_INFO(SPA_PARAM_Format, SPA_PARAM_INFO_READWRITE);
++ port->params[4] = SPA_PARAM_INFO(SPA_PARAM_Buffers, SPA_PARAM_INFO_READ);
++ } else {
++ port->params[3] = SPA_PARAM_INFO(SPA_PARAM_Format, SPA_PARAM_INFO_WRITE);
++ port->params[4] = SPA_PARAM_INFO(SPA_PARAM_Buffers, 0);
++ }
++ emit_port_info(this, port, false);
++
++ return 0;
++}
++
++static int
++impl_node_port_set_param(struct spa_node *node,
++ enum spa_direction direction, uint32_t port_id,
++ uint32_t id, uint32_t flags,
++ const struct spa_pod *param)
++{
++ struct impl *this;
++ struct port *port;
++ int res;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(node, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ switch (id) {
++ case SPA_PARAM_Format:
++ res = port_set_format(this, port, flags, param);
++ break;
++ default:
++ res = -ENOENT;
++ break;
++ }
++ return res;
++}
++
++static int
++impl_node_port_use_buffers(struct spa_node *node,
++ enum spa_direction direction,
++ uint32_t port_id, struct spa_buffer **buffers, uint32_t n_buffers)
++{
++ struct impl *this;
++ struct port *port;
++ uint32_t i;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ spa_log_info(this->log, "use buffers %d", n_buffers);
++
++ if (!port->have_format)
++ return -EIO;
++
++ clear_buffers(this, port);
++
++ for (i = 0; i < n_buffers; i++) {
++ struct buffer *b = &port->buffers[i];
++ uint32_t type;
++
++ b->buf = buffers[i];
++ b->id = i;
++ b->outstanding = true;
++
++ b->h = spa_buffer_find_meta_data(buffers[i], SPA_META_Header, sizeof(*b->h));
++
++ type = buffers[i]->datas[0].type;
++ if ((type == SPA_DATA_MemFd ||
++ type == SPA_DATA_DmaBuf ||
++ type == SPA_DATA_MemPtr) && buffers[i]->datas[0].data == NULL) {
++ spa_log_error(this->log, NAME " %p: need mapped memory", this);
++ return -EINVAL;
++ }
++ this->threshold = buffers[i]->datas[0].maxsize / port->frame_size;
++ }
++ port->n_buffers = n_buffers;
++
++ return 0;
++}
++
++static int
++impl_node_port_alloc_buffers(struct spa_node *node,
++ enum spa_direction direction,
++ uint32_t port_id,
++ struct spa_pod **params,
++ uint32_t n_params,
++ struct spa_buffer **buffers,
++ uint32_t *n_buffers)
++{
++ struct impl *this;
++ struct port *port;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(buffers != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ if (!port->have_format)
++ return -EIO;
++
++ return -ENOTSUP;
++}
++
++static int
++impl_node_port_set_io(struct spa_node *node,
++ enum spa_direction direction,
++ uint32_t port_id,
++ uint32_t id,
++ void *data, size_t size)
++{
++ struct impl *this;
++ struct port *port;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ switch (id) {
++ case SPA_IO_Buffers:
++ port->io = data;
++ break;
++ default:
++ return -ENOENT;
++ }
++ return 0;
++}
++
++static int impl_node_port_reuse_buffer(struct spa_node *node, uint32_t port_id, uint32_t buffer_id)
++{
++ return -ENOTSUP;
++}
++
++static int impl_node_process(struct spa_node *node)
++{
++ struct impl *this;
++ struct port *port;
++ struct spa_io_buffers *io;
++ uint64_t now_time;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++ port = &this->port;
++ io = port->io;
++ spa_return_val_if_fail(io != NULL, -EIO);
++
++ /* Get the current time */
++ clock_gettime(CLOCK_MONOTONIC, &this->now);
++ now_time = SPA_TIMESPEC_TO_NSEC(&this->now);
++
++ /* Make sure we process all the previous buffers */
++ if (!spa_list_is_empty(&port->ready))
++ render_buffers(this, now_time);
++
++ /* Process the new buffers */
++ if (io->status == SPA_STATUS_HAVE_BUFFER && io->buffer_id < port->n_buffers) {
++ struct buffer *b = &port->buffers[io->buffer_id];
++
++ if (!b->outstanding) {
++ spa_log_warn(this->log, NAME " %p: buffer %u in use", this, io->buffer_id);
++ io->status = -EINVAL;
++ return -EINVAL;
++ }
++
++ spa_log_trace(this->log, NAME " %p: queue buffer %u", this, io->buffer_id);
++
++ spa_list_append(&port->ready, &b->link);
++ b->outstanding = false;
++
++ this->threshold = SPA_MIN(b->buf->datas[0].chunk->size / port->frame_size,
++ this->props.max_latency);
++
++ render_buffers(this, now_time);
++
++ io->status = SPA_STATUS_OK;
++ }
++
++ return SPA_STATUS_HAVE_BUFFER;
++}
++
++static const struct spa_node impl_node = {
++ SPA_VERSION_NODE,
++ .add_listener = impl_node_add_listener,
++ .set_callbacks = impl_node_set_callbacks,
++ .enum_params = impl_node_enum_params,
++ .set_param = impl_node_set_param,
++ .set_io = impl_node_set_io,
++ .send_command = impl_node_send_command,
++ .add_port = impl_node_add_port,
++ .remove_port = impl_node_remove_port,
++ .port_enum_params = impl_node_port_enum_params,
++ .port_set_param = impl_node_port_set_param,
++ .port_use_buffers = impl_node_port_use_buffers,
++ .port_alloc_buffers = impl_node_port_alloc_buffers,
++ .port_set_io = impl_node_port_set_io,
++ .port_reuse_buffer = impl_node_port_reuse_buffer,
++ .process = impl_node_process,
++};
++
++static void transport_destroy(void *data)
++{
++ struct impl *this = data;
++ spa_log_debug(this->log, "transport %p destroy", this->transport);
++ this->transport = NULL;
++}
++
++static const struct spa_bt_transport_events transport_events = {
++ SPA_VERSION_BT_TRANSPORT_EVENTS,
++ .destroy = transport_destroy,
++};
++
++static int impl_get_interface(struct spa_handle *handle, uint32_t type, void **interface)
++{
++ struct impl *this;
++
++ spa_return_val_if_fail(handle != NULL, -EINVAL);
++ spa_return_val_if_fail(interface != NULL, -EINVAL);
++
++ this = (struct impl *) handle;
++
++ if (type == SPA_TYPE_INTERFACE_Node)
++ *interface = &this->node;
++ else
++ return -ENOENT;
++
++ return 0;
++}
++
++static int impl_clear(struct spa_handle *handle)
++{
++ return 0;
++}
++
++static size_t
++impl_get_size(const struct spa_handle_factory *factory,
++ const struct spa_dict *params)
++{
++ return sizeof(struct impl);
++}
++
++static int
++impl_init(const struct spa_handle_factory *factory,
++ struct spa_handle *handle,
++ const struct spa_dict *info,
++ const struct spa_support *support,
++ uint32_t n_support)
++{
++ struct impl *this;
++ struct port *port;
++ uint32_t i;
++
++ spa_return_val_if_fail(factory != NULL, -EINVAL);
++ spa_return_val_if_fail(handle != NULL, -EINVAL);
++
++ handle->get_interface = impl_get_interface;
++ handle->clear = impl_clear;
++
++ this = (struct impl *) handle;
++
++ for (i = 0; i < n_support; i++) {
++ if (support[i].type == SPA_TYPE_INTERFACE_Log)
++ this->log = support[i].data;
++ else if (support[i].type == SPA_TYPE_INTERFACE_DataLoop)
++ this->data_loop = support[i].data;
++ else if (support[i].type == SPA_TYPE_INTERFACE_MainLoop)
++ this->main_loop = support[i].data;
++ }
++ if (this->data_loop == NULL) {
++ spa_log_error(this->log, "a data loop is needed");
++ return -EINVAL;
++ }
++ if (this->main_loop == NULL) {
++ spa_log_error(this->log, "a main loop is needed");
++ return -EINVAL;
++ }
++
++ this->node = impl_node;
++ spa_hook_list_init(&this->hooks);
++
++ reset_props(&this->props);
++
++ this->info_all = SPA_NODE_CHANGE_MASK_FLAGS |
++ SPA_NODE_CHANGE_MASK_PARAMS |
++ SPA_NODE_CHANGE_MASK_PROPS;
++ this->info = SPA_NODE_INFO_INIT();
++ this->info.flags = SPA_NODE_FLAG_RT;
++ this->params[0] = SPA_PARAM_INFO(SPA_PARAM_PropInfo, SPA_PARAM_INFO_READ);
++ this->params[1] = SPA_PARAM_INFO(SPA_PARAM_Props, SPA_PARAM_INFO_READWRITE);
++ this->info.params = this->params;
++ this->info.n_params = 2;
++
++ port = &this->port;
++ port->info_all = SPA_PORT_CHANGE_MASK_FLAGS |
++ SPA_PORT_CHANGE_MASK_PARAMS;
++ port->info = SPA_PORT_INFO_INIT();
++ port->info.flags = SPA_PORT_FLAG_CAN_USE_BUFFERS;
++ port->params[0] = SPA_PARAM_INFO(SPA_PARAM_EnumFormat, SPA_PARAM_INFO_READ);
++ port->params[1] = SPA_PARAM_INFO(SPA_PARAM_Meta, SPA_PARAM_INFO_READ);
++ port->params[2] = SPA_PARAM_INFO(SPA_PARAM_IO, SPA_PARAM_INFO_READ);
++ port->params[3] = SPA_PARAM_INFO(SPA_PARAM_Format, SPA_PARAM_INFO_WRITE);
++ port->params[4] = SPA_PARAM_INFO(SPA_PARAM_Buffers, 0);
++ port->info.params = port->params;
++ port->info.n_params = 5;
++ spa_list_init(&port->ready);
++
++ for (i = 0; info && i < info->n_items; i++) {
++ if (strcmp(info->items[i].key, "bluez5.transport") == 0)
++ sscanf(info->items[i].value, "%p", &this->transport);
++ }
++ if (this->transport == NULL) {
++ spa_log_error(this->log, "a transport is needed");
++ return -EINVAL;
++ }
++ spa_bt_transport_add_listener(this->transport,
++ &this->transport_listener, &transport_events, this);
++ this->sock_fd = -1;
++
++ this->timerfd = timerfd_create(CLOCK_MONOTONIC, TFD_CLOEXEC | TFD_NONBLOCK);
++
++ return 0;
++}
++
++static const struct spa_interface_info impl_interfaces[] = {
++ {SPA_TYPE_INTERFACE_Node,},
++};
++
++static int
++impl_enum_interface_info(const struct spa_handle_factory *factory,
++ const struct spa_interface_info **info, uint32_t *index)
++{
++ spa_return_val_if_fail(factory != NULL, -EINVAL);
++ spa_return_val_if_fail(info != NULL, -EINVAL);
++ spa_return_val_if_fail(index != NULL, -EINVAL);
++
++ switch (*index) {
++ case 0:
++ *info = &impl_interfaces[*index];
++ break;
++ default:
++ return 0;
++ }
++ (*index)++;
++ return 1;
++}
++
++static const struct spa_dict_item info_items[] = {
++ { "factory.author", "Wim Taymans <wim.taymans@gmail.com>" },
++ { "factory.description", "Play audio with the sco (hsp/hfp)" },
++};
++
++static const struct spa_dict info = SPA_DICT_INIT_ARRAY(info_items);
++
++struct spa_handle_factory spa_sco_sink_factory = {
++ SPA_VERSION_HANDLE_FACTORY,
++ NAME,
++ &info,
++ impl_get_size,
++ impl_init,
++ impl_enum_interface_info,
++};
+diff --git a/spa/plugins/bluez5/sco-source.c b/spa/plugins/bluez5/sco-source.c
+new file mode 100644
+index 00000000..ce83ee24
+--- /dev/null
++++ b/spa/plugins/bluez5/sco-source.c
+@@ -0,0 +1,1136 @@
++/* Spa SCO Source
++ *
++ * Copyright © 2018 Wim Taymans
++ * Copyright © 2019 Collabora Ltd.
++ *
++ * Permission is hereby granted, free of charge, to any person obtaining a
++ * copy of this software and associated documentation files (the "Software"),
++ * to deal in the Software without restriction, including without limitation
++ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
++ * and/or sell copies of the Software, and to permit persons to whom the
++ * Software is furnished to do so, subject to the following conditions:
++ *
++ * The above copyright notice and this permission notice (including the next
++ * paragraph) shall be included in all copies or substantial portions of the
++ * Software.
++ *
++ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
++ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
++ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
++ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
++ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
++ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
++ * DEALINGS IN THE SOFTWARE.
++ */
++
++#include <unistd.h>
++#include <stddef.h>
++#include <stdio.h>
++#include <time.h>
++#include <fcntl.h>
++#include <sys/types.h>
++#include <sys/socket.h>
++
++#include <spa/support/loop.h>
++#include <spa/support/log.h>
++#include <spa/utils/list.h>
++
++#include <spa/node/node.h>
++#include <spa/node/io.h>
++#include <spa/param/param.h>
++#include <spa/param/audio/format.h>
++#include <spa/param/audio/format-utils.h>
++#include <spa/pod/filter.h>
++
++#include "defs.h"
++
++struct props {
++ uint32_t min_latency;
++ uint32_t max_latency;
++};
++
++#define MAX_BUFFERS 32
++
++struct buffer {
++ uint32_t id;
++ unsigned int outstanding:1;
++ struct spa_buffer *buf;
++ struct spa_meta_header *h;
++ struct spa_list link;
++};
++
++struct port {
++ struct spa_audio_info current_format;
++ int frame_size;
++ unsigned int have_format:1;
++
++ uint64_t info_all;
++ struct spa_port_info info;
++ struct spa_io_buffers *io;
++ struct spa_param_info params[8];
++
++ struct buffer buffers[MAX_BUFFERS];
++ uint32_t n_buffers;
++
++ struct spa_list free;
++ struct spa_list ready;
++
++ size_t ready_offset;
++};
++
++struct impl {
++ struct spa_handle handle;
++ struct spa_node node;
++
++ struct spa_log *log;
++ struct spa_loop *main_loop;
++ struct spa_loop *data_loop;
++
++ struct spa_hook_list hooks;
++ struct spa_callbacks callbacks;
++
++ uint64_t info_all;
++ struct spa_node_info info;
++ struct spa_param_info params[8];
++ struct props props;
++
++ struct spa_bt_transport *transport;
++ struct spa_hook transport_listener;
++ int sock_fd;
++
++ struct port port;
++
++ unsigned int started:1;
++ unsigned int slaved:1;
++
++ struct spa_source source;
++
++ struct spa_io_clock *clock;
++ struct spa_io_position *position;
++
++ struct timespec now;
++ uint32_t sample_count;
++};
++
++#define NAME "sco-source"
++
++#define CHECK_PORT(this,d,p) ((d) == SPA_DIRECTION_OUTPUT && (p) == 0)
++
++static const uint32_t default_min_latency = 64;
++static const uint32_t default_max_latency = 256;
++
++static void reset_props(struct props *props)
++{
++ props->min_latency = default_min_latency;
++ props->max_latency = default_max_latency;
++}
++
++static int impl_node_enum_params(struct spa_node *node, int seq,
++ uint32_t id, uint32_t start, uint32_t num,
++ const struct spa_pod *filter)
++{
++ struct impl *this;
++ struct spa_pod *param;
++ struct spa_pod_builder b = { 0 };
++ uint8_t buffer[1024];
++ struct spa_result_node_params result;
++ uint32_t count = 0;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(num != 0, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ result.id = id;
++ result.next = start;
++ next:
++ result.index = result.next++;
++
++ spa_pod_builder_init(&b, buffer, sizeof(buffer));
++
++ switch (id) {
++ case SPA_PARAM_PropInfo:
++ {
++ struct props *p = &this->props;
++
++ switch (result.index) {
++ case 0:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_PropInfo, id,
++ SPA_PROP_INFO_id, SPA_POD_Id(SPA_PROP_minLatency),
++ SPA_PROP_INFO_name, SPA_POD_String("The minimum latency"),
++ SPA_PROP_INFO_type, SPA_POD_CHOICE_RANGE_Int(p->min_latency, 1, INT32_MAX));
++ break;
++ case 1:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_PropInfo, id,
++ SPA_PROP_INFO_id, SPA_POD_Id(SPA_PROP_maxLatency),
++ SPA_PROP_INFO_name, SPA_POD_String("The maximum latency"),
++ SPA_PROP_INFO_type, SPA_POD_CHOICE_RANGE_Int(p->max_latency, 1, INT32_MAX));
++ break;
++ default:
++ return 0;
++ }
++ break;
++ }
++ case SPA_PARAM_Props:
++ {
++ struct props *p = &this->props;
++
++ switch (result.index) {
++ case 0:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_Props, id,
++ SPA_PROP_minLatency, SPA_POD_Int(p->min_latency),
++ SPA_PROP_maxLatency, SPA_POD_Int(p->max_latency));
++ break;
++ default:
++ return 0;
++ }
++ break;
++ }
++ default:
++ return -ENOENT;
++ }
++
++ if (spa_pod_filter(&b, &result.param, param, filter) < 0)
++ goto next;
++
++ spa_node_emit_result(&this->hooks, seq, 0, &result);
++
++ if (++count != num)
++ goto next;
++
++ return 0;
++}
++
++static int do_reslave(struct spa_loop *loop,
++ bool async,
++ uint32_t seq,
++ const void *data,
++ size_t size,
++ void *user_data)
++{
++ return 0;
++}
++
++static inline bool is_slaved(struct impl *this)
++{
++ return this->position && this->clock && this->position->clock.id != this->clock->id;
++}
++
++static int impl_node_set_io(struct spa_node *node, uint32_t id, void *data, size_t size)
++{
++ struct impl *this;
++ bool slaved;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ switch (id) {
++ case SPA_IO_Clock:
++ this->clock = data;
++ break;
++ case SPA_IO_Position:
++ this->position = data;
++ break;
++ default:
++ return -ENOENT;
++ }
++
++ slaved = is_slaved(this);
++ if (this->started && slaved != this->slaved) {
++ spa_log_debug(this->log, "sco-source %p: reslave %d->%d", this, this->slaved, slaved);
++ this->slaved = slaved;
++ spa_loop_invoke(this->data_loop, do_reslave, 0, NULL, 0, true, this);
++ }
++ return 0;
++}
++
++static int impl_node_set_param(struct spa_node *node, uint32_t id, uint32_t flags,
++ const struct spa_pod *param)
++{
++ struct impl *this;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ switch (id) {
++ case SPA_PARAM_Props:
++ {
++ struct props *p = &this->props;
++
++ if (param == NULL) {
++ reset_props(p);
++ return 0;
++ }
++ spa_pod_parse_object(param,
++ SPA_TYPE_OBJECT_Props, NULL,
++ SPA_PROP_minLatency, SPA_POD_OPT_Int(&p->min_latency),
++ SPA_PROP_maxLatency, SPA_POD_OPT_Int(&p->max_latency));
++ break;
++ }
++ default:
++ return -ENOENT;
++ }
++
++ return 0;
++}
++
++static void reset_buffers(struct port *port)
++{
++ uint32_t i;
++
++ spa_list_init(&port->free);
++ spa_list_init(&port->ready);
++
++ for (i = 0; i < port->n_buffers; i++) {
++ struct buffer *b = &port->buffers[i];
++ spa_list_append(&port->free, &b->link);
++ b->outstanding = false;
++ }
++}
++
++static bool read_data(struct impl *this, uint8_t *data, uint32_t size, uint32_t *total_read) {
++ const uint32_t mtu_size = this->transport->read_mtu;
++ uint32_t local_total_read = 0;
++
++ /* TODO: For now we assume the size is always a mutliple of mtu_size */
++ while (local_total_read < (size - mtu_size)) {
++ const int bytes_read = read(this->sock_fd, data, mtu_size);
++ if (bytes_read == 0) {
++ /* Stop */
++ return false;
++ } else if (bytes_read < 0) {
++ /* Retry */
++ if (errno == EINTR)
++ continue;
++
++ /* Socked has no data so return total data read */
++ if (errno == EAGAIN || errno == EWOULDBLOCK)
++ goto done;
++
++ /* Print error and stop */
++ spa_log_error(this->log, "read error: %s", strerror(errno));
++ return false;
++ }
++
++ data += bytes_read;
++ local_total_read += bytes_read;
++ }
++
++done:
++ if (total_read)
++ *total_read = local_total_read;
++ return true;
++}
++
++static void sco_on_ready_read(struct spa_source *source)
++{
++ struct impl *this = source->data;
++ struct port *port = &this->port;
++ struct buffer *buffer;
++ struct spa_data *buffer_data;
++ uint32_t total_read;
++
++ /* update the current pts */
++ clock_gettime(CLOCK_MONOTONIC, &this->now);
++
++ /* check if we have a new buffer */
++ if (spa_list_is_empty(&port->free)) {
++ spa_log_warn(this->log, "waiting for buffer");
++ return;
++ }
++
++ /* get the buffer data */
++ buffer = spa_list_first(&port->free, struct buffer, link);
++ buffer_data = &buffer->buf->datas[0];
++ spa_assert(buffer_data->data);
++
++ /* read data */
++ if (!read_data(this, buffer_data->data, buffer_data->maxsize, &total_read))
++ goto stop;
++ if (total_read == 0)
++ return;
++
++ /* update the buffer offset, size and stride */
++ buffer_data->chunk->offset = 0;
++ buffer_data->chunk->size = total_read;
++ buffer_data->chunk->stride = port->frame_size;
++
++ /* update the sample count */
++ this->sample_count += buffer_data->chunk->size / port->frame_size;
++
++ /* remove the buffer from the free list and add it to the ready list */
++ spa_list_remove(&buffer->link);
++ buffer->outstanding = true;
++ spa_list_append(&port->ready, &buffer->link);
++
++ /* Notify we are ready for the next buffer */
++ spa_node_call_ready(&this->callbacks, SPA_STATUS_HAVE_BUFFER);
++
++ return;
++
++stop:
++ if (this->source.loop)
++ spa_loop_remove_source(this->data_loop, &this->source);
++}
++
++static int do_start(struct impl *this)
++{
++ int val;
++ bool do_accept;
++
++ /* Dont do anything if the node has already started */
++ if (this->started)
++ return 0;
++
++ /* Make sure the transport is valid */
++ spa_return_val_if_fail (this->transport != NULL, -EIO);
++
++ /* Do accept if Gateway; otherwise do connect for Head Unit */
++ do_accept = this->transport->profile & SPA_BT_PROFILE_HEADSET_AUDIO_GATEWAY;
++
++ /* acquire the socked fd (false -> connect | true -> accept) */
++ this->sock_fd = spa_bt_transport_acquire(this->transport, do_accept);
++ if (this->sock_fd < 0)
++ return -1;
++
++ /* Set the write MTU */
++ val = this->transport->write_mtu;
++ if (setsockopt(this->sock_fd, SOL_SOCKET, SO_SNDBUF, &val, sizeof(val)) < 0)
++ spa_log_warn(this->log, "sco-source %p: SO_SNDBUF %m", this);
++
++ /* Set the read MTU */
++ val = this->transport->read_mtu;
++ if (setsockopt(this->sock_fd, SOL_SOCKET, SO_RCVBUF, &val, sizeof(val)) < 0)
++ spa_log_warn(this->log, "sco-source %p: SO_RCVBUF %m", this);
++
++ /* Set the priority */
++ val = 6;
++ if (setsockopt(this->sock_fd, SOL_SOCKET, SO_PRIORITY, &val, sizeof(val)) < 0)
++ spa_log_warn(this->log, "SO_PRIORITY failed: %m");
++
++ /* Reset the buffers and sample count */
++ reset_buffers(&this->port);
++ this->sample_count = 0;
++
++ /* Add the ready read callback */
++ this->source.data = this;
++ this->source.fd = this->sock_fd;
++ this->source.func = sco_on_ready_read;
++ this->source.mask = SPA_IO_IN;
++ this->source.rmask = 0;
++ spa_loop_add_source(this->data_loop, &this->source);
++
++ /* Set the started flag */
++ this->started = true;
++
++ 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 impl *this = user_data;
++
++ if (this->source.loop)
++ spa_loop_remove_source(this->data_loop, &this->source);
++
++ return 0;
++}
++
++static int do_stop(struct impl *this)
++{
++ int res = 0;
++
++ if (!this->started)
++ return 0;
++
++ spa_log_debug(this->log, "sco-source %p: stop", this);
++
++ spa_loop_invoke(this->data_loop, do_remove_source, 0, NULL, 0, true, this);
++
++ this->started = false;
++
++ if (this->transport) {
++ /* Release the transport */
++ res = spa_bt_transport_release(this->transport);
++
++ /* Shutdown and close the socket */
++ shutdown(this->sock_fd, SHUT_RDWR);
++ close(this->sock_fd);
++ this->sock_fd = -1;
++ }
++
++ return res;
++}
++
++static int impl_node_send_command(struct spa_node *node, const struct spa_command *command)
++{
++ struct impl *this;
++ struct port *port;
++ int res;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(command != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++ port = &this->port;
++
++ switch (SPA_NODE_COMMAND_ID(command)) {
++ case SPA_NODE_COMMAND_Start:
++ if (!port->have_format)
++ return -EIO;
++ if (port->n_buffers == 0)
++ return -EIO;
++ if ((res = do_start(this)) < 0)
++ return res;
++ break;
++ case SPA_NODE_COMMAND_Pause:
++ if ((res = do_stop(this)) < 0)
++ return res;
++ break;
++ default:
++ return -ENOTSUP;
++ }
++ return 0;
++}
++
++static const struct spa_dict_item node_info_items[] = {
++ { "media.class", "Audio/Source" },
++ { "node.driver", "true" },
++};
++
++static void emit_node_info(struct impl *this, bool full)
++{
++ if (full)
++ this->info.change_mask = this->info_all;
++ if (this->info.change_mask) {
++ this->info.props = &SPA_DICT_INIT_ARRAY(node_info_items);
++ spa_node_emit_info(&this->hooks, &this->info);
++ this->info.change_mask = 0;
++ }
++}
++
++static void emit_port_info(struct impl *this, struct port *port, bool full)
++{
++ if (full)
++ port->info.change_mask = port->info_all;
++ if (port->info.change_mask) {
++ spa_node_emit_port_info(&this->hooks,
++ SPA_DIRECTION_OUTPUT, 0, &port->info);
++ port->info.change_mask = 0;
++ }
++}
++
++static int
++impl_node_add_listener(struct spa_node *node,
++ struct spa_hook *listener,
++ const struct spa_node_events *events,
++ void *data)
++{
++ struct impl *this;
++ struct spa_hook_list save;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++ spa_hook_list_isolate(&this->hooks, &save, listener, events, data);
++
++ emit_node_info(this, true);
++ emit_port_info(this, &this->port, true);
++
++ spa_hook_list_join(&this->hooks, &save);
++
++ return 0;
++}
++
++static int
++impl_node_set_callbacks(struct spa_node *node,
++ const struct spa_node_callbacks *callbacks,
++ void *data)
++{
++ struct impl *this;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ this->callbacks = SPA_CALLBACKS_INIT(callbacks, data);
++
++ return 0;
++}
++
++static int impl_node_add_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id,
++ const struct spa_dict *props)
++{
++ return -ENOTSUP;
++}
++
++static int impl_node_remove_port(struct spa_node *node, enum spa_direction direction, uint32_t port_id)
++{
++ return -ENOTSUP;
++}
++
++static int
++impl_node_port_enum_params(struct spa_node *node, int seq,
++ enum spa_direction direction, uint32_t port_id,
++ uint32_t id, uint32_t start, uint32_t num,
++ const struct spa_pod *filter)
++{
++
++ struct impl *this;
++ struct port *port;
++ struct spa_pod *param;
++ struct spa_pod_builder b = { 0 };
++ uint8_t buffer[1024];
++ struct spa_result_node_params result;
++ uint32_t count = 0;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(num != 0, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ result.id = id;
++ result.next = start;
++ next:
++ result.index = result.next++;
++
++ spa_pod_builder_init(&b, buffer, sizeof(buffer));
++
++ switch (id) {
++ case SPA_PARAM_EnumFormat:
++ if (result.index > 0)
++ return 0;
++
++ if (this->transport == NULL)
++ return -EIO;
++
++ /* set the info structure */
++ struct spa_audio_info_raw info = { 0, };
++ info.format = SPA_AUDIO_FORMAT_S16;
++ info.channels = 1;
++ info.position[0] = SPA_AUDIO_CHANNEL_MONO;
++
++ /* TODO: For now we only handle HSP profiles which has always CVSD format,
++ * but we eventually need to support HFP that can have both CVSD and MSBC formats */
++
++ /* CVSD format has a rate of 8kHz
++ * MSBC format has a rate of 16kHz */
++ info.rate = 8000;
++
++ /* build the param */
++ param = spa_format_audio_raw_build(&b, id, &info);
++ break;
++
++ case SPA_PARAM_Format:
++ if (!port->have_format)
++ return -EIO;
++ if (result.index > 0)
++ return 0;
++
++ param = spa_format_audio_raw_build(&b, id, &port->current_format.info.raw);
++ break;
++
++ case SPA_PARAM_Buffers:
++ if (!port->have_format)
++ return -EIO;
++ if (result.index > 0)
++ return 0;
++
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_ParamBuffers, id,
++ /* 8 buffers are enough to make sure we always have one available when decoding */
++ SPA_PARAM_BUFFERS_buffers, SPA_POD_CHOICE_RANGE_Int(8, 8, MAX_BUFFERS),
++ SPA_PARAM_BUFFERS_blocks, SPA_POD_Int(1),
++ SPA_PARAM_BUFFERS_size, SPA_POD_Int(this->props.max_latency * port->frame_size),
++ SPA_PARAM_BUFFERS_stride, SPA_POD_Int(port->frame_size),
++ SPA_PARAM_BUFFERS_align, SPA_POD_Int(16));
++ break;
++
++ case SPA_PARAM_Meta:
++ switch (result.index) {
++ case 0:
++ param = spa_pod_builder_add_object(&b,
++ SPA_TYPE_OBJECT_ParamMeta, id,
++ SPA_PARAM_META_type, SPA_POD_Id(SPA_META_Header),
++ SPA_PARAM_META_size, SPA_POD_Int(sizeof(struct spa_meta_header)));
++ break;
++ default:
++ return 0;
++ }
++ break;
++
++ default:
++ return -ENOENT;
++ }
++
++ /* TODO: why filer is != NULL when linking it with sco-sink? */
++ /* if filter is null sco-source cannot be linked with sco-sink,
++ * so for now we always pass NULL */
++ if (spa_pod_filter(&b, &result.param, param, NULL) < 0)
++ goto next;
++
++ spa_node_emit_result(&this->hooks, seq, 0, &result);
++
++ if (++count != num)
++ goto next;
++
++ return 0;
++}
++
++static int clear_buffers(struct impl *this, struct port *port)
++{
++ do_stop(this);
++ if (port->n_buffers > 0) {
++ spa_list_init(&port->free);
++ spa_list_init(&port->ready);
++ port->n_buffers = 0;
++ }
++ return 0;
++}
++
++static int port_set_format(struct impl *this, struct port *port,
++ uint32_t flags,
++ const struct spa_pod *format)
++{
++ int err;
++
++ if (format == NULL) {
++ spa_log_info(this->log, "clear format");
++ clear_buffers(this, port);
++ port->have_format = false;
++ } else {
++ struct spa_audio_info info = { 0 };
++
++ if ((err = spa_format_parse(format, &info.media_type, &info.media_subtype)) < 0)
++ return err;
++
++ if (info.media_type != SPA_MEDIA_TYPE_audio ||
++ info.media_subtype != SPA_MEDIA_SUBTYPE_raw)
++ return -EINVAL;
++
++ if (spa_format_audio_raw_parse(format, &info.info.raw) < 0)
++ return -EINVAL;
++
++ port->frame_size = info.info.raw.channels * 2;
++ port->current_format = info;
++ port->have_format = true;
++ }
++
++ port->info.change_mask |= SPA_PORT_CHANGE_MASK_PARAMS;
++ if (port->have_format) {
++ port->info.change_mask |= SPA_PORT_CHANGE_MASK_FLAGS;
++ port->info.flags = SPA_PORT_FLAG_CAN_USE_BUFFERS | SPA_PORT_FLAG_LIVE;
++ port->info.change_mask |= SPA_PORT_CHANGE_MASK_RATE;
++ port->info.rate = SPA_FRACTION(1, port->current_format.info.raw.rate);
++ port->params[3] = SPA_PARAM_INFO(SPA_PARAM_Format, SPA_PARAM_INFO_READWRITE);
++ port->params[4] = SPA_PARAM_INFO(SPA_PARAM_Buffers, SPA_PARAM_INFO_READ);
++ } else {
++ port->params[3] = SPA_PARAM_INFO(SPA_PARAM_Format, SPA_PARAM_INFO_WRITE);
++ port->params[4] = SPA_PARAM_INFO(SPA_PARAM_Buffers, 0);
++ }
++ emit_port_info(this, port, false);
++
++ return 0;
++}
++
++static int
++impl_node_port_set_param(struct spa_node *node,
++ enum spa_direction direction, uint32_t port_id,
++ uint32_t id, uint32_t flags,
++ const struct spa_pod *param)
++{
++ struct impl *this;
++ struct port *port;
++ int res;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(node, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ switch (id) {
++ case SPA_PARAM_Format:
++ res = port_set_format(this, port, flags, param);
++ break;
++ default:
++ res = -ENOENT;
++ break;
++ }
++ return res;
++}
++
++static int
++impl_node_port_use_buffers(struct spa_node *node,
++ enum spa_direction direction,
++ uint32_t port_id, struct spa_buffer **buffers, uint32_t n_buffers)
++{
++ struct impl *this;
++ struct port *port;
++ uint32_t i;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ spa_log_info(this->log, "use buffers %d", n_buffers);
++
++ if (!port->have_format)
++ return -EIO;
++
++ clear_buffers(this, port);
++
++ for (i = 0; i < n_buffers; i++) {
++ struct buffer *b = &port->buffers[i];
++ struct spa_data *d = buffers[i]->datas;
++
++ b->buf = buffers[i];
++ b->id = i;
++
++ b->h = spa_buffer_find_meta_data(buffers[i], SPA_META_Header, sizeof(*b->h));
++
++ if (!((d[0].type == SPA_DATA_MemFd ||
++ d[0].type == SPA_DATA_DmaBuf ||
++ d[0].type == SPA_DATA_MemPtr) && d[0].data != NULL)) {
++ spa_log_error(this->log, NAME " %p: need mapped memory", this);
++ return -EINVAL;
++ }
++ spa_list_append(&port->free, &b->link);
++ b->outstanding = false;
++ }
++ port->n_buffers = n_buffers;
++
++ return 0;
++}
++
++static int
++impl_node_port_alloc_buffers(struct spa_node *node,
++ enum spa_direction direction,
++ uint32_t port_id,
++ struct spa_pod **params,
++ uint32_t n_params,
++ struct spa_buffer **buffers,
++ uint32_t *n_buffers)
++{
++ struct impl *this;
++ struct port *port;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++ spa_return_val_if_fail(buffers != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ if (!port->have_format)
++ return -EIO;
++
++ return -ENOTSUP;
++}
++
++static int
++impl_node_port_set_io(struct spa_node *node,
++ enum spa_direction direction,
++ uint32_t port_id,
++ uint32_t id,
++ void *data, size_t size)
++{
++ struct impl *this;
++ struct port *port;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(CHECK_PORT(this, direction, port_id), -EINVAL);
++ port = &this->port;
++
++ switch (id) {
++ case SPA_IO_Buffers:
++ port->io = data;
++ break;
++ default:
++ return -ENOENT;
++ }
++ return 0;
++}
++
++static void recycle_buffer(struct impl *this, struct port *port, uint32_t buffer_id)
++{
++ struct buffer *b = &port->buffers[buffer_id];
++
++ if (b->outstanding) {
++ spa_log_trace(this->log, NAME " %p: recycle buffer %u", this, buffer_id);
++ spa_list_append(&port->free, &b->link);
++ b->outstanding = false;
++ }
++}
++
++static int impl_node_port_reuse_buffer(struct spa_node *node, uint32_t port_id, uint32_t buffer_id)
++{
++ struct impl *this;
++ struct port *port;
++
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++
++ spa_return_val_if_fail(port_id == 0, -EINVAL);
++ port = &this->port;
++
++ if (port->n_buffers == 0)
++ return -EIO;
++
++ if (buffer_id >= port->n_buffers)
++ return -EINVAL;
++
++ recycle_buffer(this, port, buffer_id);
++
++ return 0;
++}
++
++static int impl_node_process(struct spa_node *node)
++{
++ struct impl *this;
++ struct port *port;
++ struct spa_io_buffers *io;
++ struct buffer *b;
++
++ /* get IO */
++ spa_return_val_if_fail(node != NULL, -EINVAL);
++
++ this = SPA_CONTAINER_OF(node, struct impl, node);
++ port = &this->port;
++ io = port->io;
++ spa_return_val_if_fail(io != NULL, -EIO);
++
++ /* don't do anything if IO does not need a buffer */
++ if (io->status != SPA_STATUS_NEED_BUFFER)
++ return io->status;
++
++ /* Recycle previously played buffer */
++ if (io->buffer_id != SPA_ID_INVALID &&
++ io->buffer_id < port->n_buffers) {
++ spa_log_debug(this->log, "recycling buffer_id=%d", io->buffer_id);
++ recycle_buffer(this, port, io->buffer_id);
++ io->buffer_id = SPA_ID_INVALID;
++ }
++
++ /* Check if we have new buffers in the queue */
++ if (spa_list_is_empty(&port->ready))
++ return SPA_STATUS_HAVE_BUFFER;
++
++ /* Pop the new buffer from the queue */
++ b = spa_list_first(&port->ready, struct buffer, link);
++ spa_list_remove(&b->link);
++
++ /* Set the new buffer in IO to be played */
++ io->buffer_id = b->id;
++ io->status = SPA_STATUS_HAVE_BUFFER;
++
++ return SPA_STATUS_HAVE_BUFFER;
++}
++
++static const struct spa_node impl_node = {
++ SPA_VERSION_NODE,
++ .add_listener = impl_node_add_listener,
++ .set_callbacks = impl_node_set_callbacks,
++ .enum_params = impl_node_enum_params,
++ .set_param = impl_node_set_param,
++ .set_io = impl_node_set_io,
++ .send_command = impl_node_send_command,
++ .add_port = impl_node_add_port,
++ .remove_port = impl_node_remove_port,
++ .port_enum_params = impl_node_port_enum_params,
++ .port_set_param = impl_node_port_set_param,
++ .port_use_buffers = impl_node_port_use_buffers,
++ .port_alloc_buffers = impl_node_port_alloc_buffers,
++ .port_set_io = impl_node_port_set_io,
++ .port_reuse_buffer = impl_node_port_reuse_buffer,
++ .process = impl_node_process,
++};
++
++static void transport_destroy(void *data)
++{
++ struct impl *this = data;
++ spa_log_debug(this->log, "transport %p destroy", this->transport);
++ this->transport = NULL;
++}
++
++static const struct spa_bt_transport_events transport_events = {
++ SPA_VERSION_BT_TRANSPORT_EVENTS,
++ .destroy = transport_destroy,
++};
++
++static int impl_get_interface(struct spa_handle *handle, uint32_t type, void **interface)
++{
++ struct impl *this;
++
++ spa_return_val_if_fail(handle != NULL, -EINVAL);
++ spa_return_val_if_fail(interface != NULL, -EINVAL);
++
++ this = (struct impl *) handle;
++
++ if (type == SPA_TYPE_INTERFACE_Node)
++ *interface = &this->node;
++ else
++ return -ENOENT;
++
++ return 0;
++}
++
++static int impl_clear(struct spa_handle *handle)
++{
++ return 0;
++}
++
++static size_t
++impl_get_size(const struct spa_handle_factory *factory,
++ const struct spa_dict *params)
++{
++ return sizeof(struct impl);
++}
++
++static int
++impl_init(const struct spa_handle_factory *factory,
++ struct spa_handle *handle,
++ const struct spa_dict *info,
++ const struct spa_support *support,
++ uint32_t n_support)
++{
++ struct impl *this;
++ struct port *port;
++ uint32_t i;
++
++ spa_return_val_if_fail(factory != NULL, -EINVAL);
++ spa_return_val_if_fail(handle != NULL, -EINVAL);
++
++ handle->get_interface = impl_get_interface;
++ handle->clear = impl_clear;
++
++ this = (struct impl *) handle;
++
++ for (i = 0; i < n_support; i++) {
++ if (support[i].type == SPA_TYPE_INTERFACE_Log)
++ this->log = support[i].data;
++ else if (support[i].type == SPA_TYPE_INTERFACE_DataLoop)
++ this->data_loop = support[i].data;
++ else if (support[i].type == SPA_TYPE_INTERFACE_MainLoop)
++ this->main_loop = support[i].data;
++ }
++ if (this->data_loop == NULL) {
++ spa_log_error(this->log, "a data loop is needed");
++ return -EINVAL;
++ }
++ if (this->main_loop == NULL) {
++ spa_log_error(this->log, "a main loop is needed");
++ return -EINVAL;
++ }
++
++ this->node = impl_node;
++ spa_hook_list_init(&this->hooks);
++
++ reset_props(&this->props);
++
++ /* set the node info */
++ this->info_all = SPA_NODE_CHANGE_MASK_FLAGS |
++ SPA_NODE_CHANGE_MASK_PROPS |
++ SPA_NODE_CHANGE_MASK_PARAMS;
++ this->info = SPA_NODE_INFO_INIT();
++ this->info.flags = SPA_NODE_FLAG_RT;
++ this->params[0] = SPA_PARAM_INFO(SPA_PARAM_PropInfo, SPA_PARAM_INFO_READ);
++ this->params[1] = SPA_PARAM_INFO(SPA_PARAM_Props, SPA_PARAM_INFO_READWRITE);
++ this->info.params = this->params;
++ this->info.n_params = 2;
++
++ /* set the port info */
++ port = &this->port;
++ port->info_all = SPA_PORT_CHANGE_MASK_FLAGS |
++ SPA_PORT_CHANGE_MASK_PARAMS;
++ port->info = SPA_PORT_INFO_INIT();
++ port->info.change_mask = SPA_PORT_CHANGE_MASK_FLAGS;
++ port->info.flags = SPA_PORT_FLAG_CAN_USE_BUFFERS |
++ SPA_PORT_FLAG_LIVE |
++ SPA_PORT_FLAG_TERMINAL;
++ port->params[0] = SPA_PARAM_INFO(SPA_PARAM_EnumFormat, SPA_PARAM_INFO_READ);
++ port->params[1] = SPA_PARAM_INFO(SPA_PARAM_Meta, SPA_PARAM_INFO_READ);
++ port->params[2] = SPA_PARAM_INFO(SPA_PARAM_IO, SPA_PARAM_INFO_READ);
++ port->params[3] = SPA_PARAM_INFO(SPA_PARAM_Format, SPA_PARAM_INFO_WRITE);
++ port->params[4] = SPA_PARAM_INFO(SPA_PARAM_Buffers, 0);
++ port->info.params = port->params;
++ port->info.n_params = 5;
++
++ /* Init the buffer lists */
++ spa_list_init(&port->ready);
++ spa_list_init(&port->free);
++
++ for (i = 0; info && i < info->n_items; i++) {
++ if (strcmp(info->items[i].key, "bluez5.transport") == 0)
++ sscanf(info->items[i].value, "%p", &this->transport);
++ }
++ if (this->transport == NULL) {
++ spa_log_error(this->log, "a transport is needed");
++ return -EINVAL;
++ }
++ spa_bt_transport_add_listener(this->transport,
++ &this->transport_listener, &transport_events, this);
++ this->sock_fd = -1;
++
++ return 0;
++}
++
++static const struct spa_interface_info impl_interfaces[] = {
++ {SPA_TYPE_INTERFACE_Node,},
++};
++
++static int
++impl_enum_interface_info(const struct spa_handle_factory *factory,
++ const struct spa_interface_info **info, uint32_t *index)
++{
++ spa_return_val_if_fail(factory != NULL, -EINVAL);
++ spa_return_val_if_fail(info != NULL, -EINVAL);
++ spa_return_val_if_fail(index != NULL, -EINVAL);
++
++ switch (*index) {
++ case 0:
++ *info = &impl_interfaces[*index];
++ break;
++ default:
++ return 0;
++ }
++ (*index)++;
++ return 1;
++}
++
++static const struct spa_dict_item info_items[] = {
++ { "factory.author", "Collabora Ltd. <contact@collabora.com>" },
++ { "factory.description", "Capture bluetooth audio with sco (hsp/hfp)" },
++};
++
++static const struct spa_dict info = SPA_DICT_INIT_ARRAY(info_items);
++
++struct spa_handle_factory spa_sco_source_factory = {
++ SPA_VERSION_HANDLE_FACTORY,
++ NAME,
++ &info,
++ impl_get_size,
++ impl_init,
++ impl_enum_interface_info,
++};
+--
+2.23.0.rc1
+
Code Review / AGL / meta-agl-devel.git / commitdiff