nimble/host: Add support for enabling controller DTM

This allows to controll DTM from application.
2026-09-01 06:40:08 +00:00 · 2022-11-02 15:24:00 +01:00
parent 36406e05dc
commit 98a683e1b4
2 changed files with 120 additions and 0 deletions
@@ -0,0 +1,49 @@
+/*
+ * 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_BLE_DTM_
+#define H_BLE_DTM_
+
+#include <inttypes.h>
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+struct ble_dtm_rx_params {
+    uint8_t channel;
+    uint8_t phy;
+    uint8_t modulation_index;
+};
+
+int ble_dtm_rx_start(const struct ble_dtm_rx_params *params);
+
+struct ble_dtm_tx_params {
+    uint8_t channel;
+    uint8_t test_data_len;
+    uint8_t payload;
+    uint8_t phy;
+};
+int ble_dtm_tx_start(const struct ble_dtm_tx_params *params);
+
+int ble_dtm_stop(uint16_t *num_packets);
+
+#ifdef __cplusplus
+}
+#endif
+#endif
@@ -0,0 +1,71 @@
+/*
+ * 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.
+ */
+
+#include <nimble/hci_common.h>
+#include <host/ble_dtm.h>
+#include <os/endian.h>
+#include "ble_hs_hci_priv.h"
+
+int
+ble_dtm_rx_start(const struct ble_dtm_rx_params *params)
+{
+    struct ble_hci_le_rx_test_v2_cp cmd;
+
+    cmd.rx_chan = params->channel;
+    cmd.phy = params->phy;
+    cmd.index = params->modulation_index;
+
+    return ble_hs_hci_cmd_tx(BLE_HCI_OP(BLE_HCI_OGF_LE,
+                                        BLE_HCI_OCF_LE_RX_TEST_V2),
+                             &cmd, sizeof(cmd), NULL, 0);
+}
+
+int
+ble_dtm_tx_start(const struct ble_dtm_tx_params *params)
+{
+    struct ble_hci_le_tx_test_v2_cp cmd;
+
+    cmd.tx_chan = params->channel;
+    cmd.test_data_len = params->test_data_len;
+    cmd.payload = params->payload;
+    cmd.phy = params->phy;
+
+    return ble_hs_hci_cmd_tx(BLE_HCI_OP(BLE_HCI_OGF_LE,
+                                        BLE_HCI_OCF_LE_TX_TEST_V2),
+                             &cmd, sizeof(cmd), NULL, 0);
+}
+
+int
+ble_dtm_stop(uint16_t *num_packets)
+{
+    struct ble_hci_le_test_end_rp rsp;
+    int rc;
+
+    rc = ble_hs_hci_cmd_tx(BLE_HCI_OP(BLE_HCI_OGF_LE,
+                                      BLE_HCI_OCF_LE_TEST_END),
+                           NULL, 0, &rsp, sizeof(rsp));
+
+    if (rc) {
+        *num_packets = 0;
+    } else {
+        *num_packets = le16toh(rsp.num_packets);
+    }
+
+    return rc;
+}