furi-hal-subghz.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777
  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_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, 0x2},
  115. {CC1101_MDMCFG2, 0x4}, // 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, 0x14 }, //Deviation 4.760742 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_ook_async_patable[8] = {
  149. 0x00,
  150. 0xC0, // 10dBm 0xC0, 7dBm 0xC8, 5dBm 0x84, 0dBm 0x60, -10dBm 0x34, -15dBm 0x1D, -20dBm 0x0E, -30dBm 0x12
  151. 0x00,
  152. 0x00,
  153. 0x00,
  154. 0x00,
  155. 0x00,
  156. 0x00};
  157. static const uint8_t furi_hal_subghz_preset_2fsk_async_patable[8] = {
  158. 0xC0, // 10dBm 0xC0, 7dBm 0xC8, 5dBm 0x84, 0dBm 0x60, -10dBm 0x34, -15dBm 0x1D, -20dBm 0x0E, -30dBm 0x12
  159. 0x00,
  160. 0x00,
  161. 0x00,
  162. 0x00,
  163. 0x00,
  164. 0x00,
  165. 0x00
  166. };
  167. void furi_hal_subghz_init() {
  168. furi_assert(furi_hal_subghz_state == SubGhzStateInit);
  169. furi_hal_subghz_state = SubGhzStateIdle;
  170. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  171. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  172. hal_gpio_init(&FURI_HAL_SUBGHZ_TX_GPIO, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
  173. #endif
  174. // Reset
  175. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  176. cc1101_reset(device);
  177. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  178. // Prepare GD0 for power on self test
  179. hal_gpio_init(&gpio_cc1101_g0, GpioModeInput, GpioPullNo, GpioSpeedLow);
  180. // GD0 low
  181. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHW);
  182. while(hal_gpio_read(&gpio_cc1101_g0) != false)
  183. ;
  184. // GD0 high
  185. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHW | CC1101_IOCFG_INV);
  186. while(hal_gpio_read(&gpio_cc1101_g0) != true)
  187. ;
  188. // Reset GD0 to floating state
  189. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  190. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  191. // RF switches
  192. hal_gpio_init(&gpio_rf_sw_0, GpioModeOutputPushPull, GpioPullNo, GpioSpeedLow);
  193. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW);
  194. // Go to sleep
  195. cc1101_shutdown(device);
  196. furi_hal_spi_device_return(device);
  197. FURI_LOG_I("FuriHalSubGhz", "Init OK");
  198. }
  199. void furi_hal_subghz_sleep() {
  200. furi_assert(furi_hal_subghz_state == SubGhzStateIdle);
  201. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  202. cc1101_switch_to_idle(device);
  203. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  204. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  205. cc1101_shutdown(device);
  206. furi_hal_spi_device_return(device);
  207. }
  208. void furi_hal_subghz_dump_state() {
  209. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  210. printf(
  211. "[furi_hal_subghz] cc1101 chip %d, version %d\r\n",
  212. cc1101_get_partnumber(device),
  213. cc1101_get_version(device));
  214. furi_hal_spi_device_return(device);
  215. }
  216. void furi_hal_subghz_load_preset(FuriHalSubGhzPreset preset) {
  217. if(preset == FuriHalSubGhzPresetOok650Async) {
  218. furi_hal_subghz_load_registers(furi_hal_subghz_preset_ook_650khz_async_regs);
  219. furi_hal_subghz_load_patable(furi_hal_subghz_preset_ook_async_patable);
  220. } else if(preset == FuriHalSubGhzPresetOok270Async) {
  221. furi_hal_subghz_load_registers(furi_hal_subghz_preset_ook_270khz_async_regs);
  222. furi_hal_subghz_load_patable(furi_hal_subghz_preset_ook_async_patable);
  223. } else if(preset == FuriHalSubGhzPreset2FSKAsync) {
  224. furi_hal_subghz_load_registers(furi_hal_subghz_preset_2fsk_async_regs);
  225. furi_hal_subghz_load_patable(furi_hal_subghz_preset_2fsk_async_patable);
  226. } else {
  227. furi_crash(NULL);
  228. }
  229. }
  230. void furi_hal_subghz_load_registers(const uint8_t data[][2]) {
  231. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  232. cc1101_reset(device);
  233. uint32_t i = 0;
  234. while(data[i][0]) {
  235. cc1101_write_reg(device, data[i][0], data[i][1]);
  236. i++;
  237. }
  238. furi_hal_spi_device_return(device);
  239. }
  240. void furi_hal_subghz_load_patable(const uint8_t data[8]) {
  241. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  242. cc1101_set_pa_table(device, data);
  243. furi_hal_spi_device_return(device);
  244. }
  245. void furi_hal_subghz_write_packet(const uint8_t* data, uint8_t size) {
  246. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  247. cc1101_flush_tx(device);
  248. cc1101_write_fifo(device, data, size);
  249. furi_hal_spi_device_return(device);
  250. }
  251. void furi_hal_subghz_flush_rx() {
  252. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  253. cc1101_flush_rx(device);
  254. furi_hal_spi_device_return(device);
  255. }
  256. void furi_hal_subghz_read_packet(uint8_t* data, uint8_t* size) {
  257. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  258. cc1101_read_fifo(device, data, size);
  259. furi_hal_spi_device_return(device);
  260. }
  261. void furi_hal_subghz_shutdown() {
  262. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  263. // Reset and shutdown
  264. cc1101_shutdown(device);
  265. furi_hal_spi_device_return(device);
  266. }
  267. void furi_hal_subghz_reset() {
  268. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  269. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  270. cc1101_switch_to_idle(device);
  271. cc1101_reset(device);
  272. cc1101_write_reg(device, CC1101_IOCFG0, CC1101IocfgHighImpedance);
  273. furi_hal_spi_device_return(device);
  274. }
  275. void furi_hal_subghz_idle() {
  276. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  277. cc1101_switch_to_idle(device);
  278. furi_hal_spi_device_return(device);
  279. }
  280. void furi_hal_subghz_rx() {
  281. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  282. cc1101_switch_to_rx(device);
  283. furi_hal_spi_device_return(device);
  284. }
  285. bool furi_hal_subghz_tx() {
  286. if(furi_hal_subghz_regulation != SubGhzRegulationTxRx) return false;
  287. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  288. cc1101_switch_to_tx(device);
  289. furi_hal_spi_device_return(device);
  290. return true;
  291. }
  292. float furi_hal_subghz_get_rssi() {
  293. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  294. int32_t rssi_dec = cc1101_get_rssi(device);
  295. furi_hal_spi_device_return(device);
  296. float rssi = rssi_dec;
  297. if(rssi_dec >= 128) {
  298. rssi = ((rssi - 256.0f) / 2.0f) - 74.0f;
  299. } else {
  300. rssi = (rssi / 2.0f) - 74.0f;
  301. }
  302. return rssi;
  303. }
  304. bool furi_hal_subghz_is_frequency_valid(uint32_t value) {
  305. if(!(value >= 299999755 && value <= 348000335) &&
  306. !(value >= 386999938 && value <= 464000000) &&
  307. !(value >= 778999847 && value <= 928000000)) {
  308. return false;
  309. }
  310. return true;
  311. }
  312. uint32_t furi_hal_subghz_set_frequency_and_path(uint32_t value) {
  313. value = furi_hal_subghz_set_frequency(value);
  314. if(value >= 299999755 && value <= 348000335) {
  315. furi_hal_subghz_set_path(FuriHalSubGhzPath315);
  316. } else if(value >= 386999938 && value <= 464000000) {
  317. furi_hal_subghz_set_path(FuriHalSubGhzPath433);
  318. } else if(value >= 778999847 && value <= 928000000) {
  319. furi_hal_subghz_set_path(FuriHalSubGhzPath868);
  320. } else {
  321. furi_crash(NULL);
  322. }
  323. return value;
  324. }
  325. uint32_t furi_hal_subghz_set_frequency(uint32_t value) {
  326. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  327. //checking regional settings
  328. bool txrx = false;
  329. switch(furi_hal_version_get_hw_region()) {
  330. case FuriHalVersionRegionEuRu:
  331. //433,05..434,79; 868,15..868,55
  332. if(!(value >= 433050000 && value <= 434790000) &&
  333. !(value >= 868150000 && value <= 8680550000)) {
  334. } else {
  335. txrx = true;
  336. }
  337. break;
  338. case FuriHalVersionRegionUsCaAu:
  339. //304,10..315,25; 433,05..434,79; 915,00..928,00
  340. if(!(value >= 304100000 && value <= 315250000) &&
  341. !(value >= 433050000 && value <= 434790000) &&
  342. !(value >= 915000000 && value <= 928000000)) {
  343. } else {
  344. txrx = true;
  345. }
  346. break;
  347. case FuriHalVersionRegionJp:
  348. //312,00..315,25; 920,50..923,50
  349. if(!(value >= 312000000 && value <= 315250000) &&
  350. !(value >= 920500000 && value <= 923500000)) {
  351. } else {
  352. txrx = true;
  353. }
  354. break;
  355. default:
  356. txrx = true;
  357. break;
  358. }
  359. if(txrx) {
  360. furi_hal_subghz_regulation = SubGhzRegulationTxRx;
  361. } else {
  362. furi_hal_subghz_regulation = SubGhzRegulationOnlyRx;
  363. }
  364. uint32_t real_frequency = cc1101_set_frequency(device, value);
  365. cc1101_calibrate(device);
  366. while(true) {
  367. CC1101Status status = cc1101_get_status(device);
  368. if(status.STATE == CC1101StateIDLE) break;
  369. }
  370. furi_hal_spi_device_return(device);
  371. return real_frequency;
  372. }
  373. void furi_hal_subghz_set_path(FuriHalSubGhzPath path) {
  374. const FuriHalSpiDevice* device = furi_hal_spi_device_get(FuriHalSpiDeviceIdSubGhz);
  375. if(path == FuriHalSubGhzPath433) {
  376. hal_gpio_write(&gpio_rf_sw_0, 0);
  377. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW | CC1101_IOCFG_INV);
  378. } else if(path == FuriHalSubGhzPath315) {
  379. hal_gpio_write(&gpio_rf_sw_0, 1);
  380. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW);
  381. } else if(path == FuriHalSubGhzPath868) {
  382. hal_gpio_write(&gpio_rf_sw_0, 1);
  383. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW | CC1101_IOCFG_INV);
  384. } else if(path == FuriHalSubGhzPathIsolate) {
  385. hal_gpio_write(&gpio_rf_sw_0, 0);
  386. cc1101_write_reg(device, CC1101_IOCFG2, CC1101IocfgHW);
  387. } else {
  388. furi_crash(NULL);
  389. }
  390. furi_hal_spi_device_return(device);
  391. }
  392. volatile uint32_t furi_hal_subghz_capture_delta_duration = 0;
  393. volatile FuriHalSubGhzCaptureCallback furi_hal_subghz_capture_callback = NULL;
  394. volatile void* furi_hal_subghz_capture_callback_context = NULL;
  395. static void furi_hal_subghz_capture_ISR() {
  396. // Channel 1
  397. if(LL_TIM_IsActiveFlag_CC1(TIM2)) {
  398. LL_TIM_ClearFlag_CC1(TIM2);
  399. furi_hal_subghz_capture_delta_duration = LL_TIM_IC_GetCaptureCH1(TIM2);
  400. if(furi_hal_subghz_capture_callback) {
  401. furi_hal_subghz_capture_callback(
  402. true,
  403. furi_hal_subghz_capture_delta_duration,
  404. (void*)furi_hal_subghz_capture_callback_context);
  405. }
  406. }
  407. // Channel 2
  408. if(LL_TIM_IsActiveFlag_CC2(TIM2)) {
  409. LL_TIM_ClearFlag_CC2(TIM2);
  410. if(furi_hal_subghz_capture_callback) {
  411. furi_hal_subghz_capture_callback(
  412. false,
  413. LL_TIM_IC_GetCaptureCH2(TIM2) - furi_hal_subghz_capture_delta_duration,
  414. (void*)furi_hal_subghz_capture_callback_context);
  415. }
  416. }
  417. }
  418. void furi_hal_subghz_start_async_rx(FuriHalSubGhzCaptureCallback callback, void* context) {
  419. furi_assert(furi_hal_subghz_state == SubGhzStateIdle);
  420. furi_hal_subghz_state = SubGhzStateAsyncRx;
  421. furi_hal_subghz_capture_callback = callback;
  422. furi_hal_subghz_capture_callback_context = context;
  423. hal_gpio_init_ex(
  424. &gpio_cc1101_g0, GpioModeAltFunctionPushPull, GpioPullNo, GpioSpeedLow, GpioAltFn1TIM2);
  425. // Timer: base
  426. LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_TIM2);
  427. LL_TIM_InitTypeDef TIM_InitStruct = {0};
  428. TIM_InitStruct.Prescaler = 64 - 1;
  429. TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
  430. TIM_InitStruct.Autoreload = 0x7FFFFFFE;
  431. TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV4;
  432. LL_TIM_Init(TIM2, &TIM_InitStruct);
  433. // Timer: advanced
  434. LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
  435. LL_TIM_DisableARRPreload(TIM2);
  436. LL_TIM_SetTriggerInput(TIM2, LL_TIM_TS_TI2FP2);
  437. LL_TIM_SetSlaveMode(TIM2, LL_TIM_SLAVEMODE_RESET);
  438. LL_TIM_SetTriggerOutput(TIM2, LL_TIM_TRGO_RESET);
  439. LL_TIM_EnableMasterSlaveMode(TIM2);
  440. LL_TIM_DisableDMAReq_TRIG(TIM2);
  441. LL_TIM_DisableIT_TRIG(TIM2);
  442. // Timer: channel 1 indirect
  443. LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ACTIVEINPUT_INDIRECTTI);
  444. LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ICPSC_DIV1);
  445. LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_POLARITY_FALLING);
  446. LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_FILTER_FDIV1);
  447. // Timer: channel 2 direct
  448. LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_ACTIVEINPUT_DIRECTTI);
  449. LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_ICPSC_DIV1);
  450. LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_IC_POLARITY_RISING);
  451. LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH2, LL_TIM_IC_FILTER_FDIV32_N8);
  452. // ISR setup
  453. furi_hal_interrupt_set_timer_isr(TIM2, furi_hal_subghz_capture_ISR);
  454. NVIC_SetPriority(TIM2_IRQn, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 5, 0));
  455. NVIC_EnableIRQ(TIM2_IRQn);
  456. // Interrupts and channels
  457. LL_TIM_EnableIT_CC1(TIM2);
  458. LL_TIM_EnableIT_CC2(TIM2);
  459. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH1);
  460. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH2);
  461. // Enable NVIC
  462. NVIC_SetPriority(TIM2_IRQn, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 5, 0));
  463. NVIC_EnableIRQ(TIM2_IRQn);
  464. // Start timer
  465. LL_TIM_SetCounter(TIM2, 0);
  466. LL_TIM_EnableCounter(TIM2);
  467. // Switch to RX
  468. furi_hal_subghz_rx();
  469. }
  470. void furi_hal_subghz_stop_async_rx() {
  471. furi_assert(furi_hal_subghz_state == SubGhzStateAsyncRx);
  472. furi_hal_subghz_state = SubGhzStateIdle;
  473. // Shutdown radio
  474. furi_hal_subghz_idle();
  475. LL_TIM_DeInit(TIM2);
  476. LL_APB1_GRP1_DisableClock(LL_APB1_GRP1_PERIPH_TIM2);
  477. furi_hal_interrupt_set_timer_isr(TIM2, NULL);
  478. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  479. }
  480. #define API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL (256)
  481. #define API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF (API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL / 2)
  482. #define API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME 333
  483. typedef struct {
  484. uint32_t* buffer;
  485. bool flip_flop;
  486. FuriHalSubGhzAsyncTxCallback callback;
  487. void* callback_context;
  488. } FuriHalSubGhzAsyncTx;
  489. static FuriHalSubGhzAsyncTx furi_hal_subghz_async_tx = {0};
  490. static void furi_hal_subghz_async_tx_refill(uint32_t* buffer, size_t samples) {
  491. while(samples > 0) {
  492. bool is_odd = samples % 2;
  493. LevelDuration ld =
  494. furi_hal_subghz_async_tx.callback(furi_hal_subghz_async_tx.callback_context);
  495. if(level_duration_is_reset(ld)) {
  496. // One more even sample required to end at low level
  497. if(is_odd) {
  498. *buffer = API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  499. buffer++;
  500. samples--;
  501. }
  502. break;
  503. } else {
  504. // Inject guard time if level is incorrect
  505. if(is_odd == level_duration_get_level(ld)) {
  506. *buffer = API_HAL_SUBGHZ_ASYNC_TX_GUARD_TIME;
  507. buffer++;
  508. samples--;
  509. }
  510. uint32_t duration = level_duration_get_duration(ld);
  511. assert(duration > 0);
  512. *buffer = duration;
  513. buffer++;
  514. samples--;
  515. }
  516. }
  517. memset(buffer, 0, samples * sizeof(uint32_t));
  518. }
  519. static void furi_hal_subghz_async_tx_dma_isr() {
  520. furi_assert(furi_hal_subghz_state == SubGhzStateAsyncTx);
  521. if(LL_DMA_IsActiveFlag_HT1(DMA1)) {
  522. LL_DMA_ClearFlag_HT1(DMA1);
  523. furi_hal_subghz_async_tx_refill(
  524. furi_hal_subghz_async_tx.buffer, API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF);
  525. }
  526. if(LL_DMA_IsActiveFlag_TC1(DMA1)) {
  527. LL_DMA_ClearFlag_TC1(DMA1);
  528. furi_hal_subghz_async_tx_refill(
  529. furi_hal_subghz_async_tx.buffer + API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF,
  530. API_HAL_SUBGHZ_ASYNC_TX_BUFFER_HALF);
  531. }
  532. }
  533. static void furi_hal_subghz_async_tx_timer_isr() {
  534. if(LL_TIM_IsActiveFlag_UPDATE(TIM2)) {
  535. LL_TIM_ClearFlag_UPDATE(TIM2);
  536. if(LL_TIM_GetAutoReload(TIM2) == 0) {
  537. if(furi_hal_subghz_state == SubGhzStateAsyncTx) {
  538. furi_hal_subghz_state = SubGhzStateAsyncTxLast;
  539. //forcibly pulls the pin to the ground so that there is no carrier
  540. hal_gpio_init(&gpio_cc1101_g0, GpioModeInput, GpioPullDown, GpioSpeedLow);
  541. } else {
  542. furi_hal_subghz_state = SubGhzStateAsyncTxEnd;
  543. LL_TIM_DisableCounter(TIM2);
  544. }
  545. }
  546. }
  547. }
  548. bool furi_hal_subghz_start_async_tx(FuriHalSubGhzAsyncTxCallback callback, void* context) {
  549. furi_assert(furi_hal_subghz_state == SubGhzStateIdle);
  550. furi_assert(callback);
  551. //If transmission is prohibited by regional settings
  552. if(furi_hal_subghz_regulation != SubGhzRegulationTxRx) return false;
  553. furi_hal_subghz_async_tx.callback = callback;
  554. furi_hal_subghz_async_tx.callback_context = context;
  555. furi_hal_subghz_state = SubGhzStateAsyncTx;
  556. furi_hal_subghz_async_tx.buffer =
  557. furi_alloc(API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL * sizeof(uint32_t));
  558. furi_hal_subghz_async_tx_refill(
  559. furi_hal_subghz_async_tx.buffer, API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL);
  560. // Connect CC1101_GD0 to TIM2 as output
  561. hal_gpio_init_ex(
  562. &gpio_cc1101_g0, GpioModeAltFunctionPushPull, GpioPullDown, GpioSpeedLow, GpioAltFn1TIM2);
  563. // Configure DMA
  564. LL_DMA_InitTypeDef dma_config = {0};
  565. dma_config.PeriphOrM2MSrcAddress = (uint32_t) & (TIM2->ARR);
  566. dma_config.MemoryOrM2MDstAddress = (uint32_t)furi_hal_subghz_async_tx.buffer;
  567. dma_config.Direction = LL_DMA_DIRECTION_MEMORY_TO_PERIPH;
  568. dma_config.Mode = LL_DMA_MODE_CIRCULAR;
  569. dma_config.PeriphOrM2MSrcIncMode = LL_DMA_PERIPH_NOINCREMENT;
  570. dma_config.MemoryOrM2MDstIncMode = LL_DMA_MEMORY_INCREMENT;
  571. dma_config.PeriphOrM2MSrcDataSize = LL_DMA_PDATAALIGN_WORD;
  572. dma_config.MemoryOrM2MDstDataSize = LL_DMA_MDATAALIGN_WORD;
  573. dma_config.NbData = API_HAL_SUBGHZ_ASYNC_TX_BUFFER_FULL;
  574. dma_config.PeriphRequest = LL_DMAMUX_REQ_TIM2_UP;
  575. dma_config.Priority = LL_DMA_MODE_NORMAL;
  576. LL_DMA_Init(DMA1, LL_DMA_CHANNEL_1, &dma_config);
  577. furi_hal_interrupt_set_dma_channel_isr(
  578. DMA1, LL_DMA_CHANNEL_1, furi_hal_subghz_async_tx_dma_isr);
  579. LL_DMA_EnableIT_TC(DMA1, LL_DMA_CHANNEL_1);
  580. LL_DMA_EnableIT_HT(DMA1, LL_DMA_CHANNEL_1);
  581. LL_DMA_EnableChannel(DMA1, LL_DMA_CHANNEL_1);
  582. // Configure TIM2
  583. LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_TIM2);
  584. LL_TIM_InitTypeDef TIM_InitStruct = {0};
  585. TIM_InitStruct.Prescaler = 64 - 1;
  586. TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
  587. TIM_InitStruct.Autoreload = 1000;
  588. TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV1;
  589. LL_TIM_Init(TIM2, &TIM_InitStruct);
  590. LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
  591. LL_TIM_EnableARRPreload(TIM2);
  592. // Configure TIM2 CH2
  593. LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {0};
  594. TIM_OC_InitStruct.OCMode = LL_TIM_OCMODE_TOGGLE;
  595. TIM_OC_InitStruct.OCState = LL_TIM_OCSTATE_DISABLE;
  596. TIM_OC_InitStruct.OCNState = LL_TIM_OCSTATE_DISABLE;
  597. TIM_OC_InitStruct.CompareValue = 0;
  598. TIM_OC_InitStruct.OCPolarity = LL_TIM_OCPOLARITY_HIGH;
  599. LL_TIM_OC_Init(TIM2, LL_TIM_CHANNEL_CH2, &TIM_OC_InitStruct);
  600. LL_TIM_OC_DisableFast(TIM2, LL_TIM_CHANNEL_CH2);
  601. LL_TIM_DisableMasterSlaveMode(TIM2);
  602. furi_hal_interrupt_set_timer_isr(TIM2, furi_hal_subghz_async_tx_timer_isr);
  603. LL_TIM_EnableIT_UPDATE(TIM2);
  604. LL_TIM_EnableDMAReq_UPDATE(TIM2);
  605. LL_TIM_CC_EnableChannel(TIM2, LL_TIM_CHANNEL_CH2);
  606. // Start counter
  607. LL_TIM_GenerateEvent_UPDATE(TIM2);
  608. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  609. hal_gpio_write(&FURI_HAL_SUBGHZ_TX_GPIO, true);
  610. #endif
  611. furi_hal_subghz_tx();
  612. // Enable NVIC
  613. NVIC_SetPriority(TIM2_IRQn, NVIC_EncodePriority(NVIC_GetPriorityGrouping(), 5, 0));
  614. NVIC_EnableIRQ(TIM2_IRQn);
  615. LL_TIM_SetCounter(TIM2, 0);
  616. LL_TIM_EnableCounter(TIM2);
  617. return true;
  618. }
  619. bool furi_hal_subghz_is_async_tx_complete() {
  620. return furi_hal_subghz_state == SubGhzStateAsyncTxEnd;
  621. }
  622. void furi_hal_subghz_stop_async_tx() {
  623. furi_assert(
  624. furi_hal_subghz_state == SubGhzStateAsyncTx ||
  625. furi_hal_subghz_state == SubGhzStateAsyncTxLast ||
  626. furi_hal_subghz_state == SubGhzStateAsyncTxEnd);
  627. // Shutdown radio
  628. furi_hal_subghz_idle();
  629. #ifdef FURI_HAL_SUBGHZ_TX_GPIO
  630. hal_gpio_write(&FURI_HAL_SUBGHZ_TX_GPIO, false);
  631. #endif
  632. // Deinitialize Timer
  633. LL_TIM_DeInit(TIM2);
  634. LL_APB1_GRP1_DisableClock(LL_APB1_GRP1_PERIPH_TIM2);
  635. furi_hal_interrupt_set_timer_isr(TIM2, NULL);
  636. // Deinitialize DMA
  637. LL_DMA_DeInit(DMA1, LL_DMA_CHANNEL_1);
  638. furi_hal_interrupt_set_dma_channel_isr(DMA1, LL_DMA_CHANNEL_1, NULL);
  639. // Deinitialize GPIO
  640. hal_gpio_init(&gpio_cc1101_g0, GpioModeAnalog, GpioPullNo, GpioSpeedLow);
  641. free(furi_hal_subghz_async_tx.buffer);
  642. furi_hal_subghz_state = SubGhzStateIdle;
  643. }