furi-hal-subghz.c 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835
  1. #include "furi-hal-subghz.h"
  2. #include "furi-hal-version.h"
  3. #include <furi-hal-gpio.h>
  4. #include <furi-hal-spi.h>
  5. #include <furi-hal-interrupt.h>
  6. #include <furi-hal-resources.h>
  7. #include <furi.h>
  8. #include <cc1101.h>
  9. #include <stdio.h>
  10. static volatile SubGhzState furi_hal_subghz_state = SubGhzStateInit;
  11. static volatile SubGhzRegulation furi_hal_subghz_regulation = SubGhzRegulationTxRx;
  12. static const uint8_t furi_hal_subghz_preset_ook_270khz_async_regs[][2] = {
  13. // https://e2e.ti.com/support/wireless-connectivity/sub-1-ghz-group/sub-1-ghz/f/sub-1-ghz-forum/382066/cc1101---don-t-know-the-correct-registers-configuration
  14. /* GPIO GD0 */
  15. {CC1101_IOCFG0, 0x0D}, // GD0 as async serial data output/input
  16. /* FIFO and internals */
  17. {CC1101_FIFOTHR, 0x47}, // The only important bit is ADC_RETENTION, FIFO Tx=33 Rx=32
  18. /* Packet engine */
  19. {CC1101_PKTCTRL0, 0x32}, // Async, continious, no whitening
  20. /* Frequency Synthesizer Control */
  21. {CC1101_FSCTRL1, 0x06}, // IF = (26*10^6) / (2^10) * 0x06 = 152343.75Hz
  22. // Modem Configuration
  23. {CC1101_MDMCFG0, 0x00}, // Channel spacing is 25kHz
  24. {CC1101_MDMCFG1, 0x00}, // Channel spacing is 25kHz
  25. {CC1101_MDMCFG2, 0x30}, // Format ASK/OOK, No preamble/sync
  26. {CC1101_MDMCFG3, 0x32}, // Data rate is 3.79372 kBaud
  27. {CC1101_MDMCFG4, 0x67}, // Rx BW filter is 270.833333kHz
  28. /* Main Radio Control State Machine */
  29. {CC1101_MCSM0, 0x18}, // Autocalibrate on idle-to-rx/tx, PO_TIMEOUT is 64 cycles(149-155us)
  30. /* Frequency Offset Compensation Configuration */
  31. {CC1101_FOCCFG,
  32. 0x18}, // no frequency offset compensation, POST_K same as PRE_K, PRE_K is 4K, GATE is off
  33. /* Automatic Gain Control */
  34. {CC1101_AGCCTRL0,
  35. 0x40}, // 01 - Low hysteresis, small asymmetric dead zone, medium gain; 00 - 8 samples agc; 00 - Normal AGC, 00 - 4dB boundary
  36. {CC1101_AGCCTRL1,
  37. 0x00}, // 0; 0 - LNA 2 gain is decreased to minimum before decreasing LNA gain; 00 - Relative carrier sense threshold disabled; 0000 - RSSI to MAIN_TARGET
  38. {CC1101_AGCCTRL2, 0x03}, // 00 - DVGA all; 000 - MAX LNA+LNA2; 011 - MAIN_TARGET 24 dB
  39. /* Wake on radio and timeouts control */
  40. {CC1101_WORCTRL, 0xFB}, // WOR_RES is 2^15 periods (0.91 - 0.94 s) 16.5 - 17.2 hours
  41. /* Frontend configuration */
  42. {CC1101_FREND0, 0x11}, // Adjusts current TX LO buffer + high is PATABLE[1]
  43. {CC1101_FREND1, 0xB6}, //
  44. /* Frequency Synthesizer Calibration, valid for 433.92 */
  45. {CC1101_FSCAL3, 0xE9},
  46. {CC1101_FSCAL2, 0x2A},
  47. {CC1101_FSCAL1, 0x00},
  48. {CC1101_FSCAL0, 0x1F},
  49. /* Magic f4ckery */
  50. {CC1101_TEST2, 0x81}, // FIFOTHR ADC_RETENTION=1 matched value
  51. {CC1101_TEST1, 0x35}, // FIFOTHR ADC_RETENTION=1 matched value
  52. {CC1101_TEST0, 0x09}, // VCO selection calibration stage is disabled
  53. /* End */
  54. {0, 0},
  55. };
  56. static const uint8_t furi_hal_subghz_preset_ook_650khz_async_regs[][2] = {
  57. // https://e2e.ti.com/support/wireless-connectivity/sub-1-ghz-group/sub-1-ghz/f/sub-1-ghz-forum/382066/cc1101---don-t-know-the-correct-registers-configuration
  58. /* GPIO GD0 */
  59. {CC1101_IOCFG0, 0x0D}, // GD0 as async serial data output/input
  60. /* FIFO and internals */
  61. {CC1101_FIFOTHR, 0x07}, // The only important bit is ADC_RETENTION
  62. /* Packet engine */
  63. {CC1101_PKTCTRL0, 0x32}, // Async, continious, no whitening
  64. /* Frequency Synthesizer Control */
  65. {CC1101_FSCTRL1, 0x06}, // IF = (26*10^6) / (2^10) * 0x06 = 152343.75Hz
  66. // Modem Configuration
  67. {CC1101_MDMCFG0, 0x00}, // Channel spacing is 25kHz
  68. {CC1101_MDMCFG1, 0x00}, // Channel spacing is 25kHz
  69. {CC1101_MDMCFG2, 0x30}, // Format ASK/OOK, No preamble/sync
  70. {CC1101_MDMCFG3, 0x32}, // Data rate is 3.79372 kBaud
  71. {CC1101_MDMCFG4, 0x17}, // Rx BW filter is 650.000kHz
  72. /* Main Radio Control State Machine */
  73. {CC1101_MCSM0, 0x18}, // Autocalibrate on idle-to-rx/tx, PO_TIMEOUT is 64 cycles(149-155us)
  74. /* Frequency Offset Compensation Configuration */
  75. {CC1101_FOCCFG,
  76. 0x18}, // no frequency offset compensation, POST_K same as PRE_K, PRE_K is 4K, GATE is off
  77. /* Automatic Gain Control */
  78. // {CC1101_AGCTRL0,0x40}, // 01 - Low hysteresis, small asymmetric dead zone, medium gain; 00 - 8 samples agc; 00 - Normal AGC, 00 - 4dB boundary
  79. // {CC1101_AGCTRL1,0x00}, // 0; 0 - LNA 2 gain is decreased to minimum before decreasing LNA gain; 00 - Relative carrier sense threshold disabled; 0000 - RSSI to MAIN_TARGET
  80. // {CC1101_AGCCTRL2, 0x03}, // 00 - DVGA all; 000 - MAX LNA+LNA2; 011 - MAIN_TARGET 24 dB
  81. //MAGN_TARGET for RX filter BW =< 100 kHz is 0x3. For higher RX filter BW's MAGN_TARGET is 0x7.
  82. {CC1101_AGCCTRL0,
  83. 0x91}, // 10 - Medium hysteresis, medium asymmetric dead zone, medium gain ; 01 - 16 samples agc; 00 - Normal AGC, 01 - 8dB boundary
  84. {CC1101_AGCCTRL1,
  85. 0x0}, // 0; 0 - LNA 2 gain is decreased to minimum before decreasing LNA gain; 00 - Relative carrier sense threshold disabled; 0000 - RSSI to MAIN_TARGET
  86. {CC1101_AGCCTRL2, 0x07}, // 00 - DVGA all; 000 - MAX LNA+LNA2; 111 - MAIN_TARGET 42 dB
  87. /* Wake on radio and timeouts control */
  88. {CC1101_WORCTRL, 0xFB}, // WOR_RES is 2^15 periods (0.91 - 0.94 s) 16.5 - 17.2 hours
  89. /* Frontend configuration */
  90. {CC1101_FREND0, 0x11}, // Adjusts current TX LO buffer + high is PATABLE[1]
  91. {CC1101_FREND1, 0xB6}, //
  92. /* Frequency Synthesizer Calibration, valid for 433.92 */
  93. {CC1101_FSCAL3, 0xE9},
  94. {CC1101_FSCAL2, 0x2A},
  95. {CC1101_FSCAL1, 0x00},
  96. {CC1101_FSCAL0, 0x1F},
  97. /* Magic f4ckery */
  98. {CC1101_TEST2, 0x88},
  99. {CC1101_TEST1, 0x31},
  100. {CC1101_TEST0, 0x09}, // VCO selection calibration stage is disabled
  101. /* End */
  102. {0, 0},
  103. };
  104. static const uint8_t furi_hal_subghz_preset_2fsk_dev2_38khz_async_regs[][2] = {
  105. /* GPIO GD0 */
  106. {CC1101_IOCFG0, 0x0D}, // GD0 as async serial data output/input
  107. /* Frequency Synthesizer Control */
  108. {CC1101_FSCTRL1, 0x06}, // IF = (26*10^6) / (2^10) * 0x06 = 152343.75Hz
  109. /* Packet engine */
  110. {CC1101_PKTCTRL0, 0x32}, // Async, continious, no whitening
  111. {CC1101_PKTCTRL1, 0x04},
  112. // // Modem Configuration
  113. {CC1101_MDMCFG0, 0x00},
  114. {CC1101_MDMCFG1, 0x02},
  115. {CC1101_MDMCFG2, 0x04}, // Format 2-FSK/FM, No preamble/sync, Disable (current optimized)
  116. {CC1101_MDMCFG3, 0x83}, // Data rate is 4.79794 kBaud
  117. {CC1101_MDMCFG4, 0x67}, //Rx BW filter is 270.833333 kHz
  118. {CC1101_DEVIATN, 0x04}, //Deviation 2.380371 kHz
  119. /* Main Radio Control State Machine */
  120. {CC1101_MCSM0, 0x18}, // Autocalibrate on idle-to-rx/tx, PO_TIMEOUT is 64 cycles(149-155us)
  121. /* Frequency Offset Compensation Configuration */
  122. {CC1101_FOCCFG,
  123. 0x16}, // no frequency offset compensation, POST_K same as PRE_K, PRE_K is 4K, GATE is off
  124. /* Automatic Gain Control */
  125. {CC1101_AGCCTRL0,
  126. 0x91}, //10 - Medium hysteresis, medium asymmetric dead zone, medium gain ; 01 - 16 samples agc; 00 - Normal AGC, 01 - 8dB boundary
  127. {CC1101_AGCCTRL1,
  128. 0x00}, // 0; 0 - LNA 2 gain is decreased to minimum before decreasing LNA gain; 00 - Relative carrier sense threshold disabled; 0000 - RSSI to MAIN_TARGET
  129. {CC1101_AGCCTRL2, 0x07}, // 00 - DVGA all; 000 - MAX LNA+LNA2; 111 - MAIN_TARGET 42 dB
  130. /* Wake on radio and timeouts control */
  131. {CC1101_WORCTRL, 0xFB}, // WOR_RES is 2^15 periods (0.91 - 0.94 s) 16.5 - 17.2 hours
  132. /* Frontend configuration */
  133. {CC1101_FREND0, 0x10}, // Adjusts current TX LO buffer
  134. {CC1101_FREND1, 0x56},
  135. /* Frequency Synthesizer Calibration, valid for 433.92 */
  136. {CC1101_FSCAL3, 0xE9},
  137. {CC1101_FSCAL2, 0x2A},
  138. {CC1101_FSCAL1, 0x00},
  139. {CC1101_FSCAL0, 0x1F},
  140. /* Magic f4ckery */
  141. {CC1101_TEST2, 0x81}, // FIFOTHR ADC_RETENTION=1 matched value
  142. {CC1101_TEST1, 0x35}, // FIFOTHR ADC_RETENTION=1 matched value
  143. {CC1101_TEST0, 0x09}, // VCO selection calibration stage is disabled
  144. /* End */
  145. {0, 0},
  146. };
  147. static const uint8_t furi_hal_subghz_preset_2fsk_dev4_76khz_async_regs[][2] = {
  148. /* GPIO GD0 */
  149. {CC1101_IOCFG0, 0x0D}, // GD0 as async serial data output/input
  150. /* Frequency Synthesizer Control */
  151. {CC1101_FSCTRL1, 0x06}, // IF = (26*10^6) / (2^10) * 0x06 = 152343.75Hz
  152. /* Packet engine */
  153. {CC1101_PKTCTRL0, 0x32}, // Async, continious, no whitening
  154. {CC1101_PKTCTRL1, 0x04},
  155. // // Modem Configuration
  156. {CC1101_MDMCFG0, 0x00},
  157. {CC1101_MDMCFG1, 0x02},
  158. {CC1101_MDMCFG2, 0x04}, // Format 2-FSK/FM, No preamble/sync, Disable (current optimized)
  159. {CC1101_MDMCFG3, 0x83}, // Data rate is 4.79794 kBaud
  160. {CC1101_MDMCFG4, 0x67}, //Rx BW filter is 270.833333 kHz
  161. {CC1101_DEVIATN, 0x14}, //Deviation 4.760742 kHz
  162. /* Main Radio Control State Machine */
  163. {CC1101_MCSM0, 0x18}, // Autocalibrate on idle-to-rx/tx, PO_TIMEOUT is 64 cycles(149-155us)
  164. /* Frequency Offset Compensation Configuration */
  165. {CC1101_FOCCFG,
  166. 0x16}, // no frequency offset compensation, POST_K same as PRE_K, PRE_K is 4K, GATE is off
  167. /* Automatic Gain Control */
  168. {CC1101_AGCCTRL0,
  169. 0x91}, //10 - Medium hysteresis, medium asymmetric dead zone, medium gain ; 01 - 16 samples agc; 00 - Normal AGC, 01 - 8dB boundary
  170. {CC1101_AGCCTRL1,
  171. 0x00}, // 0; 0 - LNA 2 gain is decreased to minimum before decreasing LNA gain; 00 - Relative carrier sense threshold disabled; 0000 - RSSI to MAIN_TARGET
  172. {CC1101_AGCCTRL2, 0x07}, // 00 - DVGA all; 000 - MAX LNA+LNA2; 111 - MAIN_TARGET 42 dB
  173. /* Wake on radio and timeouts control */
  174. {CC1101_WORCTRL, 0xFB}, // WOR_RES is 2^15 periods (0.91 - 0.94 s) 16.5 - 17.2 hours
  175. /* Frontend configuration */
  176. {CC1101_FREND0, 0x10}, // Adjusts current TX LO buffer
  177. {CC1101_FREND1, 0x56},
  178. /* Frequency Synthesizer Calibration, valid for 433.92 */
  179. {CC1101_FSCAL3, 0xE9},
  180. {CC1101_FSCAL2, 0x2A},
  181. {CC1101_FSCAL1, 0x00},
  182. {CC1101_FSCAL0, 0x1F},
  183. /* Magic f4ckery */
  184. {CC1101_TEST2, 0x81}, // FIFOTHR ADC_RETENTION=1 matched value
  185. {CC1101_TEST1, 0x35}, // FIFOTHR ADC_RETENTION=1 matched value
  186. {CC1101_TEST0, 0x09}, // VCO selection calibration stage is disabled
  187. /* End */
  188. {0, 0},
  189. };
  190. static const uint8_t furi_hal_subghz_preset_ook_async_patable[8] = {
  191. 0x00,
  192. 0xC0, // 10dBm 0xC0, 7dBm 0xC8, 5dBm 0x84, 0dBm 0x60, -10dBm 0x34, -15dBm 0x1D, -20dBm 0x0E, -30dBm 0x12
  193. 0x00,
  194. 0x00,
  195. 0x00,
  196. 0x00,
  197. 0x00,
  198. 0x00};
  199. static const uint8_t furi_hal_subghz_preset_2fsk_async_patable[8] = {
  200. 0xC0, // 10dBm 0xC0, 7dBm 0xC8, 5dBm 0x84, 0dBm 0x60, -10dBm 0x34, -15dBm 0x1D, -20dBm 0x0E, -30dBm 0x12
  201. 0x00,
  202. 0x00,
  203. 0x00,
  204. 0x00,
  205. 0x00,
  206. 0x00,
  207. 0x00
  208. };
  209. void furi_hal_subghz_init() {
  210. furi_assert(furi_hal_subghz_state == SubGhzStateInit);
  211. furi_hal_subghz_state = SubGhzStateIdle;
  212. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  213. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  214. hal_gpio_init(&FURI_HAL_SUBGHZ_TX_GPIO, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
  215. #endif
  216. // Reset
  217. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  218. cc1101_reset(device);
  219. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  220. // Prepare GD0 for power on self test
  221. hal_gpio_init(&gpio_cc1101_g0, GpioModeInput, GpioPullNo, GpioSpeedLow);
  222. // GD0 low
  223. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHW);
  224. while(hal_gpio_read(&gpio_cc1101_g0) != false)
  225. ;
  226. // GD0 high
  227. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHW | CC1101_IOCFG_INV);
  228. while(hal_gpio_read(&gpio_cc1101_g0) != true)
  229. ;
  230. // Reset GD0 to floating state
  231. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  232. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  233. // RF switches
  234. hal_gpio_init(&gpio_rf_sw_0, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
  235. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW);
  236. // Go to sleep
  237. cc1101_shutdown(device);
  238. furi_hal_spi_device_return(device);
  239. FURI_LOG_I("FuriHalSubGhz", "Init OK");
  240. }
  241. void furi_hal_subghz_sleep() {
  242. furi_assert(furi_hal_subghz_state == SubGhzStateIdle);
  243. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  244. cc1101_switch_to_idle(device);
  245. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  246. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  247. cc1101_shutdown(device);
  248. furi_hal_spi_device_return(device);
  249. }
  250. void furi_hal_subghz_dump_state() {
  251. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  252. printf(
  253. "[furi_hal_subghz] cc1101 chip %d, version %d\r\n",
  254. cc1101_get_partnumber(device),
  255. cc1101_get_version(device));
  256. furi_hal_spi_device_return(device);
  257. }
  258. void furi_hal_subghz_load_preset(FuriHalSubGhzPreset preset) {
  259. if(preset == FuriHalSubGhzPresetOok650Async) {
  260. furi_hal_subghz_load_registers(furi_hal_subghz_preset_ook_650khz_async_regs);
  261. furi_hal_subghz_load_patable(furi_hal_subghz_preset_ook_async_patable);
  262. } else if(preset == FuriHalSubGhzPresetOok270Async) {
  263. furi_hal_subghz_load_registers(furi_hal_subghz_preset_ook_270khz_async_regs);
  264. furi_hal_subghz_load_patable(furi_hal_subghz_preset_ook_async_patable);
  265. } else if(preset == FuriHalSubGhzPreset2FSKDev238Async) {
  266. furi_hal_subghz_load_registers(furi_hal_subghz_preset_2fsk_dev2_38khz_async_regs);
  267. furi_hal_subghz_load_patable(furi_hal_subghz_preset_2fsk_async_patable);
  268. } else if(preset == FuriHalSubGhzPreset2FSKDev476Async) {
  269. furi_hal_subghz_load_registers(furi_hal_subghz_preset_2fsk_dev4_76khz_async_regs);
  270. furi_hal_subghz_load_patable(furi_hal_subghz_preset_2fsk_async_patable);
  271. } else {
  272. furi_crash(NULL);
  273. }
  274. }
  275. void furi_hal_subghz_load_registers(const uint8_t data[][2]) {
  276. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  277. cc1101_reset(device);
  278. uint32_t i = 0;
  279. while(data[i][0]) {
  280. cc1101_write_reg(device, data[i][0], data[i][1]);
  281. i++;
  282. }
  283. furi_hal_spi_device_return(device);
  284. }
  285. void furi_hal_subghz_load_patable(const uint8_t data[8]) {
  286. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  287. cc1101_set_pa_table(device, data);
  288. furi_hal_spi_device_return(device);
  289. }
  290. void furi_hal_subghz_write_packet(const uint8_t* data, uint8_t size) {
  291. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  292. cc1101_flush_tx(device);
  293. cc1101_write_fifo(device, data, size);
  294. furi_hal_spi_device_return(device);
  295. }
  296. void furi_hal_subghz_flush_rx() {
  297. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  298. cc1101_flush_rx(device);
  299. furi_hal_spi_device_return(device);
  300. }
  301. void furi_hal_subghz_read_packet(uint8_t* data, uint8_t* size) {
  302. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  303. cc1101_read_fifo(device, data, size);
  304. furi_hal_spi_device_return(device);
  305. }
  306. void furi_hal_subghz_shutdown() {
  307. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  308. // Reset and shutdown
  309. cc1101_shutdown(device);
  310. furi_hal_spi_device_return(device);
  311. }
  312. void furi_hal_subghz_reset() {
  313. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  314. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  315. cc1101_switch_to_idle(device);
  316. cc1101_reset(device);
  317. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  318. furi_hal_spi_device_return(device);
  319. }
  320. void furi_hal_subghz_idle() {
  321. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  322. cc1101_switch_to_idle(device);
  323. furi_hal_spi_device_return(device);
  324. }
  325. void furi_hal_subghz_rx() {
  326. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  327. cc1101_switch_to_rx(device);
  328. furi_hal_spi_device_return(device);
  329. }
  330. bool furi_hal_subghz_tx() {
  331. if(furi_hal_subghz_regulation != SubGhzRegulationTxRx) return false;
  332. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  333. cc1101_switch_to_tx(device);
  334. furi_hal_spi_device_return(device);
  335. return true;
  336. }
  337. float furi_hal_subghz_get_rssi() {
  338. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  339. int32_t rssi_dec = cc1101_get_rssi(device);
  340. furi_hal_spi_device_return(device);
  341. float rssi = rssi_dec;
  342. if(rssi_dec >= 128) {
  343. rssi = ((rssi - 256.0f) / 2.0f) - 74.0f;
  344. } else {
  345. rssi = (rssi / 2.0f) - 74.0f;
  346. }
  347. return rssi;
  348. }
  349. bool furi_hal_subghz_is_frequency_valid(uint32_t value) {
  350. if(!(value >= 299999755 && value <= 348000335) &&
  351. !(value >= 386999938 && value <= 464000000) &&
  352. !(value >= 778999847 && value <= 928000000)) {
  353. return false;
  354. }
  355. return true;
  356. }
  357. uint32_t furi_hal_subghz_set_frequency_and_path(uint32_t value) {
  358. value = furi_hal_subghz_set_frequency(value);
  359. if(value >= 299999755 && value <= 348000335) {
  360. furi_hal_subghz_set_path(FuriHalSubGhzPath315);
  361. } else if(value >= 386999938 && value <= 464000000) {
  362. furi_hal_subghz_set_path(FuriHalSubGhzPath433);
  363. } else if(value >= 778999847 && value <= 928000000) {
  364. furi_hal_subghz_set_path(FuriHalSubGhzPath868);
  365. } else {
  366. furi_crash(NULL);
  367. }
  368. return value;
  369. }
  370. uint32_t furi_hal_subghz_set_frequency(uint32_t value) {
  371. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  372. //checking regional settings
  373. bool txrx = false;
  374. switch(furi_hal_version_get_hw_region()) {
  375. case FuriHalVersionRegionEuRu:
  376. //433,05..434,79; 868,15..868,55
  377. if(!(value >= 433050000 && value <= 434790000) &&
  378. !(value >= 868150000 && value <= 8680550000)) {
  379. } else {
  380. txrx = true;
  381. }
  382. break;
  383. case FuriHalVersionRegionUsCaAu:
  384. //304,10..315,25; 433,05..434,79; 915,00..928,00
  385. if(!(value >= 304100000 && value <= 315250000) &&
  386. !(value >= 433050000 && value <= 434790000) &&
  387. !(value >= 915000000 && value <= 928000000)) {
  388. } else {
  389. txrx = true;
  390. }
  391. break;
  392. case FuriHalVersionRegionJp:
  393. //312,00..315,25; 920,50..923,50
  394. if(!(value >= 312000000 && value <= 315250000) &&
  395. !(value >= 920500000 && value <= 923500000)) {
  396. } else {
  397. txrx = true;
  398. }
  399. break;
  400. default:
  401. txrx = true;
  402. break;
  403. }
  404. if(txrx) {
  405. furi_hal_subghz_regulation = SubGhzRegulationTxRx;
  406. } else {
  407. furi_hal_subghz_regulation = SubGhzRegulationOnlyRx;
  408. }
  409. uint32_t real_frequency = cc1101_set_frequency(device, value);
  410. cc1101_calibrate(device);
  411. while(true) {
  412. CC1101Status status = cc1101_get_status(device);
  413. if(status.STATE == CC1101StateIDLE) break;
  414. }
  415. furi_hal_spi_device_return(device);
  416. return real_frequency;
  417. }
  418. void furi_hal_subghz_set_path(FuriHalSubGhzPath path) {
  419. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  420. if(path == FuriHalSubGhzPath433) {
  421. hal_gpio_write(&gpio_rf_sw_0, 0);
  422. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW | CC1101_IOCFG_INV);
  423. } else if(path == FuriHalSubGhzPath315) {
  424. hal_gpio_write(&gpio_rf_sw_0, 1);
  425. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW);
  426. } else if(path == FuriHalSubGhzPath868) {
  427. hal_gpio_write(&gpio_rf_sw_0, 1);
  428. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW | CC1101_IOCFG_INV);
  429. } else if(path == FuriHalSubGhzPathIsolate) {
  430. hal_gpio_write(&gpio_rf_sw_0, 0);
  431. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW);
  432. } else {
  433. furi_crash(NULL);
  434. }
  435. furi_hal_spi_device_return(device);
  436. }
  437. volatile uint32_t furi_hal_subghz_capture_delta_duration = 0;
  438. volatile FuriHalSubGhzCaptureCallback furi_hal_subghz_capture_callback = NULL;
  439. volatile void* furi_hal_subghz_capture_callback_context = NULL;
  440. static void furi_hal_subghz_capture_ISR() {
  441. // Channel 1
  442. if(LL_TIM_IsActiveFlag_CC1(TIM2)) {
  443. LL_TIM_ClearFlag_CC1(TIM2);
  444. furi_hal_subghz_capture_delta_duration = LL_TIM_IC_GetCaptureCH1(TIM2);
  445. if(furi_hal_subghz_capture_callback) {
  446. furi_hal_subghz_capture_callback(
  447. true,
  448. furi_hal_subghz_capture_delta_duration,
  449. (void*)furi_hal_subghz_capture_callback_context);
  450. }
  451. }
  452. // Channel 2
  453. if(LL_TIM_IsActiveFlag_CC2(TIM2)) {
  454. LL_TIM_ClearFlag_CC2(TIM2);
  455. if(furi_hal_subghz_capture_callback) {
  456. furi_hal_subghz_capture_callback(
  457. false,
  458. LL_TIM_IC_GetCaptureCH2(TIM2) - furi_hal_subghz_capture_delta_duration,
  459. (void*)furi_hal_subghz_capture_callback_context);
  460. }
  461. }
  462. }
  463. void furi_hal_subghz_start_async_rx(FuriHalSubGhzCaptureCallback callback, void* context) {
  464. furi_assert(furi_hal_subghz_state == SubGhzStateIdle);
  465. furi_hal_subghz_state = SubGhzStateAsyncRx;
  466. furi_hal_subghz_capture_callback = callback;
  467. furi_hal_subghz_capture_callback_context = context;
  468. hal_gpio_init_ex(
  469. &gpio_cc1101_g0, GpioModeAltFunctionPushPull, GpioPullNo, GpioSpeedLow, GpioAltFn1TIM2);
  470. // Timer: base
  471. LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_TIM2);
  472. LL_TIM_InitTypeDef TIM_InitStruct = {0};
  473. TIM_InitStruct.Prescaler = 64 - 1;
  474. TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
  475. TIM_InitStruct.Autoreload = 0x7FFFFFFE;
  476. TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV4;
  477. LL_TIM_Init(TIM2, &TIM_InitStruct);
  478. // Timer: advanced
  479. LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
  480. LL_TIM_DisableARRPreload(TIM2);
  481. LL_TIM_SetTriggerInput(TIM2, LL_TIM_TS_TI2FP2);
  482. LL_TIM_SetSlaveMode(TIM2, LL_TIM_SLAVEMODE_RESET);
  483. LL_TIM_SetTriggerOutput(TIM2, LL_TIM_TRGO_RESET);
  484. LL_TIM_EnableMasterSlaveMode(TIM2);
  485. LL_TIM_DisableDMAReq_TRIG(TIM2);
  486. LL_TIM_DisableIT_TRIG(TIM2);
  487. // Timer: channel 1 indirect
  488. LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ACTIVEINPUT_INDIRECTTI);
  489. LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ICPSC_DIV1);
  490. LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_POLARITY_FALLING);
  491. LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_FILTER_FDIV1);
  492. // Timer: channel 2 direct
  493. LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_ACTIVEINPUT_DIRECTTI);
  494. LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_ICPSC_DIV1);
  495. LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_IC_POLARITY_RISING);
  496. LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_IC_FILTER_FDIV32_N8);
  497. // ISR setup
  498. furi_hal_interrupt_set_timer_isr(TIM2, furi_hal_subghz_capture_ISR);
  499. NVIC_SetPriority(TIM2_IRQn, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 5, 0));
  500. NVIC_EnableIRQ(TIM2_IRQn);
  501. // Interrupts and channels
  502. LL_TIM_EnableIT_CC1(TIM2);
  503. LL_TIM_EnableIT_CC2(TIM2);
  504. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH1);
  505. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH2);
  506. // Enable NVIC
  507. NVIC_SetPriority(TIM2_IRQn, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 5, 0));
  508. NVIC_EnableIRQ(TIM2_IRQn);
  509. // Start timer
  510. LL_TIM_SetCounter(TIM2, 0);
  511. LL_TIM_EnableCounter(TIM2);
  512. // Switch to RX
  513. furi_hal_subghz_rx();
  514. }
  515. void furi_hal_subghz_stop_async_rx() {
  516. furi_assert(furi_hal_subghz_state == SubGhzStateAsyncRx);
  517. furi_hal_subghz_state = SubGhzStateIdle;
  518. // Shutdown radio
  519. furi_hal_subghz_idle();
  520. LL_TIM_DeInit(TIM2);
  521. LL_APB1_GRP1_DisableClock(LL_APB1_GRP1_PERIPH_TIM2);
  522. furi_hal_interrupt_set_timer_isr(TIM2, NULL);
  523. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  524. }
  525. #define API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL (256)
  526. #define API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF (API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL / 2)
  527. #define API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME 333
  528. typedef struct {
  529. uint32_t* buffer;
  530. bool flip_flop;
  531. FuriHalSubGhzAsyncTxCallback callback;
  532. void* callback_context;
  533. } FuriHalSubGhzAsyncTx;
  534. static FuriHalSubGhzAsyncTx furi_hal_subghz_async_tx = {0};
  535. static void furi_hal_subghz_async_tx_refill(uint32_t* buffer, size_t samples) {
  536. while(samples > 0) {
  537. bool is_odd = samples % 2;
  538. LevelDuration ld =
  539. furi_hal_subghz_async_tx.callback(furi_hal_subghz_async_tx.callback_context);
  540. if(level_duration_is_wait(ld)) return;
  541. if(level_duration_is_reset(ld)) {
  542. // One more even sample required to end at low level
  543. if(is_odd) {
  544. *buffer = API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  545. buffer++;
  546. samples--;
  547. }
  548. break;
  549. } else {
  550. // Inject guard time if level is incorrect
  551. if(is_odd == level_duration_get_level(ld)) {
  552. *buffer = API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  553. buffer++;
  554. samples--;
  555. }
  556. uint32_t duration = level_duration_get_duration(ld);
  557. furi_assert(duration > 0);
  558. *buffer = duration;
  559. buffer++;
  560. samples--;
  561. }
  562. }
  563. memset(buffer, 0, samples * sizeof(uint32_t));
  564. }
  565. static void furi_hal_subghz_async_tx_dma_isr() {
  566. furi_assert(furi_hal_subghz_state == SubGhzStateAsyncTx);
  567. if(LL_DMA_IsActiveFlag_HT1(DMA1)) {
  568. LL_DMA_ClearFlag_HT1(DMA1);
  569. furi_hal_subghz_async_tx_refill(
  570. furi_hal_subghz_async_tx.buffer, API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF);
  571. }
  572. if(LL_DMA_IsActiveFlag_TC1(DMA1)) {
  573. LL_DMA_ClearFlag_TC1(DMA1);
  574. furi_hal_subghz_async_tx_refill(
  575. furi_hal_subghz_async_tx.buffer + API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF,
  576. API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF);
  577. }
  578. }
  579. static void furi_hal_subghz_async_tx_timer_isr() {
  580. if(LL_TIM_IsActiveFlag_UPDATE(TIM2)) {
  581. LL_TIM_ClearFlag_UPDATE(TIM2);
  582. if(LL_TIM_GetAutoReload(TIM2) == 0) {
  583. if(furi_hal_subghz_state == SubGhzStateAsyncTx) {
  584. furi_hal_subghz_state = SubGhzStateAsyncTxLast;
  585. //forcibly pulls the pin to the ground so that there is no carrier
  586. hal_gpio_init(&gpio_cc1101_g0, GpioModeInput, GpioPullDown, GpioSpeedLow);
  587. } else {
  588. furi_hal_subghz_state = SubGhzStateAsyncTxEnd;
  589. LL_TIM_DisableCounter(TIM2);
  590. }
  591. }
  592. }
  593. }
  594. bool furi_hal_subghz_start_async_tx(FuriHalSubGhzAsyncTxCallback callback, void* context) {
  595. furi_assert(furi_hal_subghz_state == SubGhzStateIdle);
  596. furi_assert(callback);
  597. //If transmission is prohibited by regional settings
  598. if(furi_hal_subghz_regulation != SubGhzRegulationTxRx) return false;
  599. furi_hal_subghz_async_tx.callback = callback;
  600. furi_hal_subghz_async_tx.callback_context = context;
  601. furi_hal_subghz_state = SubGhzStateAsyncTx;
  602. furi_hal_subghz_async_tx.buffer =
  603. furi_alloc(API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL * sizeof(uint32_t));
  604. furi_hal_subghz_async_tx_refill(
  605. furi_hal_subghz_async_tx.buffer, API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL);
  606. // Connect CC1101_GD0 to TIM2 as output
  607. hal_gpio_init_ex(
  608. &gpio_cc1101_g0, GpioModeAltFunctionPushPull, GpioPullDown, GpioSpeedLow, GpioAltFn1TIM2);
  609. // Configure DMA
  610. LL_DMA_InitTypeDef dma_config = {0};
  611. dma_config.PeriphOrM2MSrcAddress = (uint32_t) & (TIM2->ARR);
  612. dma_config.MemoryOrM2MDstAddress = (uint32_t)furi_hal_subghz_async_tx.buffer;
  613. dma_config.Direction = LL_DMA_DIRECTION_MEMORY_TO_PERIPH;
  614. dma_config.Mode = LL_DMA_MODE_CIRCULAR;
  615. dma_config.PeriphOrM2MSrcIncMode = LL_DMA_PERIPH_NOINCREMENT;
  616. dma_config.MemoryOrM2MDstIncMode = LL_DMA_MEMORY_INCREMENT;
  617. dma_config.PeriphOrM2MSrcDataSize = LL_DMA_PDATAALIGN_WORD;
  618. dma_config.MemoryOrM2MDstDataSize = LL_DMA_MDATAALIGN_WORD;
  619. dma_config.NbData = API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL;
  620. dma_config.PeriphRequest = LL_DMAMUX_REQ_TIM2_UP;
  621. dma_config.Priority = LL_DMA_MODE_NORMAL;
  622. LL_DMA_Init(DMA1, LL_DMA_CHANNEL_1, &dma_config);
  623. furi_hal_interrupt_set_dma_channel_isr(
  624. DMA1, LL_DMA_CHANNEL_1, furi_hal_subghz_async_tx_dma_isr);
  625. LL_DMA_EnableIT_TC(DMA1, LL_DMA_CHANNEL_1);
  626. LL_DMA_EnableIT_HT(DMA1, LL_DMA_CHANNEL_1);
  627. LL_DMA_EnableChannel(DMA1, LL_DMA_CHANNEL_1);
  628. // Configure TIM2
  629. LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_TIM2);
  630. LL_TIM_InitTypeDef TIM_InitStruct = {0};
  631. TIM_InitStruct.Prescaler = 64 - 1;
  632. TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
  633. TIM_InitStruct.Autoreload = 1000;
  634. TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV1;
  635. LL_TIM_Init(TIM2, &TIM_InitStruct);
  636. LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
  637. LL_TIM_EnableARRPreload(TIM2);
  638. // Configure TIM2 CH2
  639. LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {0};
  640. TIM_OC_InitStruct.OCMode = LL_TIM_OCMODE_TOGGLE;
  641. TIM_OC_InitStruct.OCState = LL_TIM_OCSTATE_DISABLE;
  642. TIM_OC_InitStruct.OCNState = LL_TIM_OCSTATE_DISABLE;
  643. TIM_OC_InitStruct.CompareValue = 0;
  644. TIM_OC_InitStruct.OCPolarity = LL_TIM_OCPOLARITY_HIGH;
  645. LL_TIM_OC_Init(TIM2, LL_TIM_CHANNEL_CH2, &TIM_OC_InitStruct);
  646. LL_TIM_OC_DisableFast(TIM2, LL_TIM_CHANNEL_CH2);
  647. LL_TIM_DisableMasterSlaveMode(TIM2);
  648. furi_hal_interrupt_set_timer_isr(TIM2, furi_hal_subghz_async_tx_timer_isr);
  649. LL_TIM_EnableIT_UPDATE(TIM2);
  650. LL_TIM_EnableDMAReq_UPDATE(TIM2);
  651. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH2);
  652. // Start counter
  653. LL_TIM_GenerateEvent_UPDATE(TIM2);
  654. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  655. hal_gpio_write(&FURI_HAL_SUBGHZ_TX_GPIO, true);
  656. #endif
  657. furi_hal_subghz_tx();
  658. // Enable NVIC
  659. NVIC_SetPriority(TIM2_IRQn, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 5, 0));
  660. NVIC_EnableIRQ(TIM2_IRQn);
  661. LL_TIM_SetCounter(TIM2, 0);
  662. LL_TIM_EnableCounter(TIM2);
  663. return true;
  664. }
  665. bool furi_hal_subghz_is_async_tx_complete() {
  666. return furi_hal_subghz_state == SubGhzStateAsyncTxEnd;
  667. }
  668. void furi_hal_subghz_stop_async_tx() {
  669. furi_assert(
  670. furi_hal_subghz_state == SubGhzStateAsyncTx ||
  671. furi_hal_subghz_state == SubGhzStateAsyncTxLast ||
  672. furi_hal_subghz_state == SubGhzStateAsyncTxEnd);
  673. // Shutdown radio
  674. furi_hal_subghz_idle();
  675. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  676. hal_gpio_write(&FURI_HAL_SUBGHZ_TX_GPIO, false);
  677. #endif
  678. // Deinitialize Timer
  679. LL_TIM_DeInit(TIM2);
  680. LL_APB1_GRP1_DisableClock(LL_APB1_GRP1_PERIPH_TIM2);
  681. furi_hal_interrupt_set_timer_isr(TIM2, NULL);
  682. // Deinitialize DMA
  683. LL_DMA_DeInit(DMA1, LL_DMA_CHANNEL_1);
  684. furi_hal_interrupt_set_dma_channel_isr(DMA1, LL_DMA_CHANNEL_1, NULL);
  685. // Deinitialize GPIO
  686. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  687. free(furi_hal_subghz_async_tx.buffer);
  688. furi_hal_subghz_state = SubGhzStateIdle;
  689. }