furi_hal_subghz.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689
  1. #include "furi_hal_subghz.h"
  2. #include "furi_hal_subghz_configs.h"
  3. #include <furi_hal_version.h>
  4. #include <furi_hal_rtc.h>
  5. #include <furi_hal_gpio.h>
  6. #include <furi_hal_spi.h>
  7. #include <furi_hal_interrupt.h>
  8. #include <furi_hal_resources.h>
  9. #include <stm32wbxx_ll_dma.h>
  10. #include <furi.h>
  11. #include <cc1101.h>
  12. #include <stdio.h>
  13. #define TAG "FuriHalSubGhz"
  14. typedef struct {
  15. volatile SubGhzState state;
  16. volatile SubGhzRegulation regulation;
  17. volatile FuriHalSubGhzPreset preset;
  18. } FuriHalSubGhz;
  19. volatile FuriHalSubGhz furi_hal_subghz = {
  20. .state = SubGhzStateInit,
  21. .regulation = SubGhzRegulationTxRx,
  22. .preset = FuriHalSubGhzPresetIDLE,
  23. };
  24. void furi_hal_subghz_init() {
  25. furi_assert(furi_hal_subghz.state == SubGhzStateInit);
  26. furi_hal_subghz.state = SubGhzStateIdle;
  27. furi_hal_subghz.preset = FuriHalSubGhzPresetIDLE;
  28. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  29. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  30. furi_hal_gpio_init(&FURI_HAL_SUBGHZ_TX_GPIO, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
  31. #endif
  32. // Reset
  33. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  34. cc1101_reset(&furi_hal_spi_bus_handle_subghz);
  35. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  36. // Prepare GD0 for power on self test
  37. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeInput, GpioPullNo, GpioSpeedLow);
  38. // GD0 low
  39. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG0, CC1101IocfgHW);
  40. while(furi_hal_gpio_read(&gpio_cc1101_g0) != false)
  41. ;
  42. // GD0 high
  43. cc1101_write_reg(
  44. &furi_hal_spi_bus_handle_subghz, CC1101_IOCFG0, CC1101IocfgHW | CC1101_IOCFG_INV);
  45. while(furi_hal_gpio_read(&gpio_cc1101_g0) != true)
  46. ;
  47. // Reset GD0 to floating state
  48. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  49. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  50. // RF switches
  51. furi_hal_gpio_init(&gpio_rf_sw_0, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
  52. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG2, CC1101IocfgHW);
  53. // Go to sleep
  54. cc1101_shutdown(&furi_hal_spi_bus_handle_subghz);
  55. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  56. FURI_LOG_I(TAG, "Init OK");
  57. }
  58. void furi_hal_subghz_sleep() {
  59. furi_assert(furi_hal_subghz.state == SubGhzStateIdle);
  60. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  61. cc1101_switch_to_idle(&furi_hal_spi_bus_handle_subghz);
  62. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  63. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  64. cc1101_shutdown(&furi_hal_spi_bus_handle_subghz);
  65. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  66. furi_hal_subghz.preset = FuriHalSubGhzPresetIDLE;
  67. }
  68. void furi_hal_subghz_dump_state() {
  69. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  70. printf(
  71. "[furi_hal_subghz] cc1101 chip %d, version %d\r\n",
  72. cc1101_get_partnumber(&furi_hal_spi_bus_handle_subghz),
  73. cc1101_get_version(&furi_hal_spi_bus_handle_subghz));
  74. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  75. }
  76. void furi_hal_subghz_load_preset(FuriHalSubGhzPreset preset) {
  77. if(preset == FuriHalSubGhzPresetOok650Async) {
  78. furi_hal_subghz_load_registers(furi_hal_subghz_preset_ook_650khz_async_regs);
  79. furi_hal_subghz_load_patable(furi_hal_subghz_preset_ook_async_patable);
  80. } else if(preset == FuriHalSubGhzPresetOok270Async) {
  81. furi_hal_subghz_load_registers(furi_hal_subghz_preset_ook_270khz_async_regs);
  82. furi_hal_subghz_load_patable(furi_hal_subghz_preset_ook_async_patable);
  83. } else if(preset == FuriHalSubGhzPreset2FSKDev238Async) {
  84. furi_hal_subghz_load_registers(furi_hal_subghz_preset_2fsk_dev2_38khz_async_regs);
  85. furi_hal_subghz_load_patable(furi_hal_subghz_preset_2fsk_async_patable);
  86. } else if(preset == FuriHalSubGhzPreset2FSKDev476Async) {
  87. furi_hal_subghz_load_registers(furi_hal_subghz_preset_2fsk_dev47_6khz_async_regs);
  88. furi_hal_subghz_load_patable(furi_hal_subghz_preset_2fsk_async_patable);
  89. } else if(preset == FuriHalSubGhzPresetMSK99_97KbAsync) {
  90. furi_hal_subghz_load_registers(furi_hal_subghz_preset_msk_99_97kb_async_regs);
  91. furi_hal_subghz_load_patable(furi_hal_subghz_preset_msk_async_patable);
  92. } else if(preset == FuriHalSubGhzPresetGFSK9_99KbAsync) {
  93. furi_hal_subghz_load_registers(furi_hal_subghz_preset_gfsk_9_99kb_async_regs);
  94. furi_hal_subghz_load_patable(furi_hal_subghz_preset_gfsk_async_patable);
  95. } else {
  96. furi_crash("SubGhz: Missing config.");
  97. }
  98. furi_hal_subghz.preset = preset;
  99. }
  100. void furi_hal_subghz_load_registers(const uint8_t data[][2]) {
  101. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  102. cc1101_reset(&furi_hal_spi_bus_handle_subghz);
  103. uint32_t i = 0;
  104. while(data[i][0]) {
  105. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, data[i][0], data[i][1]);
  106. i++;
  107. }
  108. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  109. }
  110. void furi_hal_subghz_load_patable(const uint8_t data[8]) {
  111. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  112. cc1101_set_pa_table(&furi_hal_spi_bus_handle_subghz, data);
  113. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  114. }
  115. void furi_hal_subghz_write_packet(const uint8_t* data, uint8_t size) {
  116. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  117. cc1101_flush_tx(&furi_hal_spi_bus_handle_subghz);
  118. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_FIFO, size);
  119. cc1101_write_fifo(&furi_hal_spi_bus_handle_subghz, data, size);
  120. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  121. }
  122. void furi_hal_subghz_flush_rx() {
  123. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  124. cc1101_flush_rx(&furi_hal_spi_bus_handle_subghz);
  125. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  126. }
  127. void furi_hal_subghz_flush_tx() {
  128. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  129. cc1101_flush_tx(&furi_hal_spi_bus_handle_subghz);
  130. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  131. }
  132. bool furi_hal_subghz_rx_pipe_not_empty() {
  133. CC1101RxBytes status[1];
  134. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  135. cc1101_read_reg(
  136. &furi_hal_spi_bus_handle_subghz, (CC1101_STATUS_RXBYTES) | CC1101_BURST, (uint8_t*)status);
  137. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  138. // TODO: you can add a buffer overflow flag if needed
  139. if(status->NUM_RXBYTES > 0) {
  140. return true;
  141. } else {
  142. return false;
  143. }
  144. }
  145. bool furi_hal_subghz_is_rx_data_crc_valid() {
  146. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  147. uint8_t data[1];
  148. cc1101_read_reg(&furi_hal_spi_bus_handle_subghz, CC1101_STATUS_LQI | CC1101_BURST, data);
  149. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  150. if(((data[0] >> 7) & 0x01)) {
  151. return true;
  152. } else {
  153. return false;
  154. }
  155. }
  156. void furi_hal_subghz_read_packet(uint8_t* data, uint8_t* size) {
  157. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  158. cc1101_read_fifo(&furi_hal_spi_bus_handle_subghz, data, size);
  159. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  160. }
  161. void furi_hal_subghz_shutdown() {
  162. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  163. // Reset and shutdown
  164. cc1101_shutdown(&furi_hal_spi_bus_handle_subghz);
  165. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  166. }
  167. void furi_hal_subghz_reset() {
  168. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  169. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  170. cc1101_switch_to_idle(&furi_hal_spi_bus_handle_subghz);
  171. cc1101_reset(&furi_hal_spi_bus_handle_subghz);
  172. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  173. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  174. }
  175. void furi_hal_subghz_idle() {
  176. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  177. cc1101_switch_to_idle(&furi_hal_spi_bus_handle_subghz);
  178. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  179. }
  180. void furi_hal_subghz_rx() {
  181. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  182. cc1101_switch_to_rx(&furi_hal_spi_bus_handle_subghz);
  183. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  184. }
  185. bool furi_hal_subghz_tx() {
  186. if(furi_hal_subghz.regulation != SubGhzRegulationTxRx) return false;
  187. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  188. cc1101_switch_to_tx(&furi_hal_spi_bus_handle_subghz);
  189. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  190. return true;
  191. }
  192. float furi_hal_subghz_get_rssi() {
  193. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  194. int32_t rssi_dec = cc1101_get_rssi(&furi_hal_spi_bus_handle_subghz);
  195. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  196. float rssi = rssi_dec;
  197. if(rssi_dec >= 128) {
  198. rssi = ((rssi - 256.0f) / 2.0f) - 74.0f;
  199. } else {
  200. rssi = (rssi / 2.0f) - 74.0f;
  201. }
  202. return rssi;
  203. }
  204. uint8_t furi_hal_subghz_get_lqi() {
  205. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  206. uint8_t data[1];
  207. cc1101_read_reg(&furi_hal_spi_bus_handle_subghz, CC1101_STATUS_LQI | CC1101_BURST, data);
  208. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  209. return data[0] & 0x7F;
  210. }
  211. bool furi_hal_subghz_is_frequency_valid(uint32_t value) {
  212. if(!(value >= 299999755 && value <= 348000335) &&
  213. !(value >= 386999938 && value <= 464000000) &&
  214. !(value >= 778999847 && value <= 928000000)) {
  215. return false;
  216. }
  217. return true;
  218. }
  219. uint32_t furi_hal_subghz_set_frequency_and_path(uint32_t value) {
  220. value = furi_hal_subghz_set_frequency(value);
  221. if(value >= 299999755 && value <= 348000335) {
  222. furi_hal_subghz_set_path(FuriHalSubGhzPath315);
  223. } else if(value >= 386999938 && value <= 464000000) {
  224. furi_hal_subghz_set_path(FuriHalSubGhzPath433);
  225. } else if(value >= 778999847 && value <= 928000000) {
  226. furi_hal_subghz_set_path(FuriHalSubGhzPath868);
  227. } else {
  228. furi_crash("SubGhz: Incorrect frequency during set.");
  229. }
  230. return value;
  231. }
  232. bool furi_hal_subghz_is_tx_allowed(uint32_t value) {
  233. //checking regional settings
  234. bool is_allowed = false;
  235. switch(furi_hal_version_get_hw_region()) {
  236. case FuriHalVersionRegionEuRu:
  237. //433,05..434,79; 868,15..868,55
  238. if(!(value >= 433050000 && value <= 434790000) &&
  239. !(value >= 868150000 && value <= 868550000)) {
  240. } else {
  241. is_allowed = true;
  242. }
  243. break;
  244. case FuriHalVersionRegionUsCaAu:
  245. //304,10..321,95; 433,05..434,79; 915,00..928,00
  246. if(!(value >= 304100000 && value <= 321950000) &&
  247. !(value >= 433050000 && value <= 434790000) &&
  248. !(value >= 915000000 && value <= 928000000)) {
  249. } else {
  250. if(furi_hal_rtc_is_flag_set(FuriHalRtcFlagDebug)) {
  251. if((value >= 304100000 && value <= 321950000) &&
  252. ((furi_hal_subghz.preset == FuriHalSubGhzPresetOok270Async) ||
  253. (furi_hal_subghz.preset == FuriHalSubGhzPresetOok650Async))) {
  254. furi_hal_subghz_load_patable(furi_hal_subghz_preset_ook_async_patable_au);
  255. }
  256. }
  257. is_allowed = true;
  258. }
  259. break;
  260. case FuriHalVersionRegionJp:
  261. //312,00..315,25; 920,50..923,50
  262. if(!(value >= 312000000 && value <= 315250000) &&
  263. !(value >= 920500000 && value <= 923500000)) {
  264. } else {
  265. is_allowed = true;
  266. }
  267. break;
  268. default:
  269. is_allowed = true;
  270. break;
  271. }
  272. return is_allowed;
  273. }
  274. uint32_t furi_hal_subghz_set_frequency(uint32_t value) {
  275. if(furi_hal_subghz_is_tx_allowed(value)) {
  276. furi_hal_subghz.regulation = SubGhzRegulationTxRx;
  277. } else {
  278. furi_hal_subghz.regulation = SubGhzRegulationOnlyRx;
  279. }
  280. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  281. uint32_t real_frequency = cc1101_set_frequency(&furi_hal_spi_bus_handle_subghz, value);
  282. cc1101_calibrate(&furi_hal_spi_bus_handle_subghz);
  283. while(true) {
  284. CC1101Status status = cc1101_get_status(&furi_hal_spi_bus_handle_subghz);
  285. if(status.STATE == CC1101StateIDLE) break;
  286. }
  287. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  288. return real_frequency;
  289. }
  290. void furi_hal_subghz_set_path(FuriHalSubGhzPath path) {
  291. furi_hal_spi_acquire(&furi_hal_spi_bus_handle_subghz);
  292. if(path == FuriHalSubGhzPath433) {
  293. furi_hal_gpio_write(&gpio_rf_sw_0, 0);
  294. cc1101_write_reg(
  295. &furi_hal_spi_bus_handle_subghz, CC1101_IOCFG2, CC1101IocfgHW | CC1101_IOCFG_INV);
  296. } else if(path == FuriHalSubGhzPath315) {
  297. furi_hal_gpio_write(&gpio_rf_sw_0, 1);
  298. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG2, CC1101IocfgHW);
  299. } else if(path == FuriHalSubGhzPath868) {
  300. furi_hal_gpio_write(&gpio_rf_sw_0, 1);
  301. cc1101_write_reg(
  302. &furi_hal_spi_bus_handle_subghz, CC1101_IOCFG2, CC1101IocfgHW | CC1101_IOCFG_INV);
  303. } else if(path == FuriHalSubGhzPathIsolate) {
  304. furi_hal_gpio_write(&gpio_rf_sw_0, 0);
  305. cc1101_write_reg(&furi_hal_spi_bus_handle_subghz, CC1101_IOCFG2, CC1101IocfgHW);
  306. } else {
  307. furi_crash("SubGhz: Incorrect path during set.");
  308. }
  309. furi_hal_spi_release(&furi_hal_spi_bus_handle_subghz);
  310. }
  311. volatile uint32_t furi_hal_subghz_capture_delta_duration = 0;
  312. volatile FuriHalSubGhzCaptureCallback furi_hal_subghz_capture_callback = NULL;
  313. volatile void* furi_hal_subghz_capture_callback_context = NULL;
  314. static void furi_hal_subghz_capture_ISR() {
  315. // Channel 1
  316. if(LL_TIM_IsActiveFlag_CC1(TIM2)) {
  317. LL_TIM_ClearFlag_CC1(TIM2);
  318. furi_hal_subghz_capture_delta_duration = LL_TIM_IC_GetCaptureCH1(TIM2);
  319. if(furi_hal_subghz_capture_callback) {
  320. furi_hal_subghz_capture_callback(
  321. true,
  322. furi_hal_subghz_capture_delta_duration,
  323. (void*)furi_hal_subghz_capture_callback_context);
  324. }
  325. }
  326. // Channel 2
  327. if(LL_TIM_IsActiveFlag_CC2(TIM2)) {
  328. LL_TIM_ClearFlag_CC2(TIM2);
  329. if(furi_hal_subghz_capture_callback) {
  330. furi_hal_subghz_capture_callback(
  331. false,
  332. LL_TIM_IC_GetCaptureCH2(TIM2) - furi_hal_subghz_capture_delta_duration,
  333. (void*)furi_hal_subghz_capture_callback_context);
  334. }
  335. }
  336. }
  337. void furi_hal_subghz_start_async_rx(FuriHalSubGhzCaptureCallback callback, void* context) {
  338. furi_assert(furi_hal_subghz.state == SubGhzStateIdle);
  339. furi_hal_subghz.state = SubGhzStateAsyncRx;
  340. furi_hal_subghz_capture_callback = callback;
  341. furi_hal_subghz_capture_callback_context = context;
  342. furi_hal_gpio_init_ex(
  343. &gpio_cc1101_g0, GpioModeAltFunctionPushPull, GpioPullNo, GpioSpeedLow, GpioAltFn1TIM2);
  344. // Timer: base
  345. LL_TIM_InitTypeDef TIM_InitStruct = {0};
  346. TIM_InitStruct.Prescaler = 64 - 1;
  347. TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
  348. TIM_InitStruct.Autoreload = 0x7FFFFFFE;
  349. TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV4;
  350. LL_TIM_Init(TIM2, &TIM_InitStruct);
  351. // Timer: advanced
  352. LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
  353. LL_TIM_DisableARRPreload(TIM2);
  354. LL_TIM_SetTriggerInput(TIM2, LL_TIM_TS_TI2FP2);
  355. LL_TIM_SetSlaveMode(TIM2, LL_TIM_SLAVEMODE_RESET);
  356. LL_TIM_SetTriggerOutput(TIM2, LL_TIM_TRGO_RESET);
  357. LL_TIM_EnableMasterSlaveMode(TIM2);
  358. LL_TIM_DisableDMAReq_TRIG(TIM2);
  359. LL_TIM_DisableIT_TRIG(TIM2);
  360. // Timer: channel 1 indirect
  361. LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ACTIVEINPUT_INDIRECTTI);
  362. LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ICPSC_DIV1);
  363. LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_POLARITY_FALLING);
  364. LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_FILTER_FDIV1);
  365. // Timer: channel 2 direct
  366. LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_ACTIVEINPUT_DIRECTTI);
  367. LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_ICPSC_DIV1);
  368. LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_IC_POLARITY_RISING);
  369. LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_IC_FILTER_FDIV32_N8);
  370. // ISR setup
  371. furi_hal_interrupt_set_isr(FuriHalInterruptIdTIM2, furi_hal_subghz_capture_ISR, NULL);
  372. // Interrupts and channels
  373. LL_TIM_EnableIT_CC1(TIM2);
  374. LL_TIM_EnableIT_CC2(TIM2);
  375. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH1);
  376. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH2);
  377. // Start timer
  378. LL_TIM_SetCounter(TIM2, 0);
  379. LL_TIM_EnableCounter(TIM2);
  380. // Switch to RX
  381. furi_hal_subghz_rx();
  382. }
  383. void furi_hal_subghz_stop_async_rx() {
  384. furi_assert(furi_hal_subghz.state == SubGhzStateAsyncRx);
  385. furi_hal_subghz.state = SubGhzStateIdle;
  386. // Shutdown radio
  387. furi_hal_subghz_idle();
  388. FURI_CRITICAL_ENTER();
  389. LL_TIM_DeInit(TIM2);
  390. FURI_CRITICAL_EXIT();
  391. furi_hal_interrupt_set_isr(FuriHalInterruptIdTIM2, NULL, NULL);
  392. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  393. }
  394. #define API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL (256)
  395. #define API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF (API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL / 2)
  396. #define API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME 333
  397. typedef struct {
  398. uint32_t* buffer;
  399. bool flip_flop;
  400. FuriHalSubGhzAsyncTxCallback callback;
  401. void* callback_context;
  402. uint64_t duty_high;
  403. uint64_t duty_low;
  404. } FuriHalSubGhzAsyncTx;
  405. static FuriHalSubGhzAsyncTx furi_hal_subghz_async_tx = {0};
  406. static void furi_hal_subghz_async_tx_refill(uint32_t* buffer, size_t samples) {
  407. while(samples > 0) {
  408. bool is_odd = samples % 2;
  409. LevelDuration ld =
  410. furi_hal_subghz_async_tx.callback(furi_hal_subghz_async_tx.callback_context);
  411. if(level_duration_is_wait(ld)) {
  412. return;
  413. } else if(level_duration_is_reset(ld)) {
  414. // One more even sample required to end at low level
  415. if(is_odd) {
  416. *buffer = API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  417. buffer++;
  418. samples--;
  419. furi_hal_subghz_async_tx.duty_low += API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  420. }
  421. break;
  422. } else {
  423. // Inject guard time if level is incorrect
  424. bool level = level_duration_get_level(ld);
  425. if(is_odd == level) {
  426. *buffer = API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  427. buffer++;
  428. samples--;
  429. if(!level) {
  430. furi_hal_subghz_async_tx.duty_high += API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  431. } else {
  432. furi_hal_subghz_async_tx.duty_low += API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  433. }
  434. // This code must be invoked only once: when encoder starts with low level.
  435. // Otherwise whole thing will crash.
  436. furi_check(samples > 0);
  437. }
  438. uint32_t duration = level_duration_get_duration(ld);
  439. furi_assert(duration > 0);
  440. *buffer = duration;
  441. buffer++;
  442. samples--;
  443. if(level) {
  444. furi_hal_subghz_async_tx.duty_high += duration;
  445. } else {
  446. furi_hal_subghz_async_tx.duty_low += duration;
  447. }
  448. }
  449. }
  450. memset(buffer, 0, samples * sizeof(uint32_t));
  451. }
  452. static void furi_hal_subghz_async_tx_dma_isr() {
  453. furi_assert(
  454. furi_hal_subghz.state == SubGhzStateAsyncTx ||
  455. furi_hal_subghz.state == SubGhzStateAsyncTxEnd ||
  456. furi_hal_subghz.state == SubGhzStateAsyncTxLast);
  457. if(LL_DMA_IsActiveFlag_HT1(DMA1)) {
  458. LL_DMA_ClearFlag_HT1(DMA1);
  459. furi_hal_subghz_async_tx_refill(
  460. furi_hal_subghz_async_tx.buffer, API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF);
  461. }
  462. if(LL_DMA_IsActiveFlag_TC1(DMA1)) {
  463. LL_DMA_ClearFlag_TC1(DMA1);
  464. furi_hal_subghz_async_tx_refill(
  465. furi_hal_subghz_async_tx.buffer + API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF,
  466. API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF);
  467. }
  468. }
  469. static void furi_hal_subghz_async_tx_timer_isr() {
  470. if(LL_TIM_IsActiveFlag_UPDATE(TIM2)) {
  471. LL_TIM_ClearFlag_UPDATE(TIM2);
  472. if(LL_TIM_GetAutoReload(TIM2) == 0) {
  473. if(furi_hal_subghz.state == SubGhzStateAsyncTx) {
  474. furi_hal_subghz.state = SubGhzStateAsyncTxLast;
  475. //forcibly pulls the pin to the ground so that there is no carrier
  476. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeInput, GpioPullDown, GpioSpeedLow);
  477. } else {
  478. furi_hal_subghz.state = SubGhzStateAsyncTxEnd;
  479. LL_TIM_DisableCounter(TIM2);
  480. }
  481. }
  482. }
  483. }
  484. bool furi_hal_subghz_start_async_tx(FuriHalSubGhzAsyncTxCallback callback, void* context) {
  485. furi_assert(furi_hal_subghz.state == SubGhzStateIdle);
  486. furi_assert(callback);
  487. //If transmission is prohibited by regional settings
  488. if(furi_hal_subghz.regulation != SubGhzRegulationTxRx) return false;
  489. furi_hal_subghz_async_tx.callback = callback;
  490. furi_hal_subghz_async_tx.callback_context = context;
  491. furi_hal_subghz.state = SubGhzStateAsyncTx;
  492. furi_hal_subghz_async_tx.duty_low = 0;
  493. furi_hal_subghz_async_tx.duty_high = 0;
  494. furi_hal_subghz_async_tx.buffer =
  495. malloc(API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL * sizeof(uint32_t));
  496. furi_hal_subghz_async_tx_refill(
  497. furi_hal_subghz_async_tx.buffer, API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL);
  498. // Connect CC1101_GD0 to TIM2 as output
  499. furi_hal_gpio_init_ex(
  500. &gpio_cc1101_g0, GpioModeAltFunctionPushPull, GpioPullDown, GpioSpeedLow, GpioAltFn1TIM2);
  501. // Configure DMA
  502. LL_DMA_InitTypeDef dma_config = {0};
  503. dma_config.PeriphOrM2MSrcAddress = (uint32_t) & (TIM2->ARR);
  504. dma_config.MemoryOrM2MDstAddress = (uint32_t)furi_hal_subghz_async_tx.buffer;
  505. dma_config.Direction = LL_DMA_DIRECTION_MEMORY_TO_PERIPH;
  506. dma_config.Mode = LL_DMA_MODE_CIRCULAR;
  507. dma_config.PeriphOrM2MSrcIncMode = LL_DMA_PERIPH_NOINCREMENT;
  508. dma_config.MemoryOrM2MDstIncMode = LL_DMA_MEMORY_INCREMENT;
  509. dma_config.PeriphOrM2MSrcDataSize = LL_DMA_PDATAALIGN_WORD;
  510. dma_config.MemoryOrM2MDstDataSize = LL_DMA_MDATAALIGN_WORD;
  511. dma_config.NbData = API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL;
  512. dma_config.PeriphRequest = LL_DMAMUX_REQ_TIM2_UP;
  513. dma_config.Priority = LL_DMA_MODE_NORMAL;
  514. LL_DMA_Init(DMA1, LL_DMA_CHANNEL_1, &dma_config);
  515. furi_hal_interrupt_set_isr(FuriHalInterruptIdDma1Ch1, furi_hal_subghz_async_tx_dma_isr, NULL);
  516. LL_DMA_EnableIT_TC(DMA1, LL_DMA_CHANNEL_1);
  517. LL_DMA_EnableIT_HT(DMA1, LL_DMA_CHANNEL_1);
  518. LL_DMA_EnableChannel(DMA1, LL_DMA_CHANNEL_1);
  519. // Configure TIM2
  520. LL_TIM_InitTypeDef TIM_InitStruct = {0};
  521. TIM_InitStruct.Prescaler = 64 - 1;
  522. TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
  523. TIM_InitStruct.Autoreload = 1000;
  524. TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV1;
  525. LL_TIM_Init(TIM2, &TIM_InitStruct);
  526. LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
  527. LL_TIM_EnableARRPreload(TIM2);
  528. // Configure TIM2 CH2
  529. LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {0};
  530. TIM_OC_InitStruct.OCMode = LL_TIM_OCMODE_TOGGLE;
  531. TIM_OC_InitStruct.OCState = LL_TIM_OCSTATE_DISABLE;
  532. TIM_OC_InitStruct.OCNState = LL_TIM_OCSTATE_DISABLE;
  533. TIM_OC_InitStruct.CompareValue = 0;
  534. TIM_OC_InitStruct.OCPolarity = LL_TIM_OCPOLARITY_HIGH;
  535. LL_TIM_OC_Init(TIM2, LL_TIM_CHANNEL_CH2, &TIM_OC_InitStruct);
  536. LL_TIM_OC_DisableFast(TIM2, LL_TIM_CHANNEL_CH2);
  537. LL_TIM_DisableMasterSlaveMode(TIM2);
  538. furi_hal_interrupt_set_isr(FuriHalInterruptIdTIM2, furi_hal_subghz_async_tx_timer_isr, NULL);
  539. LL_TIM_EnableIT_UPDATE(TIM2);
  540. LL_TIM_EnableDMAReq_UPDATE(TIM2);
  541. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH2);
  542. // Start counter
  543. LL_TIM_GenerateEvent_UPDATE(TIM2);
  544. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  545. furi_hal_gpio_write(&FURI_HAL_SUBGHZ_TX_GPIO, true);
  546. #endif
  547. furi_hal_subghz_tx();
  548. LL_TIM_SetCounter(TIM2, 0);
  549. LL_TIM_EnableCounter(TIM2);
  550. return true;
  551. }
  552. bool furi_hal_subghz_is_async_tx_complete() {
  553. return furi_hal_subghz.state == SubGhzStateAsyncTxEnd;
  554. }
  555. void furi_hal_subghz_stop_async_tx() {
  556. furi_assert(
  557. furi_hal_subghz.state == SubGhzStateAsyncTx ||
  558. furi_hal_subghz.state == SubGhzStateAsyncTxLast ||
  559. furi_hal_subghz.state == SubGhzStateAsyncTxEnd);
  560. // Shutdown radio
  561. furi_hal_subghz_idle();
  562. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  563. furi_hal_gpio_write(&FURI_HAL_SUBGHZ_TX_GPIO, false);
  564. #endif
  565. // Deinitialize Timer
  566. FURI_CRITICAL_ENTER();
  567. LL_TIM_DeInit(TIM2);
  568. furi_hal_interrupt_set_isr(FuriHalInterruptIdTIM2, NULL, NULL);
  569. // Deinitialize DMA
  570. LL_DMA_DeInit(DMA1, LL_DMA_CHANNEL_1);
  571. furi_hal_interrupt_set_isr(FuriHalInterruptIdDma1Ch1, NULL, NULL);
  572. // Deinitialize GPIO
  573. furi_hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  574. FURI_CRITICAL_EXIT();
  575. free(furi_hal_subghz_async_tx.buffer);
  576. float duty_cycle =
  577. 100.0f * (float)furi_hal_subghz_async_tx.duty_high /
  578. ((float)furi_hal_subghz_async_tx.duty_low + (float)furi_hal_subghz_async_tx.duty_high);
  579. FURI_LOG_D(
  580. TAG,
  581. "Async TX Radio stats: on %0.0fus, off %0.0fus, DutyCycle: %0.0f%%",
  582. (double)furi_hal_subghz_async_tx.duty_high,
  583. (double)furi_hal_subghz_async_tx.duty_low,
  584. (double)duty_cycle);
  585. furi_hal_subghz.state = SubGhzStateIdle;
  586. }