Update non-esp setPower method to send command through the controller.

h2zero · Jun 14, 2024 · 3260c64 · 3260c64
1 parent dff8970
commit 3260c64
Showing 1 changed file with 13 additions and 1 deletion.
diff --git a/src/NimBLEDevice.cpp b/src/NimBLEDevice.cpp
@@ -428,7 +428,19 @@ int NimBLEDevice::getPower(esp_ble_power_type_t powerType) {
 #else
 
 void NimBLEDevice::setPower(int dbm) {
-    ble_phy_txpwr_set(dbm);
+    struct ble_hci_vs_set_tx_pwr_cp cmd;
+    struct ble_hci_vs_set_tx_pwr_rp rsp;
+    int rc;
+
+    cmd.tx_power = dbm;
+    rc = ble_hs_hci_send_vs_cmd(BLE_HCI_OCF_VS_SET_TX_PWR, &cmd, sizeof(cmd), &rsp, sizeof(rsp));
+    if (rc) {
+        NIMBLE_LOGE(LOG_TAG, "failed to set TX power, rc: %04x\n", rc);
+        return;
+    }
+
+    NIMBLE_LOGD(LOG_TAG, "TX power set to %d dBm\n", rsp.tx_power);
+    return;
 }