main.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636
  1. #include "main.h"
  2. #include "ReadKey.h"
  3. #include "key.h"
  4. #include "ReadKey.h"
  5. #include "crc8.h"
  6. #include "led.h"
  7. #include "eventUnit.h"
  8. #include "myADC.h"
  9. #include "myInputCapture.h"
  10. #include "myLcd.h"
  11. #include "myDisplayUnit.h"
  12. // #include "myFlashData.h"
  13. #include "myTim.h"
  14. #include "myUart.h"
  15. #include "myBootloader.h"
  16. #include <math.h>
  17. #include "nmeaparser.h"
  18. #define SOFT_VERSION 0x02
  19. #define SET_RF_FREQ_HZ(base, ch,step) base+ch*step*10*1000
  20. //---------------key
  21. KeyParamExt_ts *getKeyReturn;
  22. key_value_te keyPressValue;
  23. static uint16_t present_adcValue;
  24. static uartPacket_ts uartPacket;
  25. static uartPacket_ts uart3Packet;
  26. static bool startToCountingRx = false;
  27. static float present_moduleCurrendValue;
  28. static float validPackageCount = 0;
  29. static uint32_t rfContinuousFreq = 1;
  30. static float rfRxTestRate = 1;
  31. static uint32_t rfTxCount = 0;
  32. static uint32_t rfRxCount = 0;
  33. static uint32_t rfTxAndGetAckTime_ms = 0;
  34. static uint32_t rfTxAndGetAckTimeSet_ms = 3000;
  35. static uint32_t rfTxReTmCount = 0;
  36. static bool rfTxGetAckStatus = false;
  37. static uint8_t rfCtrlMode;
  38. const uint32_t rfBaseFreqList[44] =
  39. {
  40. /*"0"*/433000000,
  41. /*"1"*/490000000,
  42. /*"2"*/868000000,
  43. /*"3"*/915000000,
  44. /*"4"*/170000000,
  45. /*"5"*/433000000,
  46. /*"6"*/490000000,
  47. /*"7"*/868000000,
  48. /*"8"*/915000000,
  49. /*"0"*/433000000,
  50. /*"1"*/490000000,
  51. /*"2"*/868000000,
  52. /*"3"*/915000000,
  53. /*"4"*/170000000,
  54. /*"5"*/433000000,
  55. /*"6"*/490000000,
  56. /*"7"*/868000000,
  57. /*"8"*/915000000,
  58. /*"0"*/433000000,
  59. /*"1"*/490000000,
  60. /*"2"*/868000000,
  61. /*"3"*/915000000,
  62. /*"4"*/170000000,
  63. /*"5"*/433000000,
  64. /*"6"*/490000000,
  65. /*"7"*/868000000,
  66. /*"8"*/915000000,
  67. /*"0"*/433000000,
  68. /*"1"*/490000000,
  69. /*"2"*/868000000,
  70. /*"3"*/915000000,
  71. /*"4"*/170000000,
  72. /*"5"*/433000000,
  73. /*"6"*/490000000,
  74. /*"7"*/868000000,
  75. /*"8"*/915000000,
  76. };
  77. const uint32_t rfBaudrateList[22] =
  78. {
  79. 90, 610, 1220, 2441, 5022, 12500, 37500
  80. };
  81. const int8_t rfTxPowerList[33] =
  82. {
  83. -9,-8,-7,-6,-5,-4,-3,-2,-1,0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22
  84. };
  85. static char deviceNameList[44][20] =
  86. {
  87. /*"0"*/"",
  88. /*"1"*/"",
  89. /*"2"*/"",
  90. /*"3"*/"",
  91. /*"4"*/"",
  92. /*"5"*/"",
  93. /*"6"*/"",
  94. /*"7"*/"",
  95. /*"8"*/"",
  96. /*"0"*/"",
  97. /*"1"*/"",
  98. /*"2"*/"",
  99. /*"3"*/"",
  100. /*"4"*/"",
  101. /*"5"*/"",
  102. /*"6"*/"",
  103. /*"7"*/"",
  104. /*"8"*/"",
  105. /*"0"*/"",
  106. /*"1"*/"",
  107. /*"2"*/"",
  108. /*"3"*/"",
  109. /*"4"*/"",
  110. /*"5"*/"",
  111. /*"6"*/"",
  112. /*"7"*/"",
  113. /*"8"*/"",
  114. /*"0"*/"",
  115. /*"1"*/"",
  116. /*"2"*/"",
  117. /*"3"*/"",
  118. /*"4"*/"",
  119. /*"5"*/"",
  120. /*"6"*/"",
  121. /*"7"*/"",
  122. /*"8"*/"",
  123. };
  124. userParams_ts deviceInforDef =
  125. {
  126. .deviceId = 1,
  127. .rfChannel = 0,
  128. .channelStep = 100,
  129. };
  130. uint16_t utc_time;
  131. uint16_t loc_time;
  132. userParams_ts deviceInfor;
  133. #define EVENT_TIME_CYCLE_10ms 0
  134. #define EVENT_TIME_CYCLE_500ms 1
  135. #define EVENT_UART3_RECV 2
  136. #define EVENT_UART_RECV 3
  137. #define EVENT_BOOT_TIMEOUT 4
  138. #define EVENT_RF_CONTINUOUS_TX 5
  139. #define EVENT_RF_CONTINUOUS_RX 6
  140. #define EVENT_GNSS_TIME 7
  141. #define EVENT_GNSS_LOC_TIME 8
  142. #define EVENT_TIMEOUT_TO_SAVE_PARAMS 9
  143. #define EVENT_RF_GET_RX_PACKET 10
  144. #define EVENT_RF_PACKET_TX 11
  145. #define EVENT_RF_PACKET_RX 12
  146. #define EVENT_TIMEOUT_CHECK_RF_PACKET 13
  147. #define EVENT_GNSS_RX_TIMEOUT 14
  148. static uint16_t eventReturn;
  149. struct nmea_parser parser[1];
  150. extern void decodeGnss(char *src);
  151. void dealKeyPressProccess(void)
  152. {
  153. if (getKeyReturn->haveKey == false)
  154. {
  155. return;
  156. }
  157. getKeyReturn->haveKey = false;
  158. switch (getKeyReturn->value)
  159. {
  160. case LEFT_KEY:
  161. {
  162. if(getLongKeySt() == true)
  163. {
  164. clearLongKey();
  165. EnableReleaseKey();
  166. myDisplay_enter(ENTER_LAST_PAGE);
  167. }
  168. else
  169. {
  170. if (getReleaseKeySt())
  171. {
  172. }
  173. else
  174. {
  175. EnableLongKey(5);
  176. }
  177. }
  178. }
  179. break;
  180. case RIGHT_KEY:
  181. {
  182. if(getLongKeySt() == true)
  183. {
  184. clearLongKey();
  185. EnableReleaseKey();
  186. }
  187. else
  188. {
  189. if (getReleaseKeySt())
  190. {
  191. }
  192. else
  193. {
  194. EnableLongKey(5);
  195. }
  196. }
  197. }
  198. break;
  199. case TOP_KEY:
  200. {
  201. if(getCyclicKeySt() == true)
  202. {
  203. EnableCyclicKey(30);
  204. myDisplay_change(1);
  205. }
  206. else
  207. {
  208. if (getReleaseKeySt())
  209. {
  210. beep_shortBeep();
  211. myDisplay_change(1);
  212. }
  213. else
  214. {
  215. EnableReleaseKey();
  216. EnableCyclicKey(300);
  217. }
  218. }
  219. }
  220. break;
  221. case BOTTOM_KEY:
  222. {
  223. if(getCyclicKeySt() == true)
  224. {
  225. EnableCyclicKey(30);
  226. myDisplay_change(0);
  227. }
  228. else
  229. {
  230. if (getReleaseKeySt())
  231. {
  232. beep_shortBeep();
  233. myDisplay_change(0);
  234. }
  235. else
  236. {
  237. EnableReleaseKey();
  238. EnableCyclicKey(300);
  239. }
  240. }
  241. }
  242. break;
  243. case OK_KEY:
  244. {
  245. if(getLongKeySt() == true)
  246. {
  247. clearLongKey();
  248. EnableReleaseKey();
  249. beep_shortBeep();
  250. myDisplay_enter(ENTER_NEXT_PAGE);
  251. }
  252. else
  253. {
  254. if (getReleaseKeySt())
  255. {
  256. }
  257. else
  258. {
  259. EnableLongKey(5);
  260. }
  261. }
  262. }
  263. break;
  264. default:
  265. break;
  266. }
  267. }
  268. /**
  269. *
  270. * 串口回调函数,当串口有硬件超时时会调用该函数
  271. */
  272. static void rcc_init(void)
  273. {
  274. //---------普通IO口时钟使能
  275. RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOA, ENABLE );
  276. RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOB, ENABLE );
  277. RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOC, ENABLE );
  278. RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOD, ENABLE );
  279. //----------复用功能时钟使能
  280. RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO, ENABLE);
  281. #if defined (STM32F10X_LD_VL) || defined (STM32F10X_MD_VL) || defined (STM32F10X_HD_VL)
  282. /* ADCCLK = PCLK2/2 */
  283. RCC_ADCCLKConfig(RCC_PCLK2_Div2);
  284. #else
  285. /* ADCCLK = PCLK2/4 */
  286. RCC_ADCCLKConfig(RCC_PCLK2_Div4);
  287. #endif
  288. }
  289. /**
  290. *
  291. * 串口回调函数,当串口有硬件超时时会调用该函数
  292. */
  293. void UART1_CALLBACK(uint8_t *buf, uint16_t len)
  294. {
  295. if(uartPacket.isValid == 0)
  296. {
  297. memcpy(uartPacket.packet, buf, len);
  298. uartPacket.len = len;
  299. uartPacket.isValid = 1;
  300. event_post(EVENT_UART_RECV);
  301. }
  302. }
  303. void UART3_CALLBACK(uint8_t *buf, uint16_t len)
  304. {
  305. if(uart3Packet.isValid == 0)
  306. {
  307. memcpy(uart3Packet.packet, buf, len);
  308. uart3Packet.len = len;
  309. uart3Packet.isValid = true;
  310. event_post(EVENT_UART3_RECV);
  311. }
  312. }
  313. /**
  314. *
  315. * 定时器中断回调,当产生定时器中断会调用该函数
  316. */
  317. void TIM3_CALLBACK(void)
  318. {
  319. static uint8_t timeCnt_1ms = 0;
  320. beep_onDriver();
  321. if(timeCnt_1ms ++ == 5)
  322. {
  323. timeCnt_1ms = 0;
  324. rfTxAndGetAckTime_ms ++;
  325. eventDriver();
  326. }
  327. }
  328. void uiEnterCallback(int pageId, int cursorCount, int status, int value)
  329. {
  330. switch (pageId - 1)
  331. {
  332. case UI_PAGE_ID_ITEM_MODE:
  333. {
  334. }break;
  335. case UI_PAGE_ID_RF_CONTINUOUS:
  336. {
  337. }
  338. break;
  339. case UI_PAGE_ID_RX_PACKET:
  340. {
  341. }
  342. break;
  343. case UI_PAGE_ID_SETTING:
  344. {
  345. switch (cursorCount)
  346. {
  347. case SET_ITEM_INDEX_TYPE://chipType
  348. {
  349. deviceInfor.chipType = value;
  350. setEvent(EVENT_TIMEOUT_TO_SAVE_PARAMS, false, 200);
  351. }
  352. break;
  353. case SET_ITEM_INDEX_FREQ://Freq
  354. {
  355. deviceInfor.rfChannel = value;
  356. setEvent(EVENT_TIMEOUT_TO_SAVE_PARAMS, false, 200);
  357. }
  358. break;
  359. case SET_ITEM_INDEX_STEP://channelStep
  360. {
  361. deviceInfor.channelStep = value;
  362. setEvent(EVENT_TIMEOUT_TO_SAVE_PARAMS, false, 200);
  363. }
  364. break;
  365. case SET_ITEM_INDEX_TXPOWER://TxPower
  366. {
  367. deviceInfor.txPower = value;
  368. setEvent(EVENT_TIMEOUT_TO_SAVE_PARAMS, false, 200);
  369. }
  370. break;
  371. case SET_ITEM_INDEX_RFBAUDRATE://RFBAUDRATE
  372. {
  373. deviceInfor.rfBaudrate = value;
  374. setEvent(EVENT_TIMEOUT_TO_SAVE_PARAMS, false, 200);
  375. }
  376. break;
  377. default:
  378. break;
  379. }
  380. }
  381. break;
  382. default:
  383. break;
  384. }
  385. }
  386. void sort(int arr[], int n) {
  387. int i, j, temp;
  388. for (i = 0; i < n-1; i++) {
  389. for (j = 0; j < n-i-1; j++) {
  390. if (arr[j] < arr[j+1]) {
  391. temp = arr[j];
  392. arr[j] = arr[j+1];
  393. arr[j+1] = temp;
  394. }
  395. }
  396. }
  397. }
  398. /*
  399. * Print navigation data and wait for user's keystroke
  400. * @navdata: the navigation data
  401. */
  402. void display_navdata(struct nav_data *navdata) {
  403. // printf("NAVDATA:\n");
  404. // printf("NAVDATA.FIX_VALID = %d\n", navdata->is_fixed);
  405. // printf("NAVDATA.DATE = %d-%02d-%02d\n", navdata->date.year, navdata->date.month, navdata->date.day);
  406. // printf("NAVDATA.TIME= %02d:%02d:%02d.%03d\n", navdata->time.hour, navdata->time.minute, navdata->time.second, navdata->time.ms);
  407. // printf("NAVDATA.LAT = %.6f\n", navdata->lat);
  408. // printf("NAVDATA.LON = %.6f\n", navdata->lon);
  409. // printf("NAVDATA.ALT = %.2f\n", navdata->alt);
  410. // printf("NAVDATA.HEADING = %.2f\n", navdata->heading);
  411. // printf("NAVDATA.SPEED = %.2f\n", navdata->speed);
  412. // printf("NAVDATA.HDOP = %.1f\n", navdata->hdop);
  413. // printf("NAVDATA.VDOP = %.1f\n", navdata->vdop);
  414. // printf("NAVDATA.PDOP = %.1f\n", navdata->pdop);
  415. // printf("NAVDATA.NUM_SV_FIX = %d\n", navdata->sv_inuse);
  416. // printf("NAVDATA.NUM_SV_VIEW = %d\n", navdata->sv_inview);
  417. int svid;
  418. int getIndex = 0;
  419. int cn0List[100];
  420. memset(cn0List, 0, sizeof(cn0List));
  421. for (svid = 0; svid < MAX_SVID; svid++) {
  422. struct sate *sate = navdata->sates + svid;
  423. if (sate->valid)
  424. {
  425. cn0List[getIndex++] = sate->cn0;
  426. printf("NAVDATA.SATE%d.VALID = %d\n", svid, cn0List[getIndex]);
  427. }
  428. }
  429. sort(cn0List, navdata->sv_inview);
  430. for (svid = 0; svid < 5; svid++) {
  431. myDisplay_ui_rf_cn0_display_buffer(svid, "cn%d=%2d", svid, cn0List[svid]);
  432. }
  433. printf("{\"LAT\":%.6f,\"LON\":%.6f,\"TIME\":%02d-%02d-%02d-%03d}\r\n", navdata->lat, navdata->lon, navdata->time.hour, navdata->time.minute, navdata->time.second, navdata->time.ms);
  434. // printf("\n");
  435. // printf("Press any key to continue...");
  436. myDisplay_ui_rf_display_buffer(0, "%d-%02d-%02d", navdata->date.year, navdata->date.month, navdata->date.day);
  437. myDisplay_ui_rf_display_buffer(1, "%02d:%02d:%02d.%03d", navdata->time.hour, navdata->time.minute, navdata->time.second, navdata->time.ms);
  438. myDisplay_ui_rf_display_buffer(2, "LAT=%3.10f", navdata->lat);
  439. myDisplay_ui_rf_display_buffer(3, "LON=%3.10f", navdata->lon);
  440. myDisplay_ui_rf_display_buffer(4, "SPEED=%.6f", navdata->speed);
  441. myDisplay_ui_rf_display_buffer(5, "SV:%d u:%d", navdata->sv_inview, navdata->sv_inuse);
  442. // getchar();
  443. setEvent(EVENT_GNSS_RX_TIMEOUT, false, 2000);
  444. if ((navdata->date.year + navdata->date.month + navdata->date.day + navdata->time.hour+navdata->time.minute+navdata->time.second+navdata->time.ms) == 0)
  445. {
  446. event_post(EVENT_GNSS_TIME);
  447. }
  448. else
  449. {
  450. utc_time = 0;
  451. }
  452. if ((navdata->lat + navdata->lon) == 0)
  453. {
  454. event_post(EVENT_GNSS_LOC_TIME);
  455. }
  456. else
  457. {
  458. loc_time = 0;
  459. }
  460. }
  461. int main(void)
  462. {
  463. #ifdef BOOTLOADER_APP
  464. SCB->VTOR = FLASH_BASE | 0x000C800;
  465. #endif
  466. userParams_ts userParamsTemp;
  467. NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//设置中断优先级分组为组2:2位抢占优先级,2位响应优先级
  468. rcc_init();
  469. GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE);//关闭jtag , 开启swd
  470. //读取本地保存数据
  471. // myFlash_read((uint8_t*)&deviceInfor, sizeof(userParams_ts));
  472. // if (crc8_gernCheckT((unsigned char*)&deviceInfor,
  473. // sizeof(userParams_ts) - 1,
  474. // deviceInfor.checkSum) == 0)
  475. // {
  476. // deviceInfor = deviceInforDef;
  477. // }
  478. //初始化按键
  479. key_init();
  480. //初始化LED灯
  481. LED_Init();
  482. //初始化串口
  483. myUart3_init(9600, UART3_CALLBACK); //用于透传模块测试,需要时再打开
  484. myUart1_init(115200, UART1_CALLBACK);
  485. //初始化定时器
  486. myTim1_init(200, TIM3_CALLBACK);
  487. //初始化模拟转换ADC,用于无线模块驱动电流检测
  488. myADC_init();
  489. //蜂鸣器初始化
  490. beep_init();
  491. beep_setFreq(deviceInfor.beepNumb);
  492. // LCD显示屏初始化界面显示
  493. myDisplay_init(uiEnterCallback);
  494. myDisplay_ui_firstUi_setDeviceName(deviceNameList[deviceInfor.chipType]);
  495. //上电长想一声
  496. beep_longBeep();
  497. printf("Vollgo Module GNSS\r\n");
  498. setEvent(EVENT_TIME_CYCLE_10ms, true, 10);
  499. setEvent(EVENT_TIME_CYCLE_500ms, true, 3000);
  500. // setEvent(EVENT_BOOT_TIMEOUT, false, 60000);
  501. nmea_parser_init(parser);
  502. parser->report_nav_status = display_navdata;
  503. while(1)
  504. {
  505. eventReturn = event_pend();
  506. if (getEvent(EVENT_TIME_CYCLE_10ms))
  507. {
  508. getKeyReturn = KeyValueChange(keyPressValue);
  509. dealKeyPressProccess();
  510. }
  511. if (getEvent(EVENT_TIME_CYCLE_500ms))
  512. {
  513. present_moduleCurrendValue = myADC_getVoltageValue()/50/0.5*1000;
  514. myDisplay_ui_rf_continuos_txCurrent(present_moduleCurrendValue);
  515. myDisplay_ui_rf_rxPacket_rxCurrent(present_moduleCurrendValue);
  516. uiTimerFlash_callBack();
  517. // myPrintf3("AT\r\n");
  518. }
  519. if (getEvent(EVENT_RF_CONTINUOUS_RX))
  520. {
  521. }
  522. if (getEvent(EVENT_RF_CONTINUOUS_TX))
  523. {
  524. }
  525. if (getEvent(EVENT_RF_PACKET_TX))
  526. {
  527. }
  528. if (getEvent(EVENT_RF_PACKET_RX))
  529. {
  530. }
  531. if (getEvent(EVENT_RF_GET_RX_PACKET))
  532. {
  533. LED2_ON_ONE();
  534. }
  535. if (getEvent(EVENT_GNSS_RX_TIMEOUT))
  536. {
  537. nmea_parser_init(parser);
  538. parser->report_nav_status = display_navdata;
  539. utc_time = 0;
  540. loc_time = 0;
  541. }
  542. if (getEvent(EVENT_GNSS_TIME))
  543. {
  544. myDisplay_ui_gnss_timer(++utc_time);
  545. }
  546. if (getEvent(EVENT_GNSS_LOC_TIME))
  547. {
  548. myDisplay_ui_gnss_timer_loc(++loc_time);
  549. }
  550. if (getEvent(EVENT_UART_RECV))
  551. {
  552. if (uartPacket.isValid)
  553. {
  554. uartPacket.isValid = false;
  555. }
  556. }
  557. if (getEvent(EVENT_UART3_RECV))
  558. {
  559. if (uart3Packet.isValid)
  560. {
  561. // char *token;
  562. // /* 获取第一个子字符串 */
  563. // token = strtok((char *)uart3Packet.packet, "\r\n");
  564. // while (token != NULL)
  565. // {
  566. // /* 继续获取其他的子字符串 */
  567. // decodeGnss(token);
  568. // // myPrintf1(uart3Packet.packet);
  569. // token = strtok(NULL, "\r\n");
  570. // }
  571. // printf((char *)uart3Packet.packet);
  572. for (int i = 0; i < uart3Packet.len; i++) // parse nmea data
  573. nmea_parser_putchar(parser, uart3Packet.packet[i]);
  574. uart3Packet.isValid = false;
  575. uart3Packet.len = 0;
  576. memset(uart3Packet.packet, 0, sizeof(uart3Packet.packet));
  577. }
  578. }
  579. if (getEvent(EVENT_TIMEOUT_TO_SAVE_PARAMS))
  580. {
  581. // deviceInfor.checkSum = crc8_ger((unsigned char*)&deviceInfor, sizeof(userParams_ts) - 1);
  582. // myFlash_write((uint8_t*)&deviceInfor, sizeof(userParams_ts));
  583. }
  584. if (getEvent(EVENT_BOOT_TIMEOUT))
  585. {
  586. NVIC_SystemReset();
  587. }
  588. keyPressValue = keyScan();
  589. }
  590. }