myRadio.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728
  1. #include "myRadio.h"
  2. #include "myRadio_gpio.h"
  3. #include "common.h"
  4. #include "SN_TIM1_INIT.h"
  5. /**-------------------------radio include----------------------------------**/
  6. #include "pan_rf.h"
  7. /**-------------------------radio include end----------------------------------**/
  8. static int8_t rfTxPower;
  9. static uint32_t rfFrequence;
  10. static uint32_t rfBaudrate;
  11. static uint8_t rfSyncword;
  12. static uint8_t rf_sf;
  13. static uint8_t rf_bw;
  14. static uint8_t rf_cr;
  15. static rfRxCallBack rxCb;
  16. static uint8_t rfRxBuffer[64];
  17. static uint32_t rf_handle;
  18. static uint8_t rf_workProcess = RF_PRC_IDLE;
  19. static uint8_t chipType;
  20. static uint32_t cadCheckWindow_ms = 0;
  21. static uint32_t cadCheckInterval_ms = 0;
  22. static uint32_t cadCheckWindowCount_ms = 0;
  23. static uint32_t cadCheckIntervalCount_ms = 0;
  24. /**-------------------------radio params----------------------------------**/
  25. typedef struct
  26. {
  27. int8_t power;
  28. uint8_t regValue;
  29. }rfPowerReg_ts;
  30. rfPowerReg_ts rfPowerRegTab[RF_TX_PWR_MAX_COUNT] =
  31. {
  32. {
  33. .power = -26,
  34. .regValue = 1,
  35. },
  36. {
  37. .power = -17,
  38. .regValue = 2,
  39. },
  40. {
  41. .power = -5,
  42. .regValue = 3,
  43. },
  44. {
  45. .power = -3,
  46. .regValue = 4,
  47. },
  48. {
  49. .power = -2,
  50. .regValue = 5,
  51. },
  52. {
  53. .power = -1,
  54. .regValue = 6,
  55. },
  56. {
  57. .power = 2,
  58. .regValue = 7,
  59. },
  60. {
  61. .power = 4,
  62. .regValue = 8,
  63. },
  64. {
  65. .power = 5,
  66. .regValue = 9,
  67. },
  68. {
  69. .power = 7,
  70. .regValue = 10,
  71. },
  72. {
  73. .power = 8,
  74. .regValue = 11,
  75. },
  76. {
  77. .power = 9,
  78. .regValue = 12,
  79. },
  80. {
  81. .power = 10,
  82. .regValue = 13,
  83. },
  84. {
  85. .power = 11,
  86. .regValue = 14,
  87. },
  88. {
  89. .power = 12,
  90. .regValue = 15,
  91. },
  92. {
  93. .power = 13,
  94. .regValue = 16,
  95. },
  96. {
  97. .power = 14,
  98. .regValue = 17,
  99. },
  100. {
  101. .power = 15,
  102. .regValue = 18,
  103. },
  104. {
  105. .power = 16,
  106. .regValue = 19,
  107. },
  108. {
  109. .power = 17,
  110. .regValue = 20,
  111. },
  112. {
  113. .power = 18,
  114. .regValue = 21,
  115. },
  116. {
  117. .power = 19,
  118. .regValue = 22,
  119. },
  120. {
  121. .power = 20,
  122. .regValue = 22,
  123. }
  124. };
  125. const loraBaudrateFrame_ts loraBaudrateFrame[MAX_RF_BAUDRATE_COUNT] =
  126. {
  127. {//244.14bps,SF=12,BW=62.5kHz(6),CR=2
  128. .SpreadingFactor = 12,
  129. .SignalBw = 6,
  130. .ErrorCoding = 2,
  131. },
  132. {//627.79 bps,SF=9,BW=62.5kHz(6),CR=3
  133. .SpreadingFactor = 9,
  134. .SignalBw = 6,
  135. .ErrorCoding = 4,
  136. },
  137. {//1,255.58 bps,SF=9,BW=125kHz(7),CR=3
  138. .SpreadingFactor = 9,
  139. .SignalBw = 7,
  140. .ErrorCoding = 3,
  141. },
  142. {//2,511.16 bps,SF=8,BW=125kHz(7),CR=2
  143. .SpreadingFactor = 8,
  144. .SignalBw = 7,
  145. .ErrorCoding = 2,
  146. },
  147. {//5022.32bps,SF=8,BW=250kHz(8),CR=2
  148. .SpreadingFactor = 8,
  149. .SignalBw = 8,
  150. .ErrorCoding = 2,
  151. },
  152. {//12500bps,SF=8,BW=500kHz(9),CR=1
  153. .SpreadingFactor = 8,
  154. .SignalBw = 9,
  155. .ErrorCoding = 1,
  156. },
  157. {//20400bps,SF=8,BW=500kHz(9),CR=1
  158. .SpreadingFactor = 7,
  159. .SignalBw = 9,
  160. .ErrorCoding = 1,
  161. },
  162. {//62500bps,SF=5,BW=500kHz(9),CR=1
  163. .SpreadingFactor = 7,
  164. .SignalBw = 9,
  165. .ErrorCoding = 1,
  166. },
  167. };
  168. bool rf_ifq;
  169. uint8_t regulatorMode = USE_LDO;
  170. extern struct RxDoneMsg RxDoneParams;
  171. uint8_t getRfPowerTabIndex(int8_t power);
  172. /**-------------------------radio params end----------------------------------**/
  173. void myRadio_delay(uint32_t time_ms)
  174. {
  175. std_delayms(time_ms);
  176. }
  177. /**
  178. * @brief IO口中断回调
  179. * IO口产生中断后会执行该函数
  180. * 用于接收射频工作的中断响应
  181. *
  182. * @param index
  183. */
  184. void myRadio_gpioCallback(uint8_t index)
  185. {
  186. rf_ifq = true;
  187. }
  188. /**
  189. * @brief IO口中断回调
  190. * IO口产生中断后会执行该函数
  191. * 用于接收射频工作的中断响应
  192. *
  193. * @param index
  194. */
  195. void myRadio_gpioCadCallback(uint8_t index)
  196. {
  197. if (rf_workProcess != RF_PRC_CAD_RX)
  198. {
  199. return;
  200. }
  201. printf("cad = %d= %d\r\n", rf_workProcess, SN_GPIO_PIN_get(RF_PAN3029_IO11));
  202. rf_workProcess = RF_PRC_IDLE;
  203. if (SN_GPIO_PIN_get(RF_PAN3029_IO11))
  204. {
  205. cadCheckWindowCount_ms = 0;
  206. // cadCheckIntervalCount_ms = 0;
  207. printf("gpioCad\n");
  208. // RF_StopCad();
  209. // myRadio_receiver();
  210. rf_workProcess = RF_PRC_RX;
  211. }
  212. else
  213. {
  214. }
  215. }
  216. void myRadio_timCallback(uint8_t index)
  217. {
  218. static uint32_t tiout = 0;
  219. tiout++;
  220. if (tiout > 1000)
  221. {
  222. tiout = 0;
  223. }
  224. if (cadCheckWindowCount_ms)
  225. {
  226. cadCheckWindowCount_ms--;
  227. if (cadCheckWindowCount_ms == 0)
  228. {
  229. RF_StopCad();
  230. rf_workProcess = RF_PRC_IDLE;
  231. // RF_EnterSleepState();
  232. printf("Window Window=%d Interval=%d\n", cadCheckWindowCount_ms, cadCheckIntervalCount_ms);
  233. }
  234. }
  235. if (cadCheckIntervalCount_ms)
  236. {
  237. cadCheckIntervalCount_ms--;
  238. if (cadCheckIntervalCount_ms == 0)
  239. {
  240. printf("Interval Window=%d Interval=%d\n", cadCheckWindowCount_ms, cadCheckIntervalCount_ms);
  241. // RF_ExitSleepState();
  242. myRadio_restartCadReceiver();
  243. }
  244. }
  245. }
  246. /**
  247. * @brief 射频初始化
  248. *
  249. * @param agr0
  250. * @param agr1_ptr 无线工作状态响应回调
  251. * 产生回调给外部使用,@rfRxCallBack
  252. */
  253. void myRadio_init(int agr0, void *agr1_ptr)
  254. {
  255. myRadio_gpio_init(myRadio_gpioCallback);
  256. SN_EXIT_set(RF_PAN3029_IO11,GPIO_NOPULL,myRadio_gpioCadCallback,EXTI_TRIGGER_RISING_FALLING,NVIC_PRIO_3);
  257. /**-------------------------radio init----------------------------------**/
  258. int ret = 0;
  259. #ifdef SPI_SOFT_3LINE
  260. RF_WriteReg(0x00, 0x03); /* 选择寄存器页3 */
  261. RF_WriteReg(0x1A, 0x83); /* 使能3ine SPI */
  262. #endif
  263. ret = RF_Init();
  264. if(ret != RF_OK)
  265. {
  266. // printf(" RF Init Fail");
  267. while(1);
  268. }
  269. RF_ConfigUserParams(); /* 配置 frequency、SF、BW、Preamble、CRC等参数 */
  270. // RF_SetRegulatorMode(regulatorMode); /* 设置芯片为LDO电源模式 */
  271. SN_TIM1_CALL_set(1000 ,TIM1_AGAIN_WORK ,myRadio_timCallback ,NVIC_PRIO_2);
  272. /**-------------------------radio init end----------------------------------**/
  273. myRadio_delay(10);
  274. RF_EXT_PA_TO_IDLE();
  275. if ((rfRxCallBack )agr1_ptr)
  276. {
  277. rxCb = (rfRxCallBack )agr1_ptr;
  278. }
  279. rf_handle = 0xe5;
  280. }
  281. void RadioSetregulatorMode(uint8_t mode)
  282. {
  283. regulatorMode = mode;
  284. }
  285. /**
  286. * @brief 射频底层执行程序
  287. * 要放在主循环中执行
  288. *
  289. */
  290. void myRadio_process(void)
  291. {
  292. rfRxPacket_ts rfRxPacket;
  293. if (rf_handle == 0)
  294. {
  295. return;
  296. }
  297. if (rf_ifq == false)
  298. {
  299. return;
  300. }
  301. rf_ifq = false;
  302. printf("rf_process=%d\n", rf_workProcess);
  303. if (!((rf_workProcess == RF_PRC_TX) || (rf_workProcess == RF_PRC_RX) ))
  304. {
  305. return;
  306. }
  307. uint8_t IRQFlag;
  308. IRQFlag = RF_GetIRQFlag(); /* 获取中断标志位 */
  309. printf("IRQFlag=0x%X\n", IRQFlag);
  310. if (IRQFlag & RF_IRQ_TX_DONE) /* 发送完成中断 */
  311. {
  312. RF_TurnoffLdoPA(); /* 发送完成后须关闭内部PA */
  313. RF_ClrIRQFlag(RF_IRQ_TX_DONE); /* 清除发送完成中断标志位 */
  314. IRQFlag &= ~RF_IRQ_TX_DONE;
  315. RF_EnterStandbyState(); /* 发送完成后须设置为RF_STATE_STB3状态 */
  316. // printf(">>RF_IRQ_TX_DONE!\r\n");
  317. RF_EXT_PA_TO_IDLE();
  318. if (rxCb)
  319. {
  320. rxCb(TX_STA_SECCESS, rfRxPacket);
  321. }
  322. }
  323. if (IRQFlag & RF_IRQ_RX_DONE) /* 接收完成中断 */
  324. {
  325. // g_RfRxPkt.Snr = RF_GetPktSnr(); /* 获取接收数据包的SNR值 */
  326. rfRxPacket.rssi = RF_GetPktRssi(); /* 获取接收数据包的RSSI值 */
  327. rfRxPacket.len = RF_GetRecvPayload(rfRxPacket.payload); /* 获取接收数据和长度 */
  328. // printf(">>RF_IRQ_RX_DONE!\r\n");
  329. // printf("+RxLen=%d, Rx Count=%d\n", g_RfRxPkt.RxLen, ++g_RxCount);
  330. // printf("+RxHexData:\r\n");
  331. // print_hex(g_RfRxPkt.RxBuf, g_RfRxPkt.RxLen); /* 以十六进制方式打印接收数据 */
  332. // printf("SNR:%ddB, RSSI:%ddBm \r\n", (int)g_RfRxPkt.Snr, (int)g_RfRxPkt.Rssi);
  333. RF_ClrIRQFlag(RF_IRQ_RX_DONE); /* 清除接收完成中断标志位 */
  334. IRQFlag &= ~RF_IRQ_RX_DONE;
  335. RF_EXT_PA_TO_IDLE();
  336. if (rxCb)
  337. {
  338. rxCb(RX_STA_SECCESS, rfRxPacket);
  339. }
  340. }
  341. if (IRQFlag & RF_IRQ_CRC_ERR) /* CRC错误中断 */
  342. {
  343. RF_ClrIRQFlag(RF_IRQ_CRC_ERR); /* 清除CRC错误中断标志位 */
  344. IRQFlag &= ~RF_IRQ_CRC_ERR;
  345. // printf(">>RF_IRQ_CRC_ERR\r\n");
  346. RF_EXT_PA_TO_IDLE();
  347. if (rxCb)
  348. {
  349. rxCb(RX_STA_PAYLOAD_ERROR, rfRxPacket);
  350. }
  351. }
  352. if (IRQFlag & RF_IRQ_RX_TIMEOUT) /* 接收超时中断 */
  353. {
  354. RF_ClrIRQFlag(RF_IRQ_RX_TIMEOUT); /* 清除接收超时中断标志位 */
  355. IRQFlag &= ~RF_IRQ_RX_TIMEOUT;
  356. // printf(">>RF_IRQ_RX_TIMEOUT\r\n");
  357. RF_EXT_PA_TO_IDLE();
  358. if (rxCb)
  359. {
  360. rxCb(RX_STA_TIMEOUT, rfRxPacket);
  361. }
  362. }
  363. if (IRQFlag)
  364. {
  365. RF_ClrIRQFlag(IRQFlag); /* 清除未处理的中断标志位 */
  366. }
  367. }
  368. /**
  369. * @brief 退出射频进入休眠
  370. *
  371. */
  372. void myRadio_abort(void)
  373. {
  374. if (rf_handle == 0)
  375. {
  376. return;
  377. }
  378. RF_EXT_PA_TO_IDLE();
  379. // rf_deepsleep();
  380. RF_EnterSleepState();
  381. rf_workProcess = RF_PRC_SLEEP;
  382. }
  383. /**
  384. * @brief 获取射频工作中心频率
  385. *
  386. * @return uint32_t
  387. */
  388. uint32_t myRadio_getFrequency(void)
  389. {
  390. if (rf_handle == 0)
  391. {
  392. return 0;
  393. }
  394. return rfFrequence;
  395. }
  396. /**
  397. * @brief 设置射频工作中心频率
  398. *
  399. * @param freq
  400. * 具体频点,单位:Hz
  401. */
  402. void myRadio_setFrequency(uint32_t freq)
  403. {
  404. if (rf_handle == 0)
  405. {
  406. return;
  407. }
  408. rfFrequence = freq;
  409. RF_SetFreq(rfFrequence);
  410. }
  411. /**
  412. * @brief 获取发射功率
  413. *
  414. * @return int8_t
  415. */
  416. int8_t myRadio_getTxPower(void)
  417. {
  418. if (rf_handle == 0)
  419. {
  420. return 0;
  421. }
  422. return rfTxPower;
  423. }
  424. /**
  425. * @brief 设置发射功率
  426. *
  427. * @param power
  428. * 单位:dbm
  429. */
  430. void myRadio_setTxPower(int8_t power)
  431. {
  432. if (rf_handle == 0)
  433. {
  434. return;
  435. }
  436. rfTxPower = power;
  437. RF_SetTxPower(rfPowerRegTab[getRfPowerTabIndex(rfTxPower)].regValue);
  438. }
  439. /**
  440. * 获取射频波特率
  441. * @param : br->
  442. */
  443. uint32_t myRadio_getBaudrate(void)
  444. {
  445. if (rf_handle == 0)
  446. {
  447. return 0;
  448. }
  449. return rfBaudrate;
  450. }
  451. /**
  452. * 设置射频波特率
  453. * @param : br->
  454. */
  455. void myRadio_setBaudrate(uint32_t br)
  456. {
  457. if (rf_handle == 0)
  458. {
  459. return;
  460. }
  461. rfBaudrate = br;
  462. RF_SetCR(loraBaudrateFrame[br].ErrorCoding);
  463. RF_SetBW(loraBaudrateFrame[br].SignalBw);
  464. RF_SetSF(loraBaudrateFrame[br].SpreadingFactor);
  465. }
  466. void myRadio_setSyncWord(uint8_t syncword)
  467. {
  468. if (rf_handle == 0)
  469. {
  470. return;
  471. }
  472. rfSyncword = syncword;
  473. RF_SetSyncWord(syncword);
  474. }
  475. void myRadio_setRfParams(uint8_t sf, uint8_t bw, uint8_t cr)
  476. {
  477. if (rf_handle == 0)
  478. {
  479. return;
  480. }
  481. rf_sf = sf;
  482. rf_bw = bw;
  483. rf_cr = cr;
  484. RF_SetCR(cr);
  485. RF_SetBW(bw);
  486. RF_SetSF(sf);
  487. }
  488. /**
  489. * @brief 设置模组型号
  490. *
  491. * @param type
  492. */
  493. void myRadio_setChipType(uint8_t type)
  494. {
  495. chipType = type;
  496. }
  497. /**
  498. * @brief 获取模组型号
  499. *
  500. * @return uint8_t
  501. */
  502. uint8_t myRadio_getChipType(void)
  503. {
  504. return chipType;
  505. }
  506. int16_t myRadio_getRssi(void)
  507. {
  508. return (int16_t)RF_GetRealTimeRssi();
  509. }
  510. /**
  511. * @brief 无线发送数据包
  512. *
  513. * @param packet
  514. */
  515. void myRadio_transmit(rfTxPacket_ts *packet)
  516. {
  517. if (rf_handle == 0)
  518. {
  519. return;
  520. }
  521. RF_EXT_PA_TO_TX();
  522. // uint32_t getTxtime;
  523. if (RF_GetOperateState() == RF_STATE_DEEPSLEEP)
  524. {
  525. myRadio_init(0, NULL);
  526. myRadio_setFrequency(rfFrequence);
  527. myRadio_setTxPower(rfTxPower);
  528. myRadio_setRfParams(rf_sf, rf_bw, rf_cr);
  529. myRadio_delay(10);
  530. }
  531. if (RF_GetOperateState() == RF_STATE_SLEEP)
  532. {
  533. RF_ExitSleepState();
  534. myRadio_delay(10);
  535. }
  536. RF_TxSinglePkt(packet->payload, packet->len);
  537. rf_workProcess = RF_PRC_TX;
  538. }
  539. /**
  540. * @brief 无线发送数据包
  541. *
  542. * @param packet
  543. */
  544. void myRadio_transmitArray(uint8_t *packet, uint16_t len)
  545. {
  546. if (rf_handle == 0)
  547. {
  548. return;
  549. }
  550. RF_EXT_PA_TO_TX();
  551. // uint32_t getTxtime;
  552. if (RF_GetOperateState() == RF_STATE_DEEPSLEEP)
  553. {
  554. myRadio_init(0, NULL);
  555. myRadio_setFrequency(rfFrequence);
  556. myRadio_setTxPower(rfTxPower);
  557. myRadio_setRfParams(rf_sf, rf_bw, rf_cr);
  558. myRadio_delay(10);
  559. }
  560. if (RF_GetOperateState() == RF_STATE_SLEEP)
  561. {
  562. RF_ExitSleepState();
  563. myRadio_delay(10);
  564. }
  565. RF_SetTx(packet, len);
  566. rf_workProcess = RF_PRC_TX;
  567. }
  568. /**
  569. * @brief 进入无线接收
  570. *
  571. */
  572. void myRadio_receiver(void)
  573. {
  574. if (rf_handle == 0)
  575. {
  576. return;
  577. }
  578. RF_EXT_PA_TO_RX();
  579. if (RF_GetOperateState() == RF_STATE_DEEPSLEEP)
  580. {
  581. myRadio_init(0, NULL);
  582. myRadio_setFrequency(rfFrequence);
  583. myRadio_setTxPower(rfTxPower);
  584. myRadio_setRfParams(rf_sf, rf_bw, rf_cr);
  585. myRadio_delay(10);
  586. }
  587. if (RF_GetOperateState() == RF_STATE_SLEEP)
  588. {
  589. RF_ExitSleepState();
  590. myRadio_delay(10);
  591. }
  592. RF_EnterSingleRxWithTimeout(3000);
  593. rf_workProcess = RF_PRC_RX;
  594. }
  595. /**
  596. * @brief 进入无线接收
  597. *
  598. */
  599. void myRadio_cadReceiver(uint32_t window_ms, uint32_t interval_ms)
  600. {
  601. if (rf_handle == 0)
  602. {
  603. return;
  604. }
  605. RF_EXT_PA_TO_RX();
  606. if (RF_GetOperateState() == RF_STATE_DEEPSLEEP)
  607. {
  608. myRadio_init(0, NULL);
  609. myRadio_setFrequency(rfFrequence);
  610. myRadio_setTxPower(rfTxPower);
  611. myRadio_setRfParams(rf_sf, rf_bw, rf_cr);
  612. myRadio_delay(10);
  613. }
  614. if (RF_GetOperateState() == RF_STATE_SLEEP)
  615. {
  616. RF_ExitSleepState();
  617. myRadio_delay(10);
  618. }
  619. cadCheckWindow_ms = window_ms;
  620. cadCheckInterval_ms = interval_ms;
  621. cadCheckWindowCount_ms = window_ms;
  622. cadCheckIntervalCount_ms = interval_ms;
  623. RF_StartCad(RF_CAD_THRESHOLD_20, RF_CAD_03_SYMBOL);
  624. printf("start to cad\n");
  625. rf_workProcess = RF_PRC_CAD_RX;
  626. }
  627. void myRadio_restartCadReceiver(void)
  628. {
  629. if (rf_handle == 0)
  630. {
  631. return;
  632. }
  633. if (rf_workProcess == RF_PRC_CAD_RX)
  634. {
  635. return;
  636. }
  637. RF_EXT_PA_TO_RX();
  638. RF_StartCad(RF_CAD_THRESHOLD_20, RF_CAD_03_SYMBOL);
  639. cadCheckWindowCount_ms = cadCheckWindow_ms;
  640. cadCheckIntervalCount_ms = cadCheckInterval_ms;
  641. rf_workProcess = RF_PRC_CAD_RX;
  642. printf("restart cad Window=%d Interval=%d\n", cadCheckWindow_ms, cadCheckInterval_ms);
  643. }
  644. void myRadio_stopCadReceiver(void)
  645. {
  646. if (rf_handle == 0)
  647. {
  648. return;
  649. }
  650. RF_EXT_PA_TO_IDLE();
  651. cadCheckWindow_ms = 0;
  652. cadCheckInterval_ms = 0;
  653. cadCheckWindowCount_ms = 0;
  654. cadCheckIntervalCount_ms = 0;
  655. RF_StopCad();
  656. rf_workProcess = RF_PRC_IDLE;
  657. printf("stop cad Window=%d Interval=%d\n", cadCheckWindow_ms, cadCheckInterval_ms);
  658. }
  659. void myRadio_setCtrl(controlMode_te mode, uint32_t value)
  660. {
  661. if (rf_handle == 0)
  662. {
  663. return;
  664. }
  665. rf_workProcess = RF_PRC_TEST_TX;
  666. myRadio_init(0, 0);
  667. myRadio_setSyncWord(0x45);
  668. switch (mode)
  669. {
  670. case RADIO_EXT_CONTROL_TX_UNMODULATED:
  671. {
  672. RF_EXT_PA_TO_TX();
  673. myRadio_setTxPower(rfTxPower);
  674. myRadio_setFrequency(rfFrequence);
  675. RF_StartTxContinuousWave();
  676. rf_workProcess = RF_PRC_TEST_TX;
  677. }
  678. break;
  679. case RADIO_EXT_CONTROL_TX_MODULATED:
  680. {
  681. RF_EXT_PA_TO_TX();
  682. myRadio_setTxPower(rfTxPower);
  683. myRadio_setFrequency(rfFrequence);
  684. RF_StartTxContinuousWave();
  685. rf_workProcess = RF_PRC_TEST_TX;
  686. }
  687. break;
  688. case RADIO_EXT_CONTROL_RX_SENSITIVITY:
  689. {
  690. RF_EXT_PA_TO_RX();
  691. myRadio_receiver();
  692. rf_workProcess = RF_PRC_RX;
  693. }
  694. break;
  695. default:
  696. break;
  697. }
  698. }
  699. /**-------------------------radio funtion end----------------------------------**/
  700. uint8_t getRfPowerTabIndex(int8_t power)
  701. {
  702. for (int i = 0; i < sizeof(rfPowerRegTab)/2; i++)
  703. {
  704. if (rfPowerRegTab[i].power >= power)
  705. {
  706. return i;
  707. }
  708. }
  709. return sizeof(rfPowerRegTab)/2 - 1;
  710. }