nimble: tester: Implement GATT Server BTP Service (ID 0x07)

Work in progress.

apps/bttester/src/btp/btp.h

@@ -31,6 +31,7 @@
 #include "btp_gap.h"
 #include "btp_gatt.h"
 #include "btp_gattc.h"
+#include "btp_gatts.h"
 #include "btp_l2cap.h"
 #include "btp_mesh.h"
 #include "btp_pacs.h"
@@ -48,6 +49,7 @@
 #define BTP_SERVICE_ID_L2CAP    3
 #define BTP_SERVICE_ID_MESH    4
 #define BTP_SERVICE_ID_GATTC    6
+#define BTP_SERVICE_ID_GATTS    7
 #define BTP_SERVICE_ID_PACS     12
 #define BTP_SERVICE_ID_BAP     14
 

apps/bttester/src/btp/btp_gatts.h

@@ -0,0 +1,105 @@
+/*
+ * 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_gatts.h - Bluetooth tester GATT Server service headers */
+
+/*
+ * Copyright (c) 2015-2016 Intel Corporation
+ * Copyright (C) 2025 Codecoup
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ */
+
+/* GATT Server Service */
+#define BTP_GATT_HL_MAX_CNT            16
+struct btp_notify_hlv {
+    uint16_t handle;
+    uint16_t len;
+};
+/* commands */
+#define BTP_GATTS_READ_SUPPORTED_COMMANDS    0x01
+struct btp_gatts_read_supported_commands_rp {
+    uint8_t data[0];
+} __packed;
+
+/* TODO: this should be renamed to SVC_CHANGE? */
+#define BTP_GATTS_START_SERVER        0x07
+struct btp_gatts_start_server_rp {
+    uint16_t db_attr_off;
+    uint8_t db_attr_cnt;
+} __packed;
+
+#define BTP_GATTS_GET_ATTRIBUTES        0x02
+struct btp_gatts_get_attributes_cmd {
+    uint16_t start_handle;
+    uint16_t end_handle;
+    uint8_t type_length;
+    uint8_t type[0];
+} __packed;
+struct btp_gatts_get_attributes_rp {
+    uint8_t attrs_count;
+    uint8_t attrs[0];
+} __packed;
+struct btp_gatts_attr {
+    uint16_t handle;
+    uint8_t permission;
+    uint8_t type_length;
+    uint8_t type[0];
+} __packed;
+
+#define BTP_GATTS_GET_ATTRIBUTE_VALUE    0x03
+struct btp_gatts_get_attribute_value_cmd {
+    ble_addr_t address;
+    uint16_t handle;
+} __packed;
+struct btp_gatts_get_attribute_value_rp {
+    uint8_t att_response;
+    uint16_t value_length;
+    uint8_t value[0];
+} __packed;
+
+#define BTP_GATTS_SET_VALUE        0x04
+struct btp_gatts_set_value_cmd {
+    uint16_t attr_id;
+    uint16_t len;
+    uint8_t value[0];
+} __packed;
+
+#define BTP_GATTS_SET_MULT_VALUE        0x22
+struct btp_gatts_set_mult_val_cmd {
+    ble_addr_t address;
+    uint16_t count;
+    struct btp_notify_hlv hl[BTP_GATT_HL_MAX_CNT];
+    uint8_t value[0];
+} __packed;
+
+#define BTP_GATTS_CHANGE_DATABASE        0x05
+struct btp_gatts_change_database_cmd {
+    uint16_t start_handle;
+    uint16_t end_handle;
+    uint8_t visibility;
+} __packed;
+
+/* GATTS events */
+#define BTP_GATTS_EV_ATTR_VALUE_CHANGED    0x81
+struct btp_gatts_attr_value_changed_ev {
+    uint16_t handle;
+    uint16_t data_length;
+    uint8_t data[0];
+} __packed;

apps/bttester/src/btp/bttester.h

@@ -136,6 +136,10 @@ uint8_t
 tester_init_gatt_cl(void);
 uint8_t
 tester_unregister_gatt_cl(void);
+uint8_t
+tester_init_gatts(void);
+uint8_t
+tester_unregister_gatts(void);
 void
 gatt_svr_register_cb(struct ble_gatt_register_ctxt *ctxt, void *arg);
 

apps/bttester/src/btp_core.c

@@ -115,6 +115,9 @@ register_service(const void *cmd, uint16_t cmd_len,
     case BTP_SERVICE_ID_GATTC:
         status = tester_init_gatt_cl();
         break;
+    case BTP_SERVICE_ID_GATTS:
+        status = tester_init_gatts();
+        break;
     default:
         status = BTP_STATUS_FAILED;
         break;
@@ -164,6 +167,9 @@ unregister_service(const void *cmd, uint16_t cmd_len,
     case BTP_SERVICE_ID_GATTC:
         status = tester_unregister_gatt_cl();
         break;
+    case BTP_SERVICE_ID_GATTS:
+        status = tester_unregister_gatts();
+        break;
 #if MYNEWT_VAL(BLE_ISO_BROADCAST_SOURCE)
     case BTP_SERVICE_ID_BAP:
         status = tester_unregister_bap();

apps/bttester/src/btp_gap.c

@@ -1460,6 +1460,7 @@ gap_event_cb(struct ble_gap_event *event, void *arg)
                        event->subscribe.cur_notify,
                        event->subscribe.prev_indicate,
                        event->subscribe.cur_indicate);
+/* TODO: implement tester_gatts_subscribe_ev */
         tester_gatt_subscribe_ev(event->subscribe.conn_handle,
                                  event->subscribe.attr_handle,
                                  event->subscribe.reason,

apps/bttester/src/btp_gatt.c

@@ -1854,7 +1854,7 @@ get_attr_val(const void *cmd, uint16_t cmd_len,
     return status;
 }
 
-int
+static int
 notify_multiple(uint16_t conn_handle, void *arg)
 {
     struct notify_mult_cb_data *notify_data =