our_service(4852).c 28 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444
  1. /**
  2. * Copyright (c) 2014 - 2018, Nordic Semiconductor ASA
  3. *
  4. * All rights reserved.
  5. *
  6. * Redistribution and use in source and binary forms, with or without modification,
  7. * are permitted provided that the following conditions are met:
  8. *
  9. * 1. Redistributions of source code must retain the above copyright notice, this
  10. * list of conditions and the following disclaimer.
  11. *
  12. * 2. Redistributions in binary form, except as embedded into a Nordic
  13. * Semiconductor ASA integrated circuit in a product or a software update for
  14. * such product, must reproduce the above copyright notice, this list of
  15. * conditions and the following disclaimer in the documentation and/or other
  16. * materials provided with the distribution.
  17. *
  18. * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
  19. * contributors may be used to endorse or promote products derived from this
  20. * software without specific prior written permission.
  21. *
  22. * 4. This software, with or without modification, must only be used with a
  23. * Nordic Semiconductor ASA integrated circuit.
  24. *
  25. * 5. Any software provided in binary form under this license must not be reverse
  26. * engineered, decompiled, modified and/or disassembled.
  27. *
  28. * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
  29. * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  30. * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
  31. * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
  32. * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  33. * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
  34. * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  35. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  36. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
  37. * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  38. *
  39. */
  40. #include <stdint.h>
  41. #include <string.h>
  42. #include "nrf_gpio.h"
  43. #include "our_service.h"
  44. #include "ble_srv_common.h"
  45. #include "app_error.h"
  46. #include "SEGGER_RTT.h"
  47. #include "board_gpi.h"
  48. #include "nrf_log.h"
  49. #include "sysmgr.h"
  50. #include "main.h"
  51. #include "nrf_power.h"
  52. char SvrRxBuffer[100];
  53. int SvrRxBufferPos;
  54. char SvrEvent;
  55. stSystemTimer SystemTimer;
  56. stSystemManager SystemManager;
  57. char SvrSendBuff[50];
  58. void delete_all_begin(void);
  59. void USART_DataCheck()
  60. {
  61. if( SystemTimer.UART_LAST_RECV_TIMER > 10 && SystemManager.RxValild )
  62. {
  63. SvrRxBuffer[SvrRxBufferPos] = 0;
  64. // printf("[%d]%s\r\n", SvrRxBufferPos, SvrRxBuffer);
  65. SystemManager.RxValild = 0;
  66. if( SvrRxBufferPos == 20 )
  67. {
  68. SystemManager.RxEvent = 1;
  69. NRF_LOG_RAW_INFO("==========================>\n\n");
  70. }
  71. SvrRxBufferPos = 0;
  72. }
  73. if( SystemTimer.UART_LAST_RECV_TIMER > 10 && SvrRxBufferPos )
  74. {
  75. SystemManager.RxValild = 0;
  76. SvrRxBufferPos = 0;
  77. }
  78. }
  79. void USART_Handler(void)
  80. {
  81. char ch;
  82. uint8_t cr;
  83. // SystemTimer.UART1_LAST_RECV_TIMER = 0;
  84. if( app_uart_get(&cr) == NRF_SUCCESS )
  85. {
  86. SystemManager.RxValild = 1;
  87. SvrRxBuffer[SvrRxBufferPos++] = cr;
  88. SvrRxBufferPos %= 100;
  89. SystemTimer.UART_LAST_RECV_TIMER = 0;
  90. }
  91. }
  92. /* 이벤트 서버에서 20byte 들어왔을때 */
  93. void ParseEventServer()
  94. {
  95. int i;
  96. if( SystemManager.RxEvent == 0 )
  97. return;
  98. SystemManager.RxEvent = 0;
  99. NRF_LOG_RAW_INFO("\n\n");
  100. NRF_LOG_RAW_INFO("SERVER TO DATA : ")
  101. for( i=0; i<20; i++)
  102. {
  103. NRF_LOG_RAW_INFO("0x%02x ", SvrRxBuffer[i]);
  104. }
  105. NRF_LOG_RAW_INFO("\n\n");
  106. if(SvrRxBuffer[0] != 0x02)
  107. return;
  108. switch(SvrRxBuffer[1]){
  109. case NUM_TYPE_SVR:
  110. case COM_TYPE_BAND: //
  111. switch(SvrRxBuffer[3]){
  112. // 수신기 대기상태 요청
  113. case COM_TYPE_SVR_NORMAL:
  114. SystemManager.System_State = SYSTEM_NONE;
  115. NRF_LOG_INFO("Recv : Normal");
  116. PKLedOff();
  117. PKBuzzerOff();
  118. PKMicOff();
  119. SystemManager.SwitchOn = 0;
  120. break;
  121. // 수신기 통화상태 요청
  122. case COM_TYPE_SVR_TALKING:
  123. NRF_LOG_INFO("Recv : Talking");
  124. PKLedOn();
  125. PKBuzzerOff();
  126. SystemManager.SwitchOn = 0;
  127. break;
  128. // 수신기 서버와 통화 종료 요청
  129. case COM_TYPE_SVR_DISCON:
  130. NRF_LOG_INFO("Recv : Disconnect");
  131. SystemManager.SwitchOn = 0;
  132. //bsp_board_leds_off();
  133. break;
  134. // 서버 Busy 상태 알림
  135. case COM_TYPE_SVR_BUSY:
  136. NRF_LOG_INFO("Recv : Busy");
  137. break;
  138. // 송신기 Alive신호 서버로 전송
  139. case COM_TYPE_SVR_ALIVE:
  140. NRF_LOG_INFO("Recv : Keep Alive");
  141. break;
  142. // 수신기 마이크 상태 변경 요청
  143. case COM_TYPE_SVR_MIC:
  144. SystemManager.System_State = SYSTEM_SERVER_COMM;
  145. SystemTimer.SYSTEM_SERVER_COMM_CNT = 0;
  146. NRF_LOG_INFO("Recv : mic on/off");
  147. if( SvrRxBuffer[11] == 0 )
  148. {
  149. NRF_LOG_INFO("mic on");
  150. NRF_LOG_INFO("speaker off");
  151. PKSpeakerOff();
  152. PKMicOn();
  153. PKBuzzerOff();
  154. PKLedOn();
  155. SystemManager.SwitchOn = 0;
  156. }else{
  157. NRF_LOG_INFO("mic off");
  158. NRF_LOG_INFO("speaker on");
  159. PKMicOff();
  160. PKSpeakerOn();
  161. PKLedOn();
  162. }
  163. break;
  164. // 송신기 등록요청
  165. case COM_TYPE_SVR_RECV_REG_REQ:
  166. NRF_LOG_INFO("Recv : COM_TYPE_SVR_RECV_REG");
  167. if(SystemManager.System_State == SYSTEM_NONE){
  168. SystemManager.System_State = SYSTEM_REGISTER;
  169. SystemManager.LedBlinkRun = COM_TYPE_SVR_RECV_REG;
  170. SystemManager.RegRequst = 1;
  171. SendAck(COM_TYPE_SVR_RECV_REG+1);
  172. SystemTimer.DEV_REG_TIMER = 0;
  173. }else{
  174. NRF_LOG_INFO("SYSTEM is BUSY : [%d]\n", SystemManager.System_State);
  175. }
  176. break;
  177. // 송신기 등록 초기화 요청
  178. case COM_TYPE_SVR_RECV_INIT_REQ:
  179. NRF_LOG_INFO("Recv : COM_TYPE_SVR_RECV_INIT");
  180. // SystemManager.LedBlinkRun = COM_TYPE_SVR_RECV_INIT;
  181. // SystemManager.LedBlinkTimer = 2500;
  182. // SystemTimer.LED_TOGGLE_TIMER = 0;
  183. // SystemManager.SwitchOn = 1;
  184. SendAck(COM_TYPE_SVR_RECV_INIT+1);
  185. //for( i=0; i<RegMacPool.Count; i++)
  186. //{
  187. //RegMacDelteAll();
  188. // }
  189. memset( &RegMacPool, 0, sizeof(RegMacPool));
  190. delete_all_begin();
  191. for(i=0; i<2; i++){
  192. PKLedOn();
  193. nrf_delay_ms(300);
  194. PKLedOff();
  195. nrf_delay_ms(300);
  196. }
  197. break;
  198. // 송신기에 등록된 수신기 리스트 요청
  199. case COM_TYPE_SVR_RECV_LIST_REQ:
  200. NRF_LOG_INFO("Recv : COM_TYPE_SVR_RECV_LIST");
  201. // SystemManager.LedBlinkRun = COM_TYPE_SVR_RECV_LIST;
  202. // SystemManager.LedBlinkTimer = 1500;
  203. // SystemTimer.LED_TOGGLE_TIMER = 0;
  204. // SystemManager.SwitchOn = 1;
  205. Server_Answer_Reg_List();
  206. PKLedOn();
  207. nrf_delay_ms(300);
  208. PKLedOff();
  209. break;
  210. // 서버로 부터 통화 요청
  211. case COM_TYPE_SVR_CALL_REQ:
  212. NRF_LOG_INFO("Recv : COM_TYPE_SVR_CALL_REQ");
  213. Server_Answer_Call();
  214. break;
  215. // 서버로 부터 수신기 버전 요청
  216. case COM_TYPE_SVR_VER_REQ:
  217. NRF_LOG_INFO("Recv : COM_TYPE_SVR_VER_REQ");
  218. Server_Answer_Version();
  219. break;
  220. case COM_TYPE_SVR_UPGREAD_REQ:
  221. NRF_LOG_INFO("Recv : COM_TYPE_SVR_UPGREAD_REQ");
  222. Server_Answer_Upgread();
  223. break;
  224. }
  225. break;
  226. // case COM_TYPE_BAND:
  227. // break;
  228. }
  229. }
  230. void SendToEventServer(char* data, int len)
  231. {
  232. int i;
  233. NRF_LOG_RAW_INFO("SendToEventServer ==> ");
  234. for( i=0; i<len; i++)
  235. {
  236. NRF_LOG_RAW_INFO("%02X ", data[i]);
  237. }
  238. NRF_LOG_RAW_INFO("\n");
  239. for(i=0; i<len; i++)
  240. {
  241. while (app_uart_put(data[i]) != NRF_SUCCESS);
  242. }
  243. }
  244. /******************************************************************************
  245. *
  246. * OnePass App ---> 송신기 --------> Event Server
  247. *
  248. *******************************************************************************/
  249. void SendParkingApp()
  250. {
  251. int i;
  252. NRF_LOG_RAW_INFO("===> SendParkingApp()\n");
  253. SvrSendBuff[0] = COM_STX;
  254. SvrSendBuff[1] = COM_COMM_ONEPASS;
  255. SvrSendBuff[2] = 0;
  256. SvrSendBuff[3] = 1;
  257. SvrSendBuff[4] = 0;
  258. SvrSendBuff[5] = 0;
  259. SvrSendBuff[6] = 0;
  260. SvrSendBuff[7] = new_ble_addr.addr[3]; // 수신기 MAC
  261. SvrSendBuff[8] = new_ble_addr.addr[4]; // 수신기 MAC
  262. SvrSendBuff[9] = new_ble_addr.addr[5]; // 수신기 MAC
  263. SvrSendBuff[10] = 0x12;
  264. SvrSendBuff[11] = 0x74;
  265. SvrSendBuff[12] = 0;
  266. SvrSendBuff[13] = 0;
  267. SvrSendBuff[14] = 0;
  268. SvrSendBuff[15] = 0;
  269. SvrSendBuff[16] = SystemManager.Site[0]; //SITE
  270. SvrSendBuff[17] = SystemManager.Site[1];
  271. SvrSendBuff[18] = SystemManager.Site[2];
  272. SvrSendBuff[19] = SystemManager.Site[3];
  273. SvrSendBuff[20] = SystemManager.Dong[0]; //DONG
  274. SvrSendBuff[21] = SystemManager.Dong[1];
  275. SvrSendBuff[22] = SystemManager.Ho[0]; //HO
  276. SvrSendBuff[23] = SystemManager.Ho[1];
  277. SvrSendBuff[24] = 0; //KEY NUM
  278. SvrSendBuff[25] = 0; //KEY TYPE
  279. SvrSendBuff[26] = 0; //Random
  280. SvrSendBuff[27] = 0;
  281. for(i=1; i<28; i++){
  282. SvrSendBuff[28] = SvrSendBuff[28] + SvrSendBuff[i];
  283. }
  284. SvrSendBuff[29] = COM_ETX;
  285. NRF_LOG_INFO("SendParkingApp ===");
  286. SendToEventServer(&SvrSendBuff[0], 1);
  287. nrf_delay_ms(500);
  288. SendToEventServer(&SvrSendBuff[0], 30);
  289. if(SystemManager.System_State == SYSTEM_NONE){
  290. for(i=0; i<2; i++){
  291. PKLedOn();
  292. nrf_delay_ms(300);
  293. PKLedOff();
  294. nrf_delay_ms(300);
  295. }
  296. }
  297. nrf_delay_ms(2000); // 중복해서 들어오는 데이타로 인한 연속 동작 방지
  298. }
  299. /******************************************************************************
  300. *
  301. * Band ---> 송신기 --------> Event Server
  302. *
  303. *******************************************************************************/
  304. void SendEmergencyBand()
  305. {
  306. int i;
  307. char tmpStr[10];
  308. NRF_LOG_RAW_INFO("===> SendEmergencyBand()\n");
  309. SystemManager.LedBlinkRun = 1;
  310. SystemManager.LedBlinkTimer = 5000;
  311. SystemTimer.LED_TOGGLE_TIMER = 0;
  312. SystemManager.DevType = 0;
  313. SystemManager.SwitchOn = 1;
  314. SystemManager.System_State = SYSTEM_EMERGENCY_SIREN;
  315. PKBuzzerOn();
  316. SvrSendBuff[0] = COM_STX;
  317. SvrSendBuff[1] = COM_COMM_SMART_BAND;
  318. SvrSendBuff[2] = 0;
  319. SvrSendBuff[3] = COM_TYPE_BELL_EMG;
  320. SvrSendBuff[4] = 0;
  321. SvrSendBuff[5] = 0;
  322. SvrSendBuff[6] = 0;
  323. if( RegMacPool.Count != 0 ){ // 등록된 송신기가 있으면 첫번째 MAC 전송
  324. strcpy( tmpStr, &RegMacPool.Mac[0][6]);
  325. tmpStr[6] = 0;
  326. SvrSendBuff[6] = strtoul( &tmpStr[4], NULL, 16 );
  327. tmpStr[4] = 0;
  328. SvrSendBuff[5] = strtoul( &tmpStr[2], NULL, 16 );
  329. tmpStr[2] = 0;
  330. SvrSendBuff[4] = strtoul( &tmpStr[0], NULL, 16 );
  331. }else{ // 없으면 000000 전송
  332. SvrSendBuff[4] = 0;
  333. SvrSendBuff[5] = 0;
  334. SvrSendBuff[6] = 0;
  335. }
  336. SvrSendBuff[7] = new_ble_addr.addr[3];
  337. SvrSendBuff[8] = new_ble_addr.addr[4];
  338. SvrSendBuff[9] = new_ble_addr.addr[5];
  339. SvrSendBuff[10] = 0x12;
  340. SvrSendBuff[11] = 0x72;
  341. SvrSendBuff[12] = 0; //uuid
  342. SvrSendBuff[13] = 0;
  343. SvrSendBuff[14] = 0;
  344. SvrSendBuff[15] = 0;
  345. SvrSendBuff[16] = SystemManager.Site[0]; //Site
  346. SvrSendBuff[17] = SystemManager.Site[1];
  347. SvrSendBuff[18] = SystemManager.Site[2];
  348. SvrSendBuff[19] = SystemManager.Site[3];
  349. SvrSendBuff[20] = SystemManager.Dong[0]; //Dong
  350. SvrSendBuff[21] = SystemManager.Dong[1];
  351. SvrSendBuff[22] = SystemManager.Ho[0]; //Ho
  352. SvrSendBuff[23] = SystemManager.Ho[1];
  353. SvrSendBuff[24] = 0; //KEY NUM
  354. SvrSendBuff[25] = 0; //KEY TYPE
  355. SvrSendBuff[26] = 0; //Random
  356. SvrSendBuff[27] = 0;
  357. for(i=1; i<28; i++){
  358. SvrSendBuff[28] = SvrSendBuff[28] + SvrSendBuff[i];
  359. }
  360. SvrSendBuff[29] = COM_ETX;
  361. NRF_LOG_INFO("SendEmergencyBand===");
  362. // SendToEventServer(&SvrSendBuff[0], 1);
  363. // nrf_delay_ms(500);
  364. SendToEventServer(&SvrSendBuff[0], 30);
  365. //NRF_LOG_RAW_INFO("================= EmergencyBand \n");
  366. for( i=0; i<29; i++)
  367. {
  368. //NRF_LOG_RAW_INFO("%02x ", SvrSendBuff[i]);
  369. }
  370. NRF_LOG_RAW_INFO("\n");
  371. }
  372. void SendParkingBand()
  373. {
  374. uint8_t i;
  375. uint8_t check_sum = 0;
  376. NRF_LOG_RAW_INFO("===> SendParkingBand()\n");
  377. SvrSendBuff[0] = COM_STX;
  378. SvrSendBuff[1] = COM_COMM_SMART_BAND;
  379. SvrSendBuff[2] = 0;
  380. SvrSendBuff[3] = 2;
  381. SvrSendBuff[4] = 0;
  382. SvrSendBuff[5] = 0;
  383. SvrSendBuff[6] = 0;
  384. SvrSendBuff[7] = new_ble_addr.addr[3];
  385. SvrSendBuff[8] = new_ble_addr.addr[4];
  386. SvrSendBuff[9] = new_ble_addr.addr[5];
  387. SvrSendBuff[10] = 0x12;
  388. SvrSendBuff[11] = 0x73;
  389. SvrSendBuff[12] = 0; //uuid
  390. SvrSendBuff[13] = 0;
  391. SvrSendBuff[14] = 0;
  392. SvrSendBuff[15] = 0;
  393. SvrSendBuff[16] = SystemManager.Site[0]; //Site
  394. SvrSendBuff[17] = SystemManager.Site[1];
  395. SvrSendBuff[18] = SystemManager.Site[2];
  396. SvrSendBuff[19] = SystemManager.Site[3];
  397. SvrSendBuff[20] = SystemManager.Dong[0]; //Dong
  398. SvrSendBuff[21] = SystemManager.Dong[1];
  399. SvrSendBuff[22] = SystemManager.Ho[0]; //Ho
  400. SvrSendBuff[23] = SystemManager.Ho[1];
  401. SvrSendBuff[24] = 0; //KEY NUM
  402. SvrSendBuff[25] = 0; //KEY TYPE
  403. SvrSendBuff[26] = 0; //Random
  404. SvrSendBuff[27] = 0;
  405. for(i=1; i<28; i++){
  406. SvrSendBuff[28] = SvrSendBuff[28] + SvrSendBuff[i];
  407. }
  408. SvrSendBuff[29] = COM_ETX;
  409. NRF_LOG_INFO("SendParkingBand ===");
  410. SendToEventServer(&SvrSendBuff[0], 1);
  411. nrf_delay_ms(500);
  412. SendToEventServer(&SvrSendBuff[0], 30);
  413. // SystemManager.SwitchOn = 1;
  414. SystemManager.SwitchOn = 0;
  415. if(SystemManager.System_State == SYSTEM_NONE){
  416. for(i=0; i<2; i++){
  417. PKLedOn();
  418. nrf_delay_ms(300);
  419. PKLedOff();
  420. nrf_delay_ms(300);
  421. }
  422. }
  423. }
  424. /******************************************************************************
  425. *
  426. * 비상벨 ---> 송신기 --------> Event Server
  427. *
  428. *******************************************************************************/
  429. void SendAck(uint8_t cmd)
  430. {
  431. uint8_t i;
  432. NRF_LOG_RAW_INFO("===> SendAck()\n");
  433. memset(SvrSendBuff, 0x00, sizeof(SvrSendBuff));
  434. SvrSendBuff[0] = COM_STX;
  435. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  436. SvrSendBuff[2] = 0;
  437. SvrSendBuff[3] = cmd;
  438. SvrSendBuff[4] = 0;
  439. SvrSendBuff[5] = 0;
  440. SvrSendBuff[6] = 0;
  441. SvrSendBuff[7] = new_ble_addr.addr[3];
  442. SvrSendBuff[8] = new_ble_addr.addr[4];
  443. SvrSendBuff[9] = new_ble_addr.addr[5];
  444. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  445. SvrSendBuff[11] = 'A';
  446. SvrSendBuff[12] = 'C';
  447. SvrSendBuff[13] = 'K';
  448. SvrSendBuff[14] = 0;
  449. SvrSendBuff[15] = 0;
  450. SvrSendBuff[16] = 0;
  451. SvrSendBuff[17] = 0;
  452. SvrSendBuff[18] = 0;
  453. for(i=1; i<18; i++){
  454. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  455. }
  456. SvrSendBuff[19] = COM_ETX;
  457. SendToEventServer(&SvrSendBuff[0], 20);
  458. }
  459. void SendEmergency()
  460. {
  461. uint8_t i;
  462. NRF_LOG_RAW_INFO("===> SendEmergency()\n");
  463. SystemManager.System_State = SYSTEM_EMERGENCY_SIREN;
  464. if( SystemManager.RegRequst == 1 ) // 등록모드일경우 등록모드 해제, 비상모드 전환
  465. {
  466. SystemManager.RegRequst = 0;
  467. // return;
  468. }
  469. SvrSendBuff[0] = COM_STX;
  470. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  471. SvrSendBuff[2] = 0;
  472. SvrSendBuff[3] = COM_TYPE_BELL_EMG;
  473. SvrSendBuff[4] = SystemManager.PeerAddr[3];
  474. SvrSendBuff[5] = SystemManager.PeerAddr[4];
  475. SvrSendBuff[6] = SystemManager.PeerAddr[5];
  476. SvrSendBuff[7] = new_ble_addr.addr[3];
  477. SvrSendBuff[8] = new_ble_addr.addr[4];
  478. SvrSendBuff[9] = new_ble_addr.addr[5];
  479. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  480. SvrSendBuff[11] = SystemManager.TransferVerHigh;
  481. SvrSendBuff[12] = SystemManager.TransferVerLow;
  482. SvrSendBuff[13] = SystemManager.BatLevel;
  483. SvrSendBuff[14] = 0;
  484. SvrSendBuff[15] = 0;
  485. SvrSendBuff[16] = 0;
  486. SvrSendBuff[17] = 0;
  487. for(i=1; i<18; i++){
  488. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  489. }
  490. SvrSendBuff[19] = COM_ETX;
  491. NRF_LOG_INFO("SendEmergency ===");
  492. SendToEventServer(&SvrSendBuff[0], 20);
  493. SystemManager.SwitchOn = 1;
  494. PKBuzzerOn();
  495. }
  496. void SendAlive()
  497. {
  498. uint8_t i;
  499. NRF_LOG_RAW_INFO("===> SendAlive()\n");
  500. SvrSendBuff[0] = COM_STX;
  501. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  502. SvrSendBuff[2] = 0;
  503. SvrSendBuff[3] = COM_TYPE_SVR_ALIVE;
  504. SvrSendBuff[4] = SystemManager.PeerAddr[3];
  505. SvrSendBuff[5] = SystemManager.PeerAddr[4];
  506. SvrSendBuff[6] = SystemManager.PeerAddr[5];
  507. SvrSendBuff[7] = new_ble_addr.addr[3];
  508. SvrSendBuff[8] = new_ble_addr.addr[4];
  509. SvrSendBuff[9] = new_ble_addr.addr[5];
  510. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  511. SvrSendBuff[11] = SystemManager.TransferVerHigh;
  512. SvrSendBuff[12] = SystemManager.TransferVerLow;
  513. SvrSendBuff[13] = SystemManager.BatLevel;
  514. SvrSendBuff[14] = 0;
  515. SvrSendBuff[15] = 0;
  516. SvrSendBuff[16] = 0;
  517. SvrSendBuff[17] = 0;
  518. for(i=1; i<18; i++){
  519. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  520. }
  521. SvrSendBuff[19] = COM_ETX;
  522. NRF_LOG_INFO("SendAlive ===");
  523. SendToEventServer(&SvrSendBuff[0], 20);
  524. }
  525. void SendTest()
  526. {
  527. uint8_t i;
  528. NRF_LOG_RAW_INFO("===> SendTest()\n");
  529. SvrSendBuff[0] = COM_STX;
  530. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  531. SvrSendBuff[2] = 0;
  532. SvrSendBuff[3] = COM_TYPE_SVR_TEST;
  533. SvrSendBuff[4] = SystemManager.PeerAddr[3];
  534. SvrSendBuff[5] = SystemManager.PeerAddr[4];
  535. SvrSendBuff[6] = SystemManager.PeerAddr[5];
  536. SvrSendBuff[7] = new_ble_addr.addr[3];
  537. SvrSendBuff[8] = new_ble_addr.addr[4];
  538. SvrSendBuff[9] = new_ble_addr.addr[5];
  539. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  540. SvrSendBuff[11] = SystemManager.TransferVerHigh;
  541. SvrSendBuff[12] = SystemManager.TransferVerLow;
  542. SvrSendBuff[13] = SystemManager.BatLevel;
  543. SvrSendBuff[14] = 0;
  544. SvrSendBuff[15] = 0;
  545. SvrSendBuff[16] = 0;
  546. SvrSendBuff[17] = 0;
  547. for(i=1; i<18; i++){
  548. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  549. }
  550. SvrSendBuff[19] = COM_ETX;
  551. NRF_LOG_INFO("SendTest ===");
  552. SendToEventServer(&SvrSendBuff[0], 20);
  553. }
  554. // 송신기 등록시마다 송신기 데이타 전송
  555. void SendCurrentRegDev()
  556. {
  557. NRF_LOG_RAW_INFO("===> SendCurrentRegDev()\n");
  558. uint8_t i;
  559. memset(SvrSendBuff, 0x00, sizeof(SvrSendBuff));
  560. SvrSendBuff[0] = COM_STX;
  561. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  562. SvrSendBuff[2] = 0;
  563. SvrSendBuff[3] = COM_TYPE_SVR_RECV_LIST_ANSWER;
  564. SvrSendBuff[4] = SystemManager.PeerAddr[3];
  565. SvrSendBuff[5] = SystemManager.PeerAddr[4];
  566. SvrSendBuff[6] = SystemManager.PeerAddr[5];
  567. SvrSendBuff[7] = new_ble_addr.addr[3];
  568. SvrSendBuff[8] = new_ble_addr.addr[4];
  569. SvrSendBuff[9] = new_ble_addr.addr[5];
  570. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  571. SvrSendBuff[11] = 0;
  572. SvrSendBuff[12] = 0;
  573. SvrSendBuff[13] = 0;
  574. SvrSendBuff[14] = 0;
  575. SvrSendBuff[15] = 0;
  576. SvrSendBuff[16] = 0;
  577. SvrSendBuff[17] = 0;
  578. for(i=1; i<18; i++){
  579. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  580. }
  581. SvrSendBuff[19] = COM_ETX;
  582. SendToEventServer(&SvrSendBuff[0], 20);
  583. nrf_delay_ms(50);
  584. }
  585. // 비상벨 목록 응답.
  586. void Server_Answer_Reg_List()
  587. {
  588. char tmpStr[10];
  589. uint8_t i;
  590. uint8_t j;
  591. NRF_LOG_RAW_INFO("===> Server_Answer_Reg_List(%d EA)\n", RegMacPool.Count);
  592. if( RegMacPool.Count == 0 )
  593. {
  594. memset(SvrSendBuff, 0x00, sizeof(SvrSendBuff));
  595. SvrSendBuff[0] = COM_STX;
  596. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  597. SvrSendBuff[2] = 0;
  598. SvrSendBuff[3] = COM_TYPE_SVR_RECV_LIST_ANSWER;
  599. strcpy( tmpStr, &RegMacPool.Mac[i][6]);
  600. tmpStr[6] = 0;
  601. SvrSendBuff[6] = strtoul( &tmpStr[4], NULL, 16 );
  602. tmpStr[4] = 0;
  603. SvrSendBuff[5] = strtoul( &tmpStr[2], NULL, 16 );
  604. tmpStr[2] = 0;
  605. SvrSendBuff[4] = strtoul( &tmpStr[0], NULL, 16 );
  606. SvrSendBuff[7] = new_ble_addr.addr[3];
  607. SvrSendBuff[8] = new_ble_addr.addr[4];
  608. SvrSendBuff[9] = new_ble_addr.addr[5];
  609. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  610. SvrSendBuff[11] = 0;
  611. SvrSendBuff[12] = 0;
  612. SvrSendBuff[13] = 0;
  613. SvrSendBuff[14] = 0;
  614. SvrSendBuff[15] = 0;
  615. SvrSendBuff[16] = 0;
  616. SvrSendBuff[17] = 0;
  617. for(i=1; i<18; i++){
  618. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  619. }
  620. SvrSendBuff[19] = COM_ETX;
  621. NRF_LOG_INFO("DevList %02x%02x%02x ===== ", SvrSendBuff[4], SvrSendBuff[5], SvrSendBuff[6]);
  622. SendToEventServer(&SvrSendBuff[0], 20);
  623. nrf_delay_ms(50);
  624. return;
  625. }
  626. for( i=0; i<RegMacPool.Count; i++)
  627. {
  628. memset(SvrSendBuff, 0x00, sizeof(SvrSendBuff));
  629. SvrSendBuff[0] = COM_STX;
  630. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  631. SvrSendBuff[2] = 0;
  632. SvrSendBuff[3] = COM_TYPE_SVR_RECV_LIST_ANSWER;
  633. strcpy( tmpStr, &RegMacPool.Mac[i][6]);
  634. tmpStr[6] = 0;
  635. SvrSendBuff[6] = strtoul( &tmpStr[4], NULL, 16 );
  636. tmpStr[4] = 0;
  637. SvrSendBuff[5] = strtoul( &tmpStr[2], NULL, 16 );
  638. tmpStr[2] = 0;
  639. SvrSendBuff[4] = strtoul( &tmpStr[0], NULL, 16 );
  640. SvrSendBuff[7] = new_ble_addr.addr[3];
  641. SvrSendBuff[8] = new_ble_addr.addr[4];
  642. SvrSendBuff[9] = new_ble_addr.addr[5];
  643. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  644. SvrSendBuff[11] = 0;
  645. SvrSendBuff[12] = 0;
  646. SvrSendBuff[13] = 0;
  647. SvrSendBuff[14] = 0;
  648. SvrSendBuff[15] = 0;
  649. SvrSendBuff[16] = 0;
  650. SvrSendBuff[17] = 0;
  651. for(j=1; j<18; j++){
  652. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  653. }
  654. SvrSendBuff[19] = COM_ETX;
  655. NRF_LOG_INFO("DevList %02x%02x%02x =====> ", SvrSendBuff[4], SvrSendBuff[5], SvrSendBuff[6]);
  656. SendToEventServer(&SvrSendBuff[0], 20);
  657. nrf_delay_ms(200);
  658. }
  659. }
  660. void Server_Answer_Call()
  661. {
  662. char tmpStr[10];
  663. uint8_t i;
  664. uint8_t j;
  665. memset(SvrSendBuff, 0x00, sizeof(SvrSendBuff));
  666. NRF_LOG_INFO("Server_Answer_Call()");
  667. SystemManager.System_State = SYSTEM_SERVER_COMM_REQ;
  668. if( SystemManager.ServerCon == 0 )
  669. {
  670. SystemManager.LedBlinkRun = 1;
  671. SystemManager.LedBlinkTimer = 5000;
  672. SystemTimer.LED_TOGGLE_TIMER = 0;
  673. SystemManager.DevType = 0;
  674. SystemManager.SwitchOn = 1;
  675. PKBuzzerOn();
  676. SvrSendBuff[0] = COM_STX;
  677. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  678. SvrSendBuff[2] = 0;
  679. SvrSendBuff[3] = COM_TYPE_SVR_CALL_ANSWER;
  680. if( RegMacPool.Count != 0 ){ // 등록된 송신기가 있으면 첫번째 MAC 전송
  681. strcpy( tmpStr, &RegMacPool.Mac[0][6]);
  682. tmpStr[6] = 0;
  683. SvrSendBuff[6] = strtoul( &tmpStr[4], NULL, 16 );
  684. tmpStr[4] = 0;
  685. SvrSendBuff[5] = strtoul( &tmpStr[2], NULL, 16 );
  686. tmpStr[2] = 0;
  687. SvrSendBuff[4] = strtoul( &tmpStr[0], NULL, 16 );
  688. }else{ // 없으면 000000 전송
  689. SvrSendBuff[4] = 0;
  690. SvrSendBuff[5] = 0;
  691. SvrSendBuff[6] = 0;
  692. }
  693. SvrSendBuff[7] = new_ble_addr.addr[3];
  694. SvrSendBuff[8] = new_ble_addr.addr[4];
  695. SvrSendBuff[9] = new_ble_addr.addr[5];
  696. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  697. SvrSendBuff[11] = 0;
  698. SvrSendBuff[12] = 0;
  699. SvrSendBuff[13] = 0;
  700. SvrSendBuff[14] = 0;
  701. SvrSendBuff[15] = 0;
  702. SvrSendBuff[16] = 0;
  703. SvrSendBuff[17] = 0;
  704. for(j=1; j<18; j++){
  705. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[j];
  706. }
  707. SvrSendBuff[19] = COM_ETX;
  708. SendToEventServer(&SvrSendBuff[0], 20);
  709. }
  710. }
  711. void Server_Answer_Version()
  712. {
  713. uint8_t i;
  714. uint8_t check_sum = 0;
  715. NRF_LOG_RAW_INFO("===> Server_Version_Answer()\n");
  716. if( SystemManager.ServerCon == 0)
  717. {
  718. memset(SvrSendBuff, 0x00, sizeof(SvrSendBuff));
  719. SystemManager.LedBlinkRun = COM_TYPE_SVR_VER_REQ;
  720. SystemManager.LedBlinkTimer = 1500;
  721. SystemTimer.LED_TOGGLE_TIMER = 0;
  722. SystemManager.DevType = 0;
  723. SvrSendBuff[0] = COM_STX;
  724. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  725. SvrSendBuff[2] = 0;
  726. SvrSendBuff[3] = COM_TYPE_SVR_VER_ANSWER;
  727. SvrSendBuff[4] = 0;
  728. SvrSendBuff[5] = 0;
  729. SvrSendBuff[6] = 0;
  730. SvrSendBuff[7] = new_ble_addr.addr[3];
  731. SvrSendBuff[8] = new_ble_addr.addr[4];
  732. SvrSendBuff[9] = new_ble_addr.addr[5];
  733. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  734. SvrSendBuff[11] = IES600RB_VER_HIGH;
  735. SvrSendBuff[12] = IES600RB_VER_LOW;
  736. SvrSendBuff[13] = 0;
  737. SvrSendBuff[14] = 0;
  738. SvrSendBuff[15] = 0;
  739. SvrSendBuff[16] = 0;
  740. SvrSendBuff[17] = 0;
  741. for(i=1; i<18; i++){
  742. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  743. }
  744. SvrSendBuff[19] = COM_ETX;
  745. SendToEventServer(&SvrSendBuff[0], 20);
  746. SystemManager.SwitchOn = 0;
  747. }
  748. nrf_delay_ms(1000);
  749. #if 0
  750. for(i=0; i<5; i++){
  751. PKLedOn();
  752. nrf_delay_ms(100);
  753. PKLedOff();
  754. nrf_delay_ms(100);
  755. }
  756. #endif
  757. }
  758. void Server_Answer_Upgread()
  759. {
  760. uint8_t i;
  761. uint8_t check_sum = 0;
  762. NRF_LOG_RAW_INFO("===> Server_Answer_Upgread()\n");
  763. if( SystemManager.ServerCon == 0)
  764. {
  765. memset(SvrSendBuff, 0x00, sizeof(SvrSendBuff));
  766. SystemManager.LedBlinkRun = COM_TYPE_SVR_VER_REQ;
  767. SystemManager.LedBlinkTimer = 1500;
  768. SystemTimer.LED_TOGGLE_TIMER = 0;
  769. SystemManager.DevType = 0;
  770. SvrSendBuff[0] = COM_STX;
  771. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  772. SvrSendBuff[2] = 0;
  773. SvrSendBuff[3] = COM_TYPE_SVR_UPGREAD_ANSWER;
  774. SvrSendBuff[4] = 0;
  775. SvrSendBuff[5] = 0;
  776. SvrSendBuff[6] = 0;
  777. SvrSendBuff[7] = new_ble_addr.addr[3];
  778. SvrSendBuff[8] = new_ble_addr.addr[4];
  779. SvrSendBuff[9] = new_ble_addr.addr[5];
  780. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  781. SvrSendBuff[11] = IES600RB_VER_HIGH;
  782. SvrSendBuff[12] = IES600RB_VER_LOW;
  783. SvrSendBuff[13] = 0;
  784. SvrSendBuff[14] = 0;
  785. SvrSendBuff[15] = 0;
  786. SvrSendBuff[16] = 0;
  787. SvrSendBuff[17] = 0;
  788. for(i=1; i<18; i++){
  789. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  790. }
  791. SvrSendBuff[19] = COM_ETX;
  792. SendToEventServer(&SvrSendBuff[0], 20);
  793. SystemManager.SwitchOn = 0;
  794. }
  795. NRF_LOG_RAW_INFO("================================================================================\n");
  796. NRF_LOG_RAW_INFO("======================== Reboot To BootLoad Start ==============================\n");
  797. NRF_LOG_RAW_INFO("================================================================================\n");
  798. nrf_delay_ms(1000);
  799. for(i=0; i<5; i++){
  800. PKLedOn();
  801. nrf_delay_ms(100);
  802. PKLedOff();
  803. nrf_delay_ms(100);
  804. }
  805. nrf_delay_ms(3000);
  806. nrf_power_gpregret_set(0xB1);
  807. NVIC_SystemReset();
  808. }
  809. // 사용않함
  810. void SendEmergencyLocal()
  811. {
  812. uint8_t i;
  813. uint8_t check_sum = 0;
  814. SvrSendBuff[0] = COM_STX;
  815. SvrSendBuff[1] = COM_COMM_EMG_SWTICH;
  816. SvrSendBuff[2] = 0;
  817. SvrSendBuff[3] = COM_TYPE_BELL_EMG;
  818. SvrSendBuff[4] = 0;
  819. SvrSendBuff[5] = 0;
  820. SvrSendBuff[6] = 0;
  821. SvrSendBuff[7] = new_ble_addr.addr[3];
  822. SvrSendBuff[8] = new_ble_addr.addr[4];
  823. SvrSendBuff[9] = new_ble_addr.addr[5];
  824. SvrSendBuff[10] = SERVER_COMM_DATA_LEN;
  825. SvrSendBuff[11] = 0;
  826. SvrSendBuff[12] = 0;
  827. SvrSendBuff[13] = 0;
  828. SvrSendBuff[14] = 0;
  829. SvrSendBuff[15] = 0;
  830. SvrSendBuff[16] = 0;
  831. SvrSendBuff[17] = 0;
  832. for(i=1; i<18; i++){
  833. SvrSendBuff[18] = SvrSendBuff[18] + SvrSendBuff[i];
  834. }
  835. SvrSendBuff[19] = COM_ETX;
  836. SendToEventServer(&SvrSendBuff[0], 20);
  837. SystemManager.SwitchOn = 1;
  838. PKBuzzerOn();
  839. }
  840. // 송신기 테스트 버튼눌렀을시 동작
  841. void AliveTest()
  842. {
  843. int cnt = 0;
  844. int buz_cnt = 0;
  845. int led_cnt = 0;
  846. char blink_cnt = 0;
  847. char blink_flag = 0;
  848. uint8_t ex = 1;
  849. NRF_LOG_RAW_INFO("Void AliveTest\n");
  850. #if 0
  851. PKBuzzerOn();
  852. PKLedOn();
  853. blink_flag = 1;
  854. while(ex){
  855. if(SystemTimer.MS_100_TICK){
  856. SystemTimer.MS_100_TICK = 0;
  857. cnt++;
  858. if(cnt >= 5){
  859. cnt = 0;
  860. buz_cnt++;
  861. if(buz_cnt >= 2){ // 10sec
  862. PKBuzzerOff();
  863. }
  864. blink_flag = !blink_flag;
  865. if(blink_flag){
  866. PKLedOn();
  867. }else{
  868. PKLedOff();
  869. blink_cnt++;
  870. if(blink_cnt >= 3)
  871. ex = 0;
  872. }
  873. }
  874. }
  875. }
  876. // SystemManager.LedBlinkRun = COM_TYPE_SVR_TEST;
  877. // SystemManager.LedBlinkTimer = 3300;
  878. // SystemTimer.LED_TOGGLE_TIMER = 0;
  879. #else
  880. SystemManager.SwitchOn = 1;
  881. PKBuzzerOn();
  882. SystemManager.LedBlinkRun = COM_TYPE_SVR_TEST;
  883. SystemManager.LedBlinkTimer = 3300;
  884. SystemTimer.LED_TOGGLE_TIMER = 0;
  885. #endif
  886. }
  887. void LedToggle()
  888. {
  889. static char toggle = 0;
  890. #if 0
  891. if( SystemManager.RegRequst )
  892. {
  893. if( SystemTimer.DEV_REG_TIMER >= 60000 )
  894. {
  895. SystemManager.RegRequst = 0;
  896. PKLedOff();
  897. SystemManager.LedBlinkRun = 0;
  898. }
  899. }
  900. #endif
  901. // 송신기 등록모드시 항상 ON
  902. if( SystemManager.LedBlinkRun == COM_TYPE_SVR_RECV_REG )
  903. {
  904. PKLedOn();
  905. return;
  906. }
  907. if( SystemManager.LedBlinkRun == COM_TYPE_SVR_RECV_REG+1 )
  908. {
  909. if( SystemManager.RegRequst == 1 )
  910. {
  911. if( SystemManager.LedBlinkTimer < 0 )
  912. {
  913. SystemManager.LedBlinkRun = COM_TYPE_SVR_RECV_REG;
  914. PKLedOn();
  915. return;
  916. }
  917. }
  918. if( SystemTimer.LED_TOGGLE_TIMER < 500 )
  919. return;
  920. SystemTimer.LED_TOGGLE_TIMER = 0;
  921. if( toggle++ & 0x01)
  922. {
  923. PKLedOn();
  924. }else{
  925. PKLedOff();
  926. }
  927. }
  928. if( SystemManager.LedBlinkRun == COM_TYPE_SVR_TEST )
  929. {
  930. if( SystemManager.LedBlinkTimer < 0 )
  931. {
  932. SystemManager.LedBlinkRun = 0;
  933. PKLedOff();
  934. PKBuzzerOff();
  935. return;
  936. }
  937. if( SystemTimer.LED_TOGGLE_TIMER < 500 )
  938. return;
  939. SystemTimer.LED_TOGGLE_TIMER = 0;
  940. if( toggle++&0x01)
  941. {
  942. PKLedOn();
  943. }else{
  944. PKLedOff();
  945. }
  946. }
  947. if( SystemManager.SwitchOn == 0 )
  948. return;
  949. if( SystemManager.LedBlinkRun == 0 )
  950. return;
  951. #if 0
  952. if( SystemManager.LedBlinkTimer < 0 )
  953. {
  954. SystemManager.LedBlinkRun = 0;
  955. PKLedOff();
  956. return;
  957. }
  958. #endif
  959. if( SystemTimer.LED_TOGGLE_TIMER < 500 )
  960. return;
  961. SystemTimer.LED_TOGGLE_TIMER = 0;
  962. if( toggle++&0x01)
  963. {
  964. PKLedOn();
  965. }else{
  966. PKLedOff();
  967. }
  968. }