furi-hal-subghz.c 31 KB

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