From d10371032844816b05eaf94156a27aa94c1604fb Mon Sep 17 00:00:00 2001
From: Szymon Czapracki <szymon.czapracki@codecoup.pl>
Date: Mon, 15 Apr 2024 14:56:19 +0200
Subject: [PATCH] Initial commit adding BASS in bttester

Adding BASS support in bttester
---
 apps/bttester/pkg.yml            |   2 +
 apps/bttester/src/btp/btp.h      |   1 +
 apps/bttester/src/btp/btp_bap.h  |  17 +-
 apps/bttester/src/btp/btp_bass.h |  37 +++++
 apps/bttester/src/btp/btp_gap.h  |  10 ++
 apps/bttester/src/btp/bttester.h |  10 +-
 apps/bttester/src/btp_bap.c      | 260 ++++++++++++++++++++++++++++++-
 apps/bttester/src/btp_bass.c     |  77 +++++++++
 apps/bttester/src/btp_core.c     |   2 +-
 apps/bttester/src/btp_gap.c      |  49 ++++++
 apps/bttester/syscfg.yml         |  16 +-
 11 files changed, 469 insertions(+), 12 deletions(-)
 create mode 100644 apps/bttester/src/btp/btp_bass.h
 create mode 100644 apps/bttester/src/btp_bass.c

diff --git a/apps/bttester/pkg.yml b/apps/bttester/pkg.yml
index e763185fe5..0972cb7a2b 100644
--- a/apps/bttester/pkg.yml
+++ b/apps/bttester/pkg.yml
@@ -32,10 +32,12 @@ pkg.deps:
     - "@apache-mynewt-core/sys/stats"
     - "@apache-mynewt-core/sys/shell"
     - "@apache-mynewt-nimble/nimble/host"
+    - "@apache-mynewt-nimble/nimble/host/audio"
     - "@apache-mynewt-nimble/nimble/host/util"
     - "@apache-mynewt-nimble/nimble/host/services/gap"
     - "@apache-mynewt-nimble/nimble/host/services/gatt"
     - "@apache-mynewt-nimble/nimble/host/services/dis"
+    - "@apache-mynewt-nimble/nimble/host/audio/services/bass"
     - "@apache-mynewt-nimble/nimble/host/store/config"
     - "@apache-mynewt-core/hw/drivers/uart"
     - "@apache-mynewt-core/hw/drivers/rtt"
diff --git a/apps/bttester/src/btp/btp.h b/apps/bttester/src/btp/btp.h
index 4403a16038..a4ae5225a2 100644
--- a/apps/bttester/src/btp/btp.h
+++ b/apps/bttester/src/btp/btp.h
@@ -48,6 +48,7 @@
 #define BTP_SERVICE_ID_MESH    4
 #define BTP_SERVICE_ID_GATTC    6
 #define BTP_SERVICE_ID_BAP     14
+#define BTP_SERVICE_ID_BASS     14
 
 #define BTP_SERVICE_ID_MAX    BTP_SERVICE_ID_BAP
 
diff --git a/apps/bttester/src/btp/btp_bap.h b/apps/bttester/src/btp/btp_bap.h
index f25ab14748..e5a1d8ee18 100644
--- a/apps/bttester/src/btp/btp_bap.h
+++ b/apps/bttester/src/btp/btp_bap.h
@@ -84,11 +84,26 @@ struct bap_bap_broadcast_source_stop_cmd {
 } __packed;
 
 #define BTP_BAP_BROADCAST_SINK_SETUP            0x0a
+
+#define BTP_BAP_BROADCAST_SINK_STOP             0x0f
+struct btp_bap_broadcast_sink_stop_cmd {
+    uint8_t addr_type;
+    ble_addr_t address;
+    uint8_t broadcast_id[3];
+} __packed;
+
+#define BTP_BAP_SET_BROADCAST_CODE              0x17
+struct btp_bap_set_broadcast_code_cmd {
+    uint8_t bd_addr_type;
+    ble_addr_t addr;
+    uint8_t source_id;
+    uint8_t broadcast_code[16];
+} __packed;
+
 #define BTP_BAP_BROADCAST_SINK_RELEASE          0x0b
 #define BTP_BAP_BROADCAST_SCAN_START            0x0c
 #define BTP_BAP_BROADCAST_SCAN_STOP             0x0d
 #define BTP_BAP_BROADCAST_SINK_SYNC             0x0e
-#define BTP_BAP_BROADCAST_SINK_STOP             0x0f
 #define BTP_BAP_BROADCAST_SINK_BIS_SYNC         0x10
 #define BTP_BAP_DISCOVER_SCAN_DELEGATOR         0x11
 #define BTP_BAP_BROADCAST_ASSISTANT_SCAN_START  0x12
diff --git a/apps/bttester/src/btp/btp_bass.h b/apps/bttester/src/btp/btp_bass.h
new file mode 100644
index 0000000000..da38ca722c
--- /dev/null
+++ b/apps/bttester/src/btp/btp_bass.h
@@ -0,0 +1,37 @@
+/*
+ * Licensed to the Apache Software Foundation (ASF) under one
+ * or more contributor license agreements.  See the NOTICE file
+ * distributed with this work for additional information
+ * regarding copyright ownership.  The ASF licenses this file
+ * to you under the Apache License, Version 2.0 (the
+ * "License"); you may not use this file except in compliance
+ * with the License.  You may obtain a copy of the License at
+ *
+ *  http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing,
+ * software distributed under the License is distributed on an
+ * "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
+ * KIND, either express or implied.  See the License for the
+ * specific language governing permissions and limitations
+ * under the License.
+ */
+
+#ifndef H_BTP_BASS_
+#define H_BTP_BASS_
+
+#include "nimble/ble.h"
+#include <stdint.h>
+
+#ifndef __packed
+#define __packed    __attribute__((__packed__))
+#endif
+
+/* BAS Service */
+/* commands */
+#define BTP_BASS_READ_SUPPORTED_COMMANDS         0x01
+struct btp_bass_read_supported_commands_rp {
+    uint8_t data[0];
+} __packed;
+
+#endif /* H_BTP_BASS_ */
diff --git a/apps/bttester/src/btp/btp_gap.h b/apps/bttester/src/btp/btp_gap.h
index 2a87b12930..9c691878f2 100644
--- a/apps/bttester/src/btp/btp_gap.h
+++ b/apps/bttester/src/btp/btp_gap.h
@@ -70,6 +70,7 @@ struct btp_gap_read_controller_index_list_rp {
 #define BTP_GAP_SETTINGS_PRIVACY        13
 #define BTP_GAP_SETTINGS_CONTROLLER_CONFIG    14
 #define BTP_GAP_SETTINGS_STATIC_ADDRESS    15
+#define BTP_GAP_SETTINGS_EXTENDED_ADVERTISING 17
 #define BTP_GAP_SETTINGS_PERIODIC_ADVERTISING 18
 
 #define BTP_GAP_READ_CONTROLLER_INFO    0x03
@@ -258,6 +259,15 @@ struct btp_gap_set_filter_accept_list_cmd {
     ble_addr_t addrs[];
 } __packed;
 
+#define GAP_SET_EXT_ADV    0x21
+struct btp_gap_set_ext_advertising_cmd {
+    uint8_t setting;
+} __packed;
+
+struct btp_gap_set_ext_advertising_rp {
+    uint32_t current_settings;
+} __packed;
+
 #define GAP_PADV_CONFIGURE        0x22
 struct gap_periodic_adv_configure_cmd {
     uint8_t flags;
diff --git a/apps/bttester/src/btp/bttester.h b/apps/bttester/src/btp/bttester.h
index 7cb82b5c92..0b595ecdfc 100644
--- a/apps/bttester/src/btp/bttester.h
+++ b/apps/bttester/src/btp/bttester.h
@@ -142,12 +142,16 @@ gatt_svr_register_cb(struct ble_gatt_register_ctxt *ctxt, void *arg);
 int
 gatt_svr_init(void);
 
-#if MYNEWT_VAL(BLE_ISO_BROADCAST_SOURCE)
+#if MYNEWT_VAL(BLE_AUDIO)
 uint8_t
 tester_init_bap(void);
 uint8_t
 tester_unregister_bap(void);
-#endif /* MYNEWT_VAL(BLE_ISO_BROADCAST_SOURCE) */
+uint8_t
+tester_init_bass(void);
+uint8_t
+tester_unregister_bass(void);
+#endif /* MYNEWT_VAL(BLE_AUDIO) */
 
-#endif /* __BTTESTER_H__ */
+#endif /* __BTTESTER_H */
 
diff --git a/apps/bttester/src/btp_bap.c b/apps/bttester/src/btp_bap.c
index 5a2d06c811..f778c951de 100644
--- a/apps/bttester/src/btp_bap.c
+++ b/apps/bttester/src/btp_bap.c
@@ -19,22 +19,24 @@
 
 /* btp_bap.c - Bluetooth Basic Audio Profile Tester */
 
+#include "btp/bttester.h"
 #include "syscfg/syscfg.h"
+#include <string.h>
+
 
 #if MYNEWT_VAL(BLE_ISO_BROADCAST_SOURCE)
 
 #include "btp/btp_bap.h"
 
-
 #include "btp/btp.h"
 #include "console/console.h"
 
-#include "nimble/ble.h"
 #include "host/ble_hs.h"
 #include "host/util/util.h"
 #include "math.h"
 
 #include "audio/ble_audio_broadcast_source.h"
+#include "audio/ble_audio_broadcast_sink.h"
 #include "audio/ble_audio.h"
 #include "host/ble_iso.h"
 
@@ -42,6 +44,14 @@
 
 static struct ble_audio_big_subgroup big_subgroup;
 
+static struct broadcast_sink {
+    uint8_t bd_addr_type;
+    ble_addr_t addr;
+    uint8_t source_id;
+    uint8_t broadcast_code[BLE_AUDIO_BROADCAST_CODE_SIZE];
+} sinks[MYNEWT_VAL(BLE_AUDIO_BROADCAST_SINK_MAX)];
+
+static uint8_t sink_num = 0;
 static uint8_t id_addr_type;
 static uint8_t audio_data[155];
 static uint16_t max_sdu;
@@ -319,6 +329,74 @@ broadcast_source_start(const void *cmd, uint16_t cmd_len, void *rsp,
     return BTP_STATUS_SUCCESS;
 }
 
+static uint8_t
+broadcast_code_set(const void *cmd, uint16_t cmd_len, void *rsp,
+                   uint16_t *rsp_len)
+{
+    int i;
+    const struct btp_bap_set_broadcast_code_cmd *cp = cmd;
+
+    sinks[sink_num].addr = cp->addr;
+    sinks[sink_num].bd_addr_type = cp->bd_addr_type;
+    sinks[sink_num].source_id = cp->source_id;
+
+    for (i = 0; i < BLE_AUDIO_BROADCAST_CODE_SIZE; i++) {
+        sinks[sink_num].broadcast_code[i] = cp->broadcast_code[i];
+    }
+
+    sink_num++;
+
+    return BTP_STATUS_SUCCESS;
+}
+
+static uint8_t
+broadcast_sink_setup(const void *cmd, uint16_t cmd_len, void *rsp,
+                     uint16_t *rsp_len)
+{
+    int rc, i;
+    struct ble_audio_broadcast_sink_add_params params = {0};
+
+    for (i = 0; i < sink_num; i++) {
+        memcpy(params.broadcast_code, sinks[i].broadcast_code,
+               BLE_AUDIO_BROADCAST_CODE_SIZE);
+        params.broadcast_code_is_valid = true;
+        rc = ble_audio_broadcast_sink_start(sinks[i].source_id, &params);
+        if (rc) {
+            return BTP_STATUS_FAILED;
+        }
+    }
+
+    return BTP_STATUS_SUCCESS;
+}
+
+static int
+scan_delegator_receive_state_foreach_fn(struct ble_audio_scan_delegator_receive_state_entry *entry,
+                                        void *addr)
+{
+    if (ble_addr_cmp(addr, &entry->source_desc.addr)) {
+        ble_audio_broadcast_sink_stop(entry->source_id);
+    }
+
+    return 0;
+}
+
+static uint8_t
+broadcast_sink_stop(const void *cmd, uint16_t cmd_len, void *rsp,
+                    uint16_t *rsp_len)
+{
+    ble_addr_t addr;
+    const struct btp_bap_broadcast_sink_stop_cmd *cp = cmd;
+    uint8_t broadcast_to_stop[BLE_AUDIO_BROADCAST_CODE_SIZE];
+
+    memcpy(broadcast_to_stop, cp->broadcast_id, BLE_AUDIO_BROADCAST_CODE_SIZE);
+    addr = cp->address;
+
+    ble_audio_scan_delegator_receive_state_foreach(scan_delegator_receive_state_foreach_fn,
+                                                   &addr);
+
+    return BTP_STATUS_SUCCESS;
+}
+
 static uint8_t
 broadcast_source_stop(const void *cmd, uint16_t cmd_len, void *rsp,
                       uint16_t *rsp_len)
@@ -371,8 +449,169 @@ static const struct btp_handler handlers[] = {
         .expect_len = sizeof(struct bap_bap_broadcast_source_stop_cmd),
         .func = broadcast_source_stop,
     },
+    {
+        .opcode = BTP_BAP_SET_BROADCAST_CODE,
+        .index = BTP_INDEX,
+        .expect_len = sizeof(struct btp_bap_set_broadcast_code_cmd),
+        .func = broadcast_code_set,
+    },
+    {
+        .opcode = BTP_BAP_BROADCAST_SINK_SETUP,
+        .index = BTP_INDEX,
+        .expect_len = 0,
+        .func = broadcast_sink_setup,
+    },
+    {
+        .opcode = BTP_BAP_BROADCAST_SINK_STOP,
+        .index = BTP_INDEX,
+        .expect_len = sizeof(struct btp_bap_broadcast_sink_stop_cmd),
+        .func = broadcast_sink_stop,
+    },
 };
 
+#define BROADCAST_SINK_PA_SYNC_TIMEOUT_DEFAULT  0x07D0
+
+static int
+broadcast_sink_pa_sync_params_get(struct ble_gap_periodic_sync_params *params)
+{
+    params->skip = 0;
+    params->sync_timeout = BROADCAST_SINK_PA_SYNC_TIMEOUT_DEFAULT;
+    params->reports_disabled = false;
+
+    return 0;
+}
+
+static int
+broadcast_sink_disc_start(const struct ble_gap_ext_disc_params *params)
+{
+    uint8_t own_addr_type;
+    int rc;
+
+    /* Figure out address to use while scanning. */
+    rc = ble_hs_id_infer_auto(0, &own_addr_type);
+    if (rc != 0) {
+        console_printf("determining own address type failed (%d)", rc);
+        assert(0);
+    }
+
+    rc = ble_gap_ext_disc(own_addr_type, 0, 0, 0, 0, 0, params, NULL, NULL, NULL);
+    if (rc != 0) {
+        console_printf("ext disc failed (%d)", rc);
+    }
+
+    return rc;
+}
+
+static int
+broadcast_sink_disc_stop(void)
+{
+    int rc;
+
+    rc = ble_gap_disc_cancel();
+    if (rc != 0) {
+        console_printf("disc cancel failed (%d)", rc);
+    }
+
+    return rc;
+}
+
+static int
+broadcast_sink_action_fn(struct ble_audio_broadcast_sink_action *action, void *arg)
+{
+    switch (action->type) {
+    case BLE_AUDIO_BROADCAST_SINK_ACTION_PA_SYNC:
+        return broadcast_sink_pa_sync_params_get(action->pa_sync.out_params);
+    case BLE_AUDIO_BROADCAST_SINK_ACTION_BIG_SYNC:
+        break;
+    case BLE_AUDIO_BROADCAST_SINK_ACTION_BIS_SYNC:
+        return 0;
+    case BLE_AUDIO_BROADCAST_SINK_ACTION_DISC_START:
+        return broadcast_sink_disc_start(action->disc_start.params_preferred);
+    case BLE_AUDIO_BROADCAST_SINK_ACTION_DISC_STOP:
+        return broadcast_sink_disc_stop();
+    default:
+        assert(false);
+        return BLE_HS_ENOTSUP;
+    }
+
+    return 0;
+}
+
+static int
+broadcast_sink_audio_event_handler(struct ble_audio_event *event, void *arg)
+{
+    switch (event->type) {
+    case BLE_AUDIO_EVENT_BROADCAST_SINK_PA_SYNC_STATE:
+        console_printf("source_id=0x%02x PA sync: %s\n",
+                       event->broadcast_sink_pa_sync_state.source_id,
+                       ble_audio_broadcast_sink_sync_state_str(
+                               event->broadcast_sink_pa_sync_state.state));
+        break;
+    case BLE_AUDIO_EVENT_BROADCAST_SINK_BIS_SYNC_STATE:
+        console_printf("source_id=0x%02x bis_index=0x%02x BIS sync: %s\n",
+                       event->broadcast_sink_bis_sync_state.source_id,
+                       event->broadcast_sink_bis_sync_state.bis_index,
+                       ble_audio_broadcast_sink_sync_state_str(
+                               event->broadcast_sink_bis_sync_state.state));
+        if (event->broadcast_sink_bis_sync_state.state ==
+            BLE_AUDIO_BROADCAST_SINK_SYNC_STATE_ESTABLISHED) {
+            console_printf("conn_handle=0x%04x\n",
+                           event->broadcast_sink_bis_sync_state.conn_handle);
+        }
+        break;
+    default:
+        break;
+    }
+
+    return 0;
+}
+
+static int
+scan_delegator_pick_source_id_to_swap(uint8_t *out_source_id_to_swap)
+{
+    /* TODO: Add some logic here */
+    *out_source_id_to_swap = 0;
+
+    return 0;
+}
+
+static int
+scan_delegator_action_fn(struct ble_audio_scan_delegator_action *action, void *arg)
+{
+    switch (action->type) {
+    case BLE_AUDIO_SCAN_DELEGATOR_ACTION_SOURCE_ADD:
+        console_printf("Source Add:\nsource_id=%u\n", action->source_add.source_id);
+        if (action->source_add.out_source_id_to_swap == NULL) {
+            return 0;
+        }
+        return scan_delegator_pick_source_id_to_swap(action->source_add.out_source_id_to_swap);
+    case BLE_AUDIO_SCAN_DELEGATOR_ACTION_SOURCE_MODIFY:
+        console_printf("Source Modify:\nsource_id=%u\n", action->source_modify.source_id);
+        break;
+    case BLE_AUDIO_SCAN_DELEGATOR_ACTION_SOURCE_REMOVE:
+        console_printf("Source Remove:\nsource_id=%u\n", action->source_remove.source_id);
+        break;
+    default:
+        assert(false);
+        return BLE_HS_ENOTSUP;
+    }
+
+    return 0;
+}
+
+static int
+scan_delegator_audio_event_handler(struct ble_audio_event *event, void *arg)
+{
+    switch (event->type) {
+    case BLE_AUDIO_EVENT_BROADCAST_ANNOUNCEMENT:
+        break;
+    default:
+        break;
+    }
+
+    return 0;
+}
+
 uint8_t
 tester_init_bap(void)
 {
@@ -405,6 +644,23 @@ tester_init_bap(void)
         return BTP_STATUS_FAILED;
     }
 
+    static struct ble_audio_event_listener broadcast_sink_listener;
+
+    rc = ble_audio_broadcast_sink_cb_set(broadcast_sink_action_fn, NULL);
+    assert(rc == 0);
+
+    rc = ble_audio_event_listener_register(&broadcast_sink_listener,
+                                           broadcast_sink_audio_event_handler, NULL);
+
+    static struct ble_audio_event_listener scan_delegator_listener;
+
+    rc = ble_audio_scan_delegator_action_fn_set(scan_delegator_action_fn, NULL);
+    assert(rc == 0);
+
+    rc = ble_audio_event_listener_register(&scan_delegator_listener,
+                                           scan_delegator_audio_event_handler, NULL);
+    assert(rc == 0);
+
     tester_register_command_handlers(BTP_SERVICE_ID_BAP, handlers,
                                      ARRAY_SIZE(handlers));
 
diff --git a/apps/bttester/src/btp_bass.c b/apps/bttester/src/btp_bass.c
new file mode 100644
index 0000000000..8947232634
--- /dev/null
+++ b/apps/bttester/src/btp_bass.c
@@ -0,0 +1,77 @@
+/*
+ * Licensed to the Apache Software Foundation (ASF) under one
+ * or more contributor license agreements.  See the NOTICE file
+ * distributed with this work for additional information
+ * regarding copyright ownership.  The ASF licenses this file
+ * to you under the Apache License, Version 2.0 (the
+ * "License"); you may not use this file except in compliance
+ * with the License.  You may obtain a copy of the License at
+ *
+ *  http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing,
+ * software distributed under the License is distributed on an
+ * "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
+ * KIND, either express or implied.  See the License for the
+ * specific language governing permissions and limitations
+ * under the License.
+ */
+
+/* btp_bass.c - Bluetooth Broadcast Audio Stream Service Tester */
+
+#include "syscfg/syscfg.h"
+#include <stdint.h>
+
+#if MYNEWT_VAL(BLE_AUDIO)
+
+#include "btp/btp_bass.h"
+
+
+#include "btp/btp.h"
+#include "console/console.h"
+
+#include "nimble/ble.h"
+#include "host/ble_hs.h"
+#include "host/util/util.h"
+#include "math.h"
+
+#include "audio/ble_audio_broadcast_source.h"
+#include "services/bass/ble_audio_svc_bass.h"
+#include "audio/ble_audio.h"
+#include "host/ble_iso.h"
+
+#include "bsp/bsp.h"
+
+static uint8_t
+supported_commands(const void *cmd, uint16_t cmd_len,
+                   void *rsp, uint16_t *rsp_len)
+{
+    return BTP_STATUS_SUCCESS;
+}
+
+static const struct btp_handler handlers[] = {
+    {
+        .opcode = BTP_BASS_READ_SUPPORTED_COMMANDS,
+        .index = BTP_INDEX_NONE,
+        .expect_len = 0,
+        .func = supported_commands,
+    },
+};
+
+uint8_t
+tester_init_bass(void)
+{
+    tester_register_command_handlers(BTP_SERVICE_ID_BASS, handlers,
+                                     ARRAY_SIZE(handlers));
+
+    return BTP_STATUS_SUCCESS;
+}
+
+uint8_t
+tester_unregister_bass(void)
+{
+    return BTP_STATUS_SUCCESS;
+}
+
+#endif /* MYNEWT_VAL(BLE_AUDIO) */
+
diff --git a/apps/bttester/src/btp_core.c b/apps/bttester/src/btp_core.c
index a7b1878322..eeae816a9e 100644
--- a/apps/bttester/src/btp_core.c
+++ b/apps/bttester/src/btp_core.c
@@ -106,7 +106,7 @@ register_service(const void *cmd, uint16_t cmd_len,
     case BTP_SERVICE_ID_BAP:
         status = tester_init_bap();
         break;
-#endif /* MYNEWT_VAL(BLE_ISO_BROADCAST_SOURCE) */
+#endif /* MYNEWT_VAL(BLE_ISO_BROADCASTER) */
     case BTP_SERVICE_ID_GATTC:
         status = tester_init_gatt_cl();
         break;
diff --git a/apps/bttester/src/btp_gap.c b/apps/bttester/src/btp_gap.c
index d0aa7ce06e..921690a6e6 100644
--- a/apps/bttester/src/btp_gap.c
+++ b/apps/bttester/src/btp_gap.c
@@ -160,6 +160,7 @@ supported_commands(const void *cmd, uint16_t cmd_len,
 
     /* octet 4 */
 #if MYNEWT_VAL(BLE_PERIODIC_ADV)
+    tester_set_bit(rp->data, GAP_SET_EXT_ADV);
     tester_set_bit(rp->data, GAP_PADV_CONFIGURE);
     tester_set_bit(rp->data, GAP_PADV_START);
     tester_set_bit(rp->data, GAP_PADV_SET_DATA);
@@ -2000,6 +2001,47 @@ set_filter_accept_list(const void *cmd, uint16_t cmd_len,
     return BTP_STATUS_SUCCESS;
 }
 
+#if MYNEWT_VAL(BLE_EXT_ADV)
+static uint8_t
+set_ext_advertising(const void *cmd, uint16_t cmd_len,
+                    void *rsp, uint16_t *rsp_len)
+{
+    int rc, setting;
+    struct ble_gap_ext_adv_params ext_params = {0};
+    struct btp_gap_set_ext_advertising_rp *rp = rsp;
+    const struct btp_gap_set_ext_advertising_cmd *cp = cmd;
+
+    memset(&ext_params, 0, sizeof(ext_params));
+
+    ext_params.connectable = 0;
+    ext_params.scannable = 0;
+    ext_params.legacy_pdu = 0;
+    ext_params.anonymous = 0;
+    ext_params.own_addr_type = own_addr_type;
+    ext_params.primary_phy = BLE_HCI_LE_PHY_1M;
+    ext_params.secondary_phy = BLE_HCI_LE_PHY_1M;
+    ext_params.sid = 1;
+
+    setting = cp->setting;
+    if (!setting) {
+        ext_params.legacy_pdu = 1;
+    }
+
+    rc = ble_gap_ext_adv_configure(1, &ext_params, NULL, gap_event_cb, NULL);
+    if (rc) {
+        SYS_LOG_ERR("Failed to configure extended advertiser; rc=%d", rc);
+        return BTP_STATUS_FAILED;
+    }
+
+    current_settings |= BIT(BTP_GAP_SETTINGS_EXTENDED_ADVERTISING);
+
+    rp->current_settings = htole32(current_settings);
+    *rsp_len = sizeof(*rp);
+
+    return BTP_STATUS_SUCCESS;
+}
+#endif
+
 #if MYNEWT_VAL(BLE_PERIODIC_ADV)
 static uint8_t
 periodic_adv_configure(const void *cmd, uint16_t cmd_len,
@@ -2330,6 +2372,13 @@ static const struct btp_handler handlers[] = {
         .expect_len = BTP_HANDLER_LENGTH_VARIABLE,
         .func = set_filter_accept_list,
     },
+#if MYNEWT_VAL(BLE_EXT_ADV)
+    {
+        .opcode = GAP_SET_EXT_ADV,
+        .expect_len = sizeof(struct btp_gap_set_ext_advertising_cmd),
+        .func = set_ext_advertising,
+    },
+#endif /* BLE_EXT_ADV*/
 #if MYNEWT_VAL(BLE_PERIODIC_ADV)
     {
         .opcode = GAP_PADV_CONFIGURE,
diff --git a/apps/bttester/syscfg.yml b/apps/bttester/syscfg.yml
index 80c377a7c1..fea32fccd6 100644
--- a/apps/bttester/syscfg.yml
+++ b/apps/bttester/syscfg.yml
@@ -93,15 +93,23 @@ syscfg.vals:
 
     BLE_ISO: 1
     BLE_AUDIO: 1
+    BLE_AUDIO_BROADCAST_SINK: 1
+    BLE_AUDIO_BROADCAST_SINK_MAX: 2
+    BLE_PERIODIC_ADV_SYNC_TRANSFER: 1
+    BLE_PERIODIC_ADV_SYNC_BIGINFO_REPORTS: 1
     BLE_ROLE_BROADCASTER: 1
-    BLE_ISO_MAX_BISES: 1
-    BLE_ISO_MAX_BIGS: 1
+    BLE_ISO_BROADCAST_SOURCE: 1
+    BLE_ISO_BROADCAST_SINK: 1
+    BLE_ISO_MAX_BISES: 3
+    BLE_ISO_MAX_BIGS: 3
     BLE_EXT_ADV: 1
     BLE_PHY_2M: 1
     BLE_EXT_ADV_MAX_SIZE: 40
     BLE_PERIODIC_ADV: 1
     BLE_ISO_BROADCAST_SOURCE: 1
-    BLE_MULTI_ADV_INSTANCES: 1
+    BLE_MULTI_ADV_INSTANCES: 3
+    BLE_SVC_AUDIO_BASS_METADATA_MAX_SZ: 256
+    BLE_SVC_AUDIO_BASS_SUB_NUM_MAX: 10
 
     OS_MAIN_STACK_SIZE: 512
     SHELL_TASK: 0
@@ -163,5 +171,3 @@ syscfg.vals:
     BLE_MESH_TX_SEG_MSG_COUNT: 2
     BLE_MAX_CONNECTIONS: 8
 
-
-