Module_AlarmDetect.c 39 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070
  1. /*
  2. * Module_AlarmDetect.c
  3. *
  4. * Created on: 2020年01月15日
  5. * Author: Eason Yang
  6. */
  7. #include <sys/types.h>
  8. #include <sys/stat.h>
  9. #include <sys/time.h>
  10. #include <sys/timeb.h>
  11. #include <sys/ipc.h>
  12. #include <sys/shm.h>
  13. #include <sys/mman.h>
  14. #include <unistd.h>
  15. #include <stdarg.h>
  16. #include <stdio.h> /*標準輸入輸出定義*/
  17. #include <stdlib.h> /*標準函數庫定義*/
  18. #include <unistd.h> /*Unix 標準函數定義*/
  19. #include <fcntl.h> /*檔控制定義*/
  20. #include <termios.h> /*PPSIX 終端控制定義*/
  21. #include <errno.h> /*錯誤號定義*/
  22. #include <errno.h>
  23. #include <string.h>
  24. #include <time.h>
  25. #include <ctype.h>
  26. #include "define.h"
  27. #include "main.h"
  28. #define FILTER_SPEC 2
  29. #define DEBUG_INFO(format, args...) StoreLogMsg("[%s:%d][%s][Info] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
  30. #define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
  31. #define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, __FILE__, __LINE__, __FUNCTION__, ##args)
  32. #define Debug
  33. #define ARRAY_SIZE(A) (sizeof(A) / sizeof(A[0]))
  34. #define PASS 1
  35. #define FAIL 0
  36. #define ON 1
  37. #define OFF 0
  38. #define SPEC_OV 275
  39. #define SPEC_UV 160
  40. #define SPEC_OC (32*1.1)
  41. #define SPEC_OT 85
  42. #define HYSTERETIC_OUV 10
  43. #define HYSTERETIC_OT 10
  44. #define HYSTERETIC_OC 10
  45. struct{
  46. unsigned short int OV[3];
  47. unsigned short int UV[3];
  48. unsigned short int OC;
  49. unsigned short int OT_AMB;
  50. unsigned short int GMI;
  51. unsigned short int Short;
  52. unsigned short int Leakage;
  53. unsigned short int HandShakingTimeout;
  54. unsigned short int EmrgencyBTN;
  55. unsigned short int Relay_Welding;
  56. unsigned short int Relay_DrivingFault;
  57. unsigned short int CP_LevelFail;
  58. unsigned short int MCU_SelfTestFail;
  59. }Alarm_Counter[2];
  60. void trim(char *s);
  61. void substr(char *dest, const char* src, unsigned int start, unsigned int cnt);
  62. struct SysConfigAndInfo *ShmSysConfigAndInfo;
  63. struct StatusCodeData *ShmStatusCodeData;
  64. struct OCPP16Data *ShmOCPP16Data;
  65. struct Charger *ShmCharger;
  66. int StoreLogMsg(const char *fmt, ...)
  67. {
  68. char Buf[4096+256];
  69. char buffer[4096];
  70. time_t CurrentTime;
  71. struct tm *tm;
  72. va_list args;
  73. va_start(args, fmt);
  74. int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
  75. va_end(args);
  76. memset(Buf,0,sizeof(Buf));
  77. CurrentTime = time(NULL);
  78. tm=localtime(&CurrentTime);
  79. if((ShmSysConfigAndInfo->SysConfig.ModelName != NULL) && (ShmSysConfigAndInfo->SysConfig.SerialNumber != NULL) && (strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName) >= 14))
  80. {
  81. sprintf(Buf,"echo \"[%04d.%02d.%02d %02d:%02d:%02d] - %s\" >> /Storage/SystemLog/[%04d.%02d]%s_%s_SystemLog",
  82. tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,
  83. buffer,
  84. tm->tm_year+1900,tm->tm_mon+1,
  85. ShmSysConfigAndInfo->SysConfig.ModelName,
  86. ShmSysConfigAndInfo->SysConfig.SerialNumber);
  87. }
  88. else
  89. {
  90. sprintf(Buf,"echo \"[%04d.%02d.%02d %02d:%02d:%02d] - %s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
  91. tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,
  92. buffer,
  93. tm->tm_year+1900,tm->tm_mon+1);
  94. }
  95. #ifdef SystemLogMessage
  96. system(Buf);
  97. #endif
  98. #ifdef ConsloePrintLog
  99. printf("[%04d.%02d.%02d %02d:%02d:%02d] - %s", tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec, buffer);
  100. #endif
  101. return rc;
  102. }
  103. int DiffTimeb(struct timeb ST, struct timeb ET)
  104. {
  105. //return milli-second
  106. unsigned int StartTime,StopTime;
  107. StartTime=(unsigned int)ST.time;
  108. StopTime=(unsigned int)ET.time;
  109. return (StopTime-StartTime)*1000+ET.millitm-ST.millitm;
  110. }
  111. //==========================================
  112. // Init all share memory
  113. //==========================================
  114. int InitShareMemory()
  115. {
  116. int result = PASS;
  117. int MeterSMId;
  118. //creat ShmSysConfigAndInfo
  119. if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), 0777)) < 0)
  120. {
  121. #ifdef SystemLogMessage
  122. DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
  123. #endif
  124. result = FAIL;
  125. }
  126. else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  127. {
  128. #ifdef SystemLogMessage
  129. DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
  130. #endif
  131. result = FAIL;
  132. }
  133. else
  134. {}
  135. //creat ShmStatusCodeData
  136. if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), 0777)) < 0)
  137. {
  138. #ifdef SystemLogMessage
  139. DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
  140. #endif
  141. result = FAIL;
  142. }
  143. else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  144. {
  145. #ifdef SystemLogMessage
  146. DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
  147. #endif
  148. result = FAIL;
  149. }
  150. else
  151. {}
  152. //creat ShmStatusCodeData
  153. if ((MeterSMId = shmget(ShmChargerKey, sizeof(struct Charger), 0777)) < 0)
  154. {
  155. DEBUG_ERROR("shmget ShmCharger NG\r\n");
  156. result = FAIL;
  157. }
  158. else if ((ShmCharger = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  159. {
  160. DEBUG_ERROR("shmat ShmCharger NG\r\n");
  161. result = FAIL;
  162. }
  163. else
  164. {}
  165. //creat ShmOCPP16Data
  166. if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data), 0777)) < 0)
  167. {
  168. DEBUG_ERROR("shmget ShmOCPP16Data NG\r\n");
  169. result = FAIL;
  170. }
  171. else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  172. {
  173. DEBUG_ERROR("shmat ShmOCPP16Data NG\r\n");
  174. result = FAIL;
  175. }
  176. else
  177. {}
  178. return result;
  179. }
  180. //==========================================
  181. // Common routine
  182. //==========================================
  183. void trim(char *s)
  184. {
  185. int i=0, j, k, l=0;
  186. while((s[i]==' ')||(s[i]=='\t')||(s[i]=='\n'))
  187. i++;
  188. j = strlen(s)-1;
  189. while((s[j]==' ')||(s[j]=='\t')||(s[j]=='\n'))
  190. j--;
  191. if(i==0 && j==strlen(s)-1) { }
  192. else if(i==0) s[j+1] = '\0';
  193. else {
  194. for(k=i; k<=j; k++) s[l++] = s[k];
  195. s[l] = '\0';
  196. }
  197. }
  198. void substr(char *dest, const char* src, unsigned int start, unsigned int cnt)
  199. {
  200. strncpy(dest, src + start, cnt);
  201. dest[cnt] = 0;
  202. }
  203. //==========================================
  204. // Main process
  205. //==========================================
  206. int main(void)
  207. {
  208. if(InitShareMemory() == FAIL)
  209. {
  210. DEBUG_ERROR("InitShareMemory NG\n");
  211. if(ShmStatusCodeData!=NULL)
  212. {
  213. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory=1;
  214. }
  215. sleep(5);
  216. return FAIL;
  217. }
  218. for(;;)
  219. {
  220. for(int gun_index = 0;gun_index<AC_QUANTITY;gun_index++)
  221. {
  222. //=====================================
  223. // Over voltage detection
  224. //=====================================
  225. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_VOLTAGE))
  226. {
  227. if(Alarm_Counter[gun_index].OV[0] > FILTER_SPEC)
  228. {
  229. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == OFF))
  230. {
  231. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = ON;
  232. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_VOLTAGE;
  233. DEBUG_INFO("ALARM_OVER_VOLTAGE : alarm \r\n");
  234. }
  235. }
  236. else
  237. {
  238. Alarm_Counter[gun_index].OV[0]++;
  239. }
  240. }
  241. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_VOLTAGE)))
  242. {
  243. Alarm_Counter[gun_index].OV[0] = 0;
  244. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == ON))
  245. {
  246. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = OFF;
  247. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_VOLTAGE;
  248. DEBUG_INFO("ALARM_OVER_VOLTAGE : recover \r\n");
  249. }
  250. }
  251. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  252. {
  253. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_VOLTAGE))
  254. {
  255. if(Alarm_Counter[gun_index].OV[1] > FILTER_SPEC)
  256. {
  257. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == OFF))
  258. {
  259. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = ON;
  260. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_VOLTAGE;
  261. DEBUG_INFO("ALARM_OVER_VOLTAGE : alarm \r\n");
  262. }
  263. }
  264. else
  265. {
  266. Alarm_Counter[gun_index].OV[1]++;
  267. }
  268. }
  269. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_VOLTAGE)))
  270. {
  271. Alarm_Counter[gun_index].OV[1] = 0;
  272. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == ON))
  273. {
  274. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = OFF;
  275. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_VOLTAGE;
  276. DEBUG_INFO("ALARM_OVER_VOLTAGE : recover \r\n");
  277. }
  278. }
  279. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_VOLTAGE))
  280. {
  281. if(Alarm_Counter[gun_index].OV[2] > FILTER_SPEC)
  282. {
  283. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == OFF))
  284. {
  285. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = ON;
  286. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_VOLTAGE;
  287. DEBUG_INFO("ALARM_OVER_VOLTAGE : alarm \r\n");
  288. }
  289. }
  290. else
  291. {
  292. Alarm_Counter[gun_index].OV[2]++;
  293. }
  294. }
  295. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_VOLTAGE)))
  296. {
  297. Alarm_Counter[gun_index].OV[2] = 0;
  298. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == ON))
  299. {
  300. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = OFF;
  301. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_VOLTAGE;
  302. DEBUG_INFO("ALARM_OVER_VOLTAGE : recover \r\n");
  303. }
  304. }
  305. }
  306. //=====================================
  307. // Under voltage detection
  308. //=====================================
  309. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_UNDER_VOLTAGE))
  310. {
  311. if(Alarm_Counter[gun_index].UV[0] > FILTER_SPEC)
  312. {
  313. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == OFF))
  314. {
  315. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = ON;
  316. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_UNDER_VOLTAGE;
  317. DEBUG_INFO("ALARM_UNDER_VOLTAGE : alarm \r\n");
  318. }
  319. }
  320. else
  321. {
  322. Alarm_Counter[gun_index].UV[0]++;
  323. }
  324. }
  325. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_UNDER_VOLTAGE)))
  326. {
  327. Alarm_Counter[gun_index].UV[0] = 0;
  328. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == ON))
  329. {
  330. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = OFF;
  331. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_UNDER_VOLTAGE;
  332. DEBUG_INFO("ALARM_UNDER_VOLTAGE : recover \r\n");
  333. }
  334. }
  335. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  336. {
  337. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_UNDER_VOLTAGE))
  338. {
  339. if(Alarm_Counter[gun_index].UV[1] > FILTER_SPEC)
  340. {
  341. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == OFF))
  342. {
  343. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = ON;
  344. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_UNDER_VOLTAGE;
  345. DEBUG_INFO("ALARM_UNDER_VOLTAGE : alarm \r\n");
  346. }
  347. }
  348. else
  349. {
  350. Alarm_Counter[gun_index].UV[1]++;
  351. }
  352. }
  353. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_UNDER_VOLTAGE)))
  354. {
  355. Alarm_Counter[gun_index].UV[1] = 0;
  356. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == ON))
  357. {
  358. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = OFF;
  359. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_UNDER_VOLTAGE;
  360. DEBUG_INFO("ALARM_UNDER_VOLTAGE : recover \r\n");
  361. }
  362. }
  363. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_UNDER_VOLTAGE))
  364. {
  365. if(Alarm_Counter[gun_index].UV[2] > FILTER_SPEC)
  366. {
  367. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == OFF))
  368. {
  369. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = ON;
  370. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_UNDER_VOLTAGE;
  371. DEBUG_INFO("ALARM_UNDER_VOLTAGE : alarm \r\n");
  372. }
  373. }
  374. else
  375. {
  376. Alarm_Counter[gun_index].UV[2]++;
  377. }
  378. }
  379. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_UNDER_VOLTAGE)))
  380. {
  381. Alarm_Counter[gun_index].UV[2] = 0;
  382. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == ON))
  383. {
  384. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = OFF;
  385. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_UNDER_VOLTAGE;
  386. DEBUG_INFO("ALARM_UNDER_VOLTAGE : recover \r\n");
  387. }
  388. }
  389. }
  390. //=====================================
  391. // Over current detection
  392. //=====================================
  393. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_CURRENT))
  394. {
  395. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == OFF))
  396. {
  397. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = ON;
  398. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_CURRENT;
  399. DEBUG_INFO("ALARM_OVER_CURRENT : alarm \r\n");
  400. }
  401. }
  402. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_CURRENT)))
  403. {
  404. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == ON))
  405. {
  406. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = OFF;
  407. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_CURRENT;
  408. DEBUG_INFO("ALARM_OVER_CURRENT : recover \r\n");
  409. }
  410. }
  411. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  412. {
  413. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_CURRENT))
  414. {
  415. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == OFF))
  416. {
  417. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = ON;
  418. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_CURRENT;
  419. DEBUG_INFO("ALARM_OVER_CURRENT : alarm \r\n");
  420. }
  421. }
  422. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_CURRENT)))
  423. {
  424. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == ON))
  425. {
  426. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = OFF;
  427. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_CURRENT;
  428. DEBUG_INFO("ALARM_OVER_CURRENT : recover \r\n");
  429. }
  430. }
  431. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_CURRENT))
  432. {
  433. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == OFF))
  434. {
  435. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = ON;
  436. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_CURRENT;
  437. DEBUG_INFO("ALARM_OVER_CURRENT : alarm \r\n");
  438. }
  439. }
  440. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_CURRENT)))
  441. {
  442. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == ON))
  443. {
  444. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = OFF;
  445. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_CURRENT;
  446. DEBUG_INFO("ALARM_OVER_CURRENT : recover \r\n");
  447. }
  448. }
  449. }
  450. //=====================================
  451. // Over temperature detection
  452. //=====================================
  453. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_TEMPERATURE))
  454. {
  455. if(Alarm_Counter[gun_index].OT_AMB > FILTER_SPEC)
  456. {
  457. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP == OFF))
  458. {
  459. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = ON;
  460. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_TEMPERATURE;
  461. DEBUG_INFO("ALARM_OVER_TEMPERATURE : alarm \r\n");
  462. }
  463. }
  464. else
  465. {
  466. Alarm_Counter[gun_index].OT_AMB++;
  467. }
  468. }
  469. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_TEMPERATURE)))
  470. {
  471. Alarm_Counter[gun_index].OT_AMB = 0;
  472. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP == ON))
  473. {
  474. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = OFF;
  475. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_TEMPERATURE;
  476. DEBUG_INFO("ALARM_OVER_TEMPERATURE : recover \r\n");
  477. }
  478. }
  479. //=====================================
  480. // Ground fault detection
  481. //=====================================
  482. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_GROUND_FAIL)
  483. {
  484. if(Alarm_Counter[gun_index].GMI > FILTER_SPEC)
  485. {
  486. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == OFF))
  487. {
  488. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip = ON;
  489. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_GROUND_FAIL;
  490. DEBUG_INFO("ALARM_GROUND_FAIL : alarm \r\n");
  491. }
  492. }
  493. else
  494. {
  495. Alarm_Counter[gun_index].GMI++;
  496. }
  497. }
  498. else if (!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_GROUND_FAIL))
  499. {
  500. Alarm_Counter[gun_index].GMI = 0;
  501. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip == ON ))
  502. {
  503. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.GbGfdTrip = OFF;
  504. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_GROUND_FAIL;
  505. DEBUG_INFO("ALARM_GROUND_FAIL : recover \r\n");
  506. }
  507. }
  508. //=====================================
  509. // CP level fail detection
  510. //=====================================
  511. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CP_ERROR)
  512. {
  513. if(Alarm_Counter[gun_index].CP_LevelFail > FILTER_SPEC)
  514. {
  515. if(ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault == OFF)
  516. {
  517. ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = ON;
  518. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_CP_ERROR;
  519. DEBUG_INFO("ALARM_CP_ERROR : alarm \r\n");
  520. }
  521. }
  522. else
  523. {
  524. Alarm_Counter[gun_index].CP_LevelFail++;
  525. }
  526. }
  527. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CP_ERROR))
  528. {
  529. Alarm_Counter[gun_index].CP_LevelFail= 0;
  530. if(ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault == ON)
  531. {
  532. ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = OFF;
  533. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_CP_ERROR;
  534. DEBUG_INFO("ALARM_CP_ERROR : recover \r\n");
  535. }
  536. }
  537. //=====================================
  538. // Current AC/DC leak detection
  539. //=====================================
  540. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_AC) ||
  541. (ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_DC))
  542. {
  543. if(Alarm_Counter[gun_index].Leakage > FILTER_SPEC)
  544. {
  545. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip == OFF))
  546. {
  547. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = ON;
  548. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_AC)
  549. {
  550. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_CURRENT_LEAK_AC;
  551. ShmCharger->gun_info[gun_index].otherAlarmCode.isACLeakage = ON;
  552. DEBUG_INFO("ALARM_CURRENT_LEAK_AC : alarm \r\n");
  553. }
  554. else if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_DC)
  555. {
  556. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_CURRENT_LEAK_DC;
  557. ShmCharger->gun_info[gun_index].otherAlarmCode.isDcLeakage = ON;
  558. DEBUG_INFO("ALARM_CURRENT_LEAK_DC : alarm \r\n");
  559. }
  560. }
  561. }
  562. else
  563. {
  564. Alarm_Counter[gun_index].Leakage++;
  565. }
  566. }
  567. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_AC)) ||
  568. (!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_DC)))
  569. {
  570. Alarm_Counter[gun_index].Leakage = 0;
  571. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip == ON))
  572. {
  573. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = OFF;
  574. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isACLeakage == ON)
  575. {
  576. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_CURRENT_LEAK_AC;
  577. ShmCharger->gun_info[gun_index].otherAlarmCode.isACLeakage = OFF;
  578. DEBUG_INFO("ALARM_CURRENT_LEAK_AC : recover \r\n");
  579. }
  580. else if(ShmCharger->gun_info[gun_index].otherAlarmCode.isDcLeakage == ON)
  581. {
  582. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_CURRENT_LEAK_DC;
  583. ShmCharger->gun_info[gun_index].otherAlarmCode.isDcLeakage = OFF;
  584. DEBUG_INFO("ALARM_CURRENT_LEAK_DC : recover \r\n");
  585. }
  586. }
  587. }
  588. //=====================================
  589. // MCU self test fail detection
  590. //=====================================
  591. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_MCU_TESTFAIL)
  592. {
  593. if(Alarm_Counter[gun_index].MCU_SelfTestFail > FILTER_SPEC)
  594. {
  595. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isMcuSelfTest == OFF)
  596. {
  597. ShmCharger->gun_info[gun_index].otherAlarmCode.isMcuSelfTest = ON;
  598. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_MCU_TESTFAIL;
  599. DEBUG_INFO("ALARM_MCU_TESTFAIL : alarm \r\n");
  600. }
  601. }
  602. else
  603. {
  604. Alarm_Counter[gun_index].MCU_SelfTestFail++;
  605. }
  606. }
  607. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_MCU_TESTFAIL))
  608. {
  609. Alarm_Counter[gun_index].MCU_SelfTestFail = 0;
  610. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isMcuSelfTest == ON)
  611. {
  612. ShmCharger->gun_info[gun_index].otherAlarmCode.isMcuSelfTest = OFF;
  613. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_MCU_TESTFAIL;
  614. DEBUG_INFO("ALARM_MCU_TESTFAIL : recover \r\n");
  615. }
  616. }
  617. //=====================================
  618. // Hand shaking timeout detection
  619. //=====================================
  620. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_HANDSHAKE_TIMEOUT)
  621. {
  622. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut == OFF)
  623. {
  624. ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut = ON;
  625. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_HANDSHAKE_TIMEOUT;
  626. DEBUG_INFO("ALARM_HANDSHAKE_TIMEOUT : alarm \r\n");
  627. }
  628. }
  629. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_HANDSHAKE_TIMEOUT))
  630. {
  631. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut == ON)
  632. {
  633. ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut = OFF;
  634. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_HANDSHAKE_TIMEOUT;
  635. DEBUG_INFO("ALARM_HANDSHAKE_TIMEOUT : recover \r\n");
  636. }
  637. }
  638. //=====================================
  639. // Emergency stop detection
  640. //=====================================
  641. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_EMERGENCY_STOP)
  642. {
  643. if(Alarm_Counter[gun_index].EmrgencyBTN > FILTER_SPEC)
  644. {
  645. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == OFF))
  646. {
  647. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = ON;
  648. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_EMERGENCY_STOP;
  649. DEBUG_INFO("ALARM_EMERGENCY_STOP : alarm \r\n");
  650. }
  651. }
  652. else
  653. {
  654. Alarm_Counter[gun_index].EmrgencyBTN++;
  655. }
  656. }
  657. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_EMERGENCY_STOP))
  658. {
  659. Alarm_Counter[gun_index].EmrgencyBTN = 0;
  660. if((ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == ON))
  661. {
  662. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = OFF;
  663. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_EMERGENCY_STOP;
  664. DEBUG_INFO("ALARM_EMERGENCY_STOP : recover \r\n");
  665. }
  666. }
  667. //=====================================
  668. // Relay welding detection
  669. //=====================================
  670. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_WELDING)
  671. {
  672. if(Alarm_Counter[gun_index].Relay_Welding > FILTER_SPEC)
  673. {
  674. if((ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding == OFF))
  675. {
  676. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = ON;
  677. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_RELAY_WELDING;
  678. DEBUG_INFO("ALARM_RELAY_STATUS : alarm \r\n");
  679. }
  680. }
  681. else
  682. {
  683. Alarm_Counter[gun_index].Relay_Welding++;
  684. }
  685. }
  686. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_WELDING))
  687. {
  688. Alarm_Counter[gun_index].Relay_Welding = 0;
  689. if((ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding == ON))
  690. {
  691. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = OFF;
  692. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_RELAY_WELDING;
  693. DEBUG_INFO("ALARM_RELAY_STATUS : recover \r\n");
  694. }
  695. }
  696. //=====================================
  697. // Relay driving fault detection
  698. //=====================================
  699. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_DRIVE_FAULT)
  700. {
  701. if(Alarm_Counter[gun_index].Relay_DrivingFault > FILTER_SPEC)
  702. {
  703. if((ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault == OFF))
  704. {
  705. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = ON;
  706. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_RELAY_DRIVE_FAULT;
  707. DEBUG_INFO("ALARM_RELAY_DRIVE_FAULT : alarm \r\n");
  708. }
  709. }
  710. else
  711. {
  712. Alarm_Counter[gun_index].Relay_DrivingFault++;
  713. }
  714. }
  715. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_DRIVE_FAULT))
  716. {
  717. Alarm_Counter[gun_index].Relay_DrivingFault = 0;
  718. if((ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault == ON))
  719. {
  720. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = OFF;
  721. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_RELAY_DRIVE_FAULT;
  722. DEBUG_INFO("ALARM_RELAY_DRIVE_FAULT : recover \r\n");
  723. }
  724. }
  725. //=====================================
  726. // Current short detection
  727. //=====================================
  728. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_SHORT)
  729. {
  730. if(Alarm_Counter[gun_index].Short > FILTER_SPEC)
  731. {
  732. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isCurrentShort == OFF)
  733. {
  734. ShmCharger->gun_info[gun_index].otherAlarmCode.isCurrentShort = ON;
  735. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_CURRENT_SHORT;
  736. DEBUG_INFO("ALARM_CIRCUIT_SHORT : alarm \r\n");
  737. }
  738. }
  739. else
  740. {
  741. Alarm_Counter[gun_index].Short++;
  742. }
  743. }
  744. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_SHORT))
  745. {
  746. Alarm_Counter[gun_index].Short = 0;
  747. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isCurrentShort == ON)
  748. {
  749. ShmCharger->gun_info[gun_index].otherAlarmCode.isCurrentShort = OFF;
  750. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_CURRENT_SHORT;
  751. DEBUG_INFO("ALARM_CIRCUIT_SHORT : recover \r\n");
  752. }
  753. }
  754. //=====================================
  755. // Rotatory switch detection
  756. //=====================================
  757. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_ROTATORY_SWITCH_FAULT)
  758. {
  759. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isRotatorySwitch == OFF)
  760. {
  761. ShmCharger->gun_info[gun_index].otherAlarmCode.isRotatorySwitch = ON;
  762. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_ROTATORY_SWITCH_FAULT;
  763. DEBUG_INFO("ALARM_ROTATORY_SWITCH_FAULT : alarm \r\n");
  764. }
  765. }
  766. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_ROTATORY_SWITCH_FAULT))
  767. {
  768. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isRotatorySwitch == ON)
  769. {
  770. ShmCharger->gun_info[gun_index].otherAlarmCode.isRotatorySwitch = OFF;
  771. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_ROTATORY_SWITCH_FAULT;
  772. DEBUG_INFO("ALARM_ROTATORY_SWITCH_FAULT : recover \r\n");
  773. }
  774. }
  775. //=====================================
  776. // Leakage module detection
  777. //=====================================
  778. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LEAK_MODULE_FAIL)
  779. {
  780. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isLeakageModule == OFF)
  781. {
  782. ShmCharger->gun_info[gun_index].otherAlarmCode.isLeakageModule = ON;
  783. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_LEAK_MODULE_FAIL;
  784. DEBUG_INFO("ALARM_LEAK_MODULE_FAIL : alarm \r\n");
  785. }
  786. }
  787. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LEAK_MODULE_FAIL))
  788. {
  789. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isLeakageModule == ON)
  790. {
  791. ShmCharger->gun_info[gun_index].otherAlarmCode.isLeakageModule = OFF;
  792. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_LEAK_MODULE_FAIL;
  793. DEBUG_INFO("ALARM_LEAK_MODULE_FAIL : recover \r\n");
  794. }
  795. }
  796. //=====================================
  797. // Shutter detection
  798. //=====================================
  799. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_SHUTTER_FAULT)
  800. {
  801. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isShutterFail == OFF)
  802. {
  803. ShmCharger->gun_info[gun_index].otherAlarmCode.isShutterFail = ON;
  804. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_SHUTTER_FAULT;
  805. DEBUG_INFO("ALARM_SHUTTER_FAULT : alarm \r\n");
  806. }
  807. }
  808. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_SHUTTER_FAULT))
  809. {
  810. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isShutterFail == ON)
  811. {
  812. ShmCharger->gun_info[gun_index].otherAlarmCode.isShutterFail = OFF;
  813. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_SHUTTER_FAULT;
  814. DEBUG_INFO("ALARM_SHUTTER_FAULT : recover \r\n");
  815. }
  816. }
  817. //=====================================
  818. // Locker detection
  819. //=====================================
  820. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LOCKER_FAULT)
  821. {
  822. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isLockerFault == OFF)
  823. {
  824. ShmCharger->gun_info[gun_index].otherAlarmCode.isLockerFault = ON;
  825. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_LOCKER_FAULT;
  826. DEBUG_INFO("ALARM_LOCKER_FAULT : alarm \r\n");
  827. }
  828. }
  829. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LOCKER_FAULT))
  830. {
  831. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isLockerFault== ON)
  832. {
  833. ShmCharger->gun_info[gun_index].otherAlarmCode.isLockerFault = OFF;
  834. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_LOCKER_FAULT;
  835. DEBUG_INFO("ALARM_LOCKER_FAULT : recover \r\n");
  836. }
  837. }
  838. //=====================================
  839. // Power drop detection
  840. //=====================================
  841. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_POWER_DROP)
  842. {
  843. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isPowerDrop == OFF)
  844. {
  845. ShmCharger->gun_info[gun_index].otherAlarmCode.isPowerDrop = ON;
  846. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_POWER_DROP;
  847. DEBUG_INFO("ALARM_POWER_DROP : alarm \r\n");
  848. }
  849. }
  850. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_POWER_DROP))
  851. {
  852. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isPowerDrop == ON)
  853. {
  854. ShmCharger->gun_info[gun_index].otherAlarmCode.isPowerDrop = OFF;
  855. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_POWER_DROP;
  856. DEBUG_INFO("ALARM_POWER_DROP : recover \r\n");
  857. }
  858. }
  859. //=====================================
  860. // OCPP error code message
  861. //=====================================
  862. if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_OVER_VOLTAGE)
  863. {
  864. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OverVoltage");
  865. }
  866. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_UNDER_VOLTAGE)
  867. {
  868. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "UnderVoltage");
  869. }
  870. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_OVER_CURRENT)
  871. {
  872. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OverCurrentFailure");
  873. }
  874. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_OVER_TEMPERATURE)
  875. {
  876. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "HighTemperature");
  877. }
  878. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_GROUND_FAIL)
  879. {
  880. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "GroundFailure");
  881. }
  882. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CP_ERROR)
  883. {
  884. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  885. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "CpError");
  886. }
  887. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CURRENT_LEAK_AC)
  888. {
  889. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  890. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "ACLeakage");
  891. }
  892. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CURRENT_LEAK_DC)
  893. {
  894. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  895. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "DCLeakage");
  896. }
  897. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_MCU_TESTFAIL)
  898. {
  899. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  900. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "McuTestFail");
  901. }
  902. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_HANDSHAKE_TIMEOUT)
  903. {
  904. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  905. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "HandshakeTimeout");
  906. }
  907. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_EMERGENCY_STOP)
  908. {
  909. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  910. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "EmergencyStop");
  911. }
  912. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_RELAY_WELDING)
  913. {
  914. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  915. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "RelayWelding");
  916. }
  917. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_LEAK_MODULE_FAIL)
  918. {
  919. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  920. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "LeakageModuleFail");
  921. }
  922. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_SHUTTER_FAULT)
  923. {
  924. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  925. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "ShutterFault");
  926. }
  927. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_LOCKER_FAULT)
  928. {
  929. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "ConnectorLockFailure");
  930. }
  931. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_POWER_DROP)
  932. {
  933. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  934. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "PowerDrop");
  935. }
  936. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CURRENT_SHORT)
  937. {
  938. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  939. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "CircuitShort");
  940. }
  941. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_ROTATORY_SWITCH_FAULT)
  942. {
  943. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  944. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "RotatorySwitchFault");
  945. }
  946. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_RELAY_DRIVE_FAULT)
  947. {
  948. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  949. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "RelayDriveFault");
  950. }
  951. else
  952. {
  953. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "NoError");
  954. memset(ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode, 0x00, ARRAY_SIZE(ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode));
  955. }
  956. //=====================================
  957. // Latch alarm recover in state A
  958. //=====================================
  959. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 1))
  960. {
  961. /*
  962. TODO: Recover latch alarm here
  963. */
  964. }
  965. //=====================================
  966. // Latch alarm recover in state B1 and B2
  967. //=====================================
  968. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 2) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 3))
  969. {
  970. /*
  971. TODO: Recover latch alarm here
  972. */
  973. }
  974. //=====================================
  975. // Latch alarm recover in state C
  976. //=====================================
  977. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 4))
  978. {
  979. /*
  980. TODO: Recover latch alarm here
  981. */
  982. }
  983. }
  984. usleep(100000);
  985. }
  986. return FAIL;
  987. }