|
3 | 3 | // Licensed under the Apache License, Version 2.0 (the "License"); |
4 | 4 | // you may not use this file except in compliance with the License. |
5 | 5 | // You may obtain a copy of the License at |
6 | | - |
| 6 | +// |
7 | 7 | // http://www.apache.org/licenses/LICENSE-2.0 |
8 | 8 | // |
9 | 9 | // Unless required by applicable law or agreed to in writing, software |
|
12 | 12 | // See the License for the specific language governing permissions and |
13 | 13 | // limitations under the License. |
14 | 14 |
|
15 | | -#include "esp32-hal-bt.h" |
16 | | - |
17 | | -#if SOC_BT_SUPPORTED |
18 | | -#ifdef CONFIG_BT_ENABLED |
| 15 | +#include "sdkconfig.h" |
| 16 | +#if defined(CONFIG_BT_ENABLED) && SOC_BT_SUPPORTED |
19 | 17 |
|
20 | 18 | #include "esp_bt.h" |
| 19 | +#include "esp_bt_main.h" |
| 20 | +#include "esp_bt_device.h" |
| 21 | +#include "esp32-hal-bt.h" |
| 22 | +#include "esp_log.h" |
21 | 23 |
|
22 | | -#ifdef CONFIG_BTDM_CONTROLLER_MODE_BTDM |
23 | | -#define BT_MODE ESP_BT_MODE_BTDM |
24 | | -#elif defined(CONFIG_BTDM_CONTROLLER_MODE_BR_EDR_ONLY) |
25 | | -#define BT_MODE ESP_BT_MODE_CLASSIC_BT |
26 | | -#else |
27 | | -#define BT_MODE ESP_BT_MODE_BLE |
28 | | -#endif |
| 24 | +static const char* TAG = "arduino-bt"; |
| 25 | +static bool _bt_initialized = false; |
| 26 | +static bool _bt_enabled = false; |
29 | 27 |
|
30 | | -bool btStarted() { |
31 | | - return (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_ENABLED); |
| 28 | +// Diese Implementierung überschreibt die schwache (weak) Version in esp32-hal-misc.c |
| 29 | +bool btInUse() { |
| 30 | + return _bt_initialized && _bt_enabled; |
32 | 31 | } |
33 | 32 |
|
34 | 33 | bool btStart() { |
35 | | - return btStartMode(BT_MODE); |
36 | | -} |
| 34 | + esp_err_t err; |
37 | 35 |
|
38 | | -bool btStartMode(bt_mode mode) { |
39 | | - esp_bt_mode_t esp_bt_mode; |
40 | | - esp_bt_controller_config_t cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT(); |
41 | | -#if CONFIG_IDF_TARGET_ESP32 |
42 | | - switch (mode) { |
43 | | - case BT_MODE_BLE: esp_bt_mode = ESP_BT_MODE_BLE; break; |
44 | | - case BT_MODE_CLASSIC_BT: esp_bt_mode = ESP_BT_MODE_CLASSIC_BT; break; |
45 | | - case BT_MODE_BTDM: esp_bt_mode = ESP_BT_MODE_BTDM; break; |
46 | | - default: esp_bt_mode = BT_MODE; break; |
47 | | - } |
48 | | - // esp_bt_controller_enable(MODE) This mode must be equal as the mode in “cfg” of esp_bt_controller_init(). |
49 | | - cfg.mode = esp_bt_mode; |
50 | | - if (cfg.mode == ESP_BT_MODE_CLASSIC_BT) { |
51 | | - esp_bt_controller_mem_release(ESP_BT_MODE_BLE); |
52 | | - } |
53 | | -#else |
54 | | - // other esp variants dont support BT-classic / DM. |
55 | | - esp_bt_mode = BT_MODE; |
56 | | -#endif |
| 36 | + if(_bt_enabled) { |
| 37 | + return true; |
| 38 | + } |
57 | 39 |
|
58 | | - if (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_ENABLED) { |
59 | | - return true; |
60 | | - } |
61 | | - esp_err_t ret; |
62 | | - if (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_IDLE) { |
63 | | - if ((ret = esp_bt_controller_init(&cfg)) != ESP_OK) { |
64 | | - log_e("initialize controller failed: %s", esp_err_to_name(ret)); |
65 | | - return false; |
| 40 | + if(!_bt_initialized) { |
| 41 | + esp_bt_controller_config_t bt_cfg = BT_CONTROLLER_INIT_CONFIG_DEFAULT(); |
| 42 | + |
| 43 | + err = esp_bt_controller_init(&bt_cfg); |
| 44 | + if(err != ESP_OK) { |
| 45 | + ESP_LOGE(TAG, "BT controller initialize failed: %s", esp_err_to_name(err)); |
| 46 | + return false; |
| 47 | + } |
| 48 | + |
| 49 | + _bt_initialized = true; |
| 50 | + } |
| 51 | + |
| 52 | + err = esp_bt_controller_enable(ESP_BT_MODE_BTDM); |
| 53 | + if(err != ESP_OK) { |
| 54 | + ESP_LOGE(TAG, "BT controller enable failed: %s", esp_err_to_name(err)); |
| 55 | + return false; |
| 56 | + } |
| 57 | + |
| 58 | + err = esp_bluedroid_init(); |
| 59 | + if(err != ESP_OK) { |
| 60 | + ESP_LOGE(TAG, "Bluedroid initialize failed: %s", esp_err_to_name(err)); |
| 61 | + esp_bt_controller_disable(); |
| 62 | + return false; |
66 | 63 | } |
67 | | - while (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_IDLE) {} |
68 | | - } |
69 | | - if (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_INITED) { |
70 | | - if ((ret = esp_bt_controller_enable(esp_bt_mode)) != ESP_OK) { |
71 | | - log_e("BT Enable mode=%d failed %s", BT_MODE, esp_err_to_name(ret)); |
72 | | - return false; |
| 64 | + |
| 65 | + err = esp_bluedroid_enable(); |
| 66 | + if(err != ESP_OK) { |
| 67 | + ESP_LOGE(TAG, "Bluedroid enable failed: %s", esp_err_to_name(err)); |
| 68 | + esp_bluedroid_deinit(); |
| 69 | + esp_bt_controller_disable(); |
| 70 | + return false; |
73 | 71 | } |
74 | | - } |
75 | | - if (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_ENABLED) { |
| 72 | + |
| 73 | + _bt_enabled = true; |
76 | 74 | return true; |
77 | | - } |
78 | | - log_e("BT Start failed"); |
79 | | - return false; |
80 | 75 | } |
81 | 76 |
|
82 | 77 | bool btStop() { |
83 | | - if (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_IDLE) { |
84 | | - return true; |
85 | | - } |
86 | | - if (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_ENABLED) { |
87 | | - if (esp_bt_controller_disable()) { |
88 | | - log_e("BT Disable failed"); |
89 | | - return false; |
90 | | - } |
91 | | - while (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_ENABLED); |
92 | | - } |
93 | | - if (esp_bt_controller_get_status() == ESP_BT_CONTROLLER_STATUS_INITED) { |
94 | | - if (esp_bt_controller_deinit()) { |
95 | | - log_e("BT deint failed"); |
96 | | - return false; |
| 78 | + esp_err_t err; |
| 79 | + |
| 80 | + if(!_bt_enabled) { |
| 81 | + return true; |
97 | 82 | } |
98 | | - vTaskDelay(1); |
99 | | - if (esp_bt_controller_get_status() != ESP_BT_CONTROLLER_STATUS_IDLE) { |
100 | | - return false; |
| 83 | + |
| 84 | + err = esp_bluedroid_disable(); |
| 85 | + if(err != ESP_OK) { |
| 86 | + ESP_LOGE(TAG, "Bluedroid disable failed: %s", esp_err_to_name(err)); |
| 87 | + return false; |
101 | 88 | } |
102 | | - return true; |
103 | | - } |
104 | | - log_e("BT Stop failed"); |
105 | | - return false; |
106 | | -} |
107 | 89 |
|
108 | | -#else // CONFIG_BT_ENABLED |
109 | | -bool btStarted() { |
110 | | - return false; |
111 | | -} |
| 90 | + err = esp_bluedroid_deinit(); |
| 91 | + if(err != ESP_OK) { |
| 92 | + ESP_LOGE(TAG, "Bluedroid deinitialize failed: %s", esp_err_to_name(err)); |
| 93 | + return false; |
| 94 | + } |
112 | 95 |
|
113 | | -bool btStart() { |
114 | | - return false; |
115 | | -} |
| 96 | + err = esp_bt_controller_disable(); |
| 97 | + if(err != ESP_OK) { |
| 98 | + ESP_LOGE(TAG, "BT controller disable failed: %s", esp_err_to_name(err)); |
| 99 | + return false; |
| 100 | + } |
116 | 101 |
|
117 | | -bool btStop() { |
118 | | - return false; |
| 102 | + _bt_enabled = false; |
| 103 | + return true; |
119 | 104 | } |
120 | 105 |
|
121 | | -#endif /* CONFIG_BT_ENABLED */ |
122 | | - |
123 | | -#endif /* SOC_BT_SUPPORTED */ |
| 106 | +#endif |
0 commit comments