Module_AlarmDetect.c 43 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127
  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[3];
  49. unsigned short int OT_AMB;
  50. unsigned short int GMI;
  51. unsigned short int Short[3];
  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_L1_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_L1_OVER_VOLTAGE;
  233. DEBUG_INFO("ALARM_L1_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_L1_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_L1_OVER_VOLTAGE;
  248. DEBUG_INFO("ALARM_L1_OVER_VOLTAGE : recover \r\n");
  249. }
  250. }
  251. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  252. {
  253. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_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_L2_OVER_VOLTAGE;
  261. DEBUG_INFO("ALARM_L2_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_L2_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_L2_OVER_VOLTAGE;
  276. DEBUG_INFO("ALARM_L2_OVER_VOLTAGE : recover \r\n");
  277. }
  278. }
  279. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_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_L3_OVER_VOLTAGE;
  287. DEBUG_INFO("ALARM_L3_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_L3_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_L3_OVER_VOLTAGE;
  302. DEBUG_INFO("ALARM_L3_OVER_VOLTAGE : recover \r\n");
  303. }
  304. }
  305. }
  306. //=====================================
  307. // Under voltage detection
  308. //=====================================
  309. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_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_L1_UNDER_VOLTAGE;
  317. DEBUG_INFO("ALARM_L1_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_L1_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_L1_UNDER_VOLTAGE;
  332. DEBUG_INFO("ALARM_L1_UNDER_VOLTAGE : recover \r\n");
  333. }
  334. }
  335. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  336. {
  337. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_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_L2_UNDER_VOLTAGE;
  345. DEBUG_INFO("ALARM_L2_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_L2_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_L2_UNDER_VOLTAGE;
  360. DEBUG_INFO("ALARM_L2_UNDER_VOLTAGE : recover \r\n");
  361. }
  362. }
  363. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_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_L3_UNDER_VOLTAGE;
  371. DEBUG_INFO("ALARM_L3_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_L3_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_L3_UNDER_VOLTAGE;
  386. DEBUG_INFO("ALARM_L3_UNDER_VOLTAGE : recover \r\n");
  387. }
  388. }
  389. }
  390. //=====================================
  391. // Over current detection
  392. //=====================================
  393. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_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_L1_OVER_CURRENT;
  399. DEBUG_INFO("ALARM_L1_OVER_CURRENT : alarm \r\n");
  400. }
  401. }
  402. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_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_L1_OVER_CURRENT;
  408. DEBUG_INFO("ALARM_L1_OVER_CURRENT : recover \r\n");
  409. }
  410. }
  411. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  412. {
  413. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_OVER_CURRENT)
  414. {
  415. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 == OFF)
  416. {
  417. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 = ON;
  418. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L2_OVER_CURRENT;
  419. DEBUG_INFO("ALARM_L2_OVER_CURRENT : alarm \r\n");
  420. }
  421. }
  422. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_OVER_CURRENT)))
  423. {
  424. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 == ON)
  425. {
  426. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 = OFF;
  427. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L2_OVER_CURRENT;
  428. DEBUG_INFO("ALARM_L2_OVER_CURRENT : recover \r\n");
  429. }
  430. }
  431. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_OVER_CURRENT)
  432. {
  433. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 == OFF)
  434. {
  435. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 = ON;
  436. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L3_OVER_CURRENT;
  437. DEBUG_INFO("ALARM_L3_OVER_CURRENT : alarm \r\n");
  438. }
  439. }
  440. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_OVER_CURRENT)))
  441. {
  442. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 == ON)
  443. {
  444. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 = OFF;
  445. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L3_OVER_CURRENT;
  446. DEBUG_INFO("ALARM_L3_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.AcGroundfaultFail == OFF)
  487. {
  488. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = 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.AcGroundfaultFail == ON)
  502. {
  503. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = 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(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail == OFF)
  596. {
  597. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = 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(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail == ON)
  611. {
  612. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = 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_L1_CIRCUIT_SHORT)
  729. {
  730. if(Alarm_Counter[gun_index].Short[0] > FILTER_SPEC)
  731. {
  732. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort == OFF)
  733. {
  734. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = ON;
  735. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L1_CIRCUIT_SHORT;
  736. DEBUG_INFO("ALARM_L1_CIRCUIT_SHORT : alarm \r\n");
  737. }
  738. }
  739. else
  740. {
  741. Alarm_Counter[gun_index].Short[0]++;
  742. }
  743. }
  744. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_CIRCUIT_SHORT))
  745. {
  746. Alarm_Counter[gun_index].Short[0] = 0;
  747. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort == ON)
  748. {
  749. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = OFF;
  750. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L1_CIRCUIT_SHORT;
  751. DEBUG_INFO("ALARM_L1_CIRCUIT_SHORT : recover \r\n");
  752. }
  753. }
  754. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  755. {
  756. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_CIRCUIT_SHORT)
  757. {
  758. if(Alarm_Counter[gun_index].Short[1] > FILTER_SPEC)
  759. {
  760. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 == OFF)
  761. {
  762. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 = ON;
  763. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L2_CIRCUIT_SHORT;
  764. DEBUG_INFO("ALARM_L2_CIRCUIT_SHORT : alarm \r\n");
  765. }
  766. }
  767. else
  768. {
  769. Alarm_Counter[gun_index].Short[1]++;
  770. }
  771. }
  772. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_CIRCUIT_SHORT))
  773. {
  774. Alarm_Counter[gun_index].Short[1] = 0;
  775. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 == ON)
  776. {
  777. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 = OFF;
  778. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L2_CIRCUIT_SHORT;
  779. DEBUG_INFO("ALARM_L2_CIRCUIT_SHORT : recover \r\n");
  780. }
  781. }
  782. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_CIRCUIT_SHORT)
  783. {
  784. if(Alarm_Counter[gun_index].Short[2] > FILTER_SPEC)
  785. {
  786. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 == OFF)
  787. {
  788. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 = ON;
  789. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L3_CIRCUIT_SHORT;
  790. DEBUG_INFO("ALARM_L3_CIRCUIT_SHORT : alarm \r\n");
  791. }
  792. }
  793. else
  794. {
  795. Alarm_Counter[gun_index].Short[2]++;
  796. }
  797. }
  798. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_CIRCUIT_SHORT))
  799. {
  800. Alarm_Counter[gun_index].Short[2] = 0;
  801. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 == ON)
  802. {
  803. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 = OFF;
  804. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L3_CIRCUIT_SHORT;
  805. DEBUG_INFO("ALARM_L3_CIRCUIT_SHORT : recover \r\n");
  806. }
  807. }
  808. }
  809. //=====================================
  810. // Rotatory switch detection
  811. //=====================================
  812. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_ROTATORY_SWITCH_FAULT)
  813. {
  814. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault == OFF)
  815. {
  816. ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault = ON;
  817. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_ROTATORY_SWITCH_FAULT;
  818. DEBUG_INFO("ALARM_ROTATORY_SWITCH_FAULT : alarm \r\n");
  819. }
  820. }
  821. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_ROTATORY_SWITCH_FAULT))
  822. {
  823. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault == ON)
  824. {
  825. ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault = OFF;
  826. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_ROTATORY_SWITCH_FAULT;
  827. DEBUG_INFO("ALARM_ROTATORY_SWITCH_FAULT : recover \r\n");
  828. }
  829. }
  830. //=====================================
  831. // Leakage module detection
  832. //=====================================
  833. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LEAK_MODULE_FAIL)
  834. {
  835. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail == OFF)
  836. {
  837. ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = ON;
  838. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_LEAK_MODULE_FAIL;
  839. DEBUG_INFO("ALARM_LEAK_MODULE_FAIL : alarm \r\n");
  840. }
  841. }
  842. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LEAK_MODULE_FAIL))
  843. {
  844. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail == ON)
  845. {
  846. ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = OFF;
  847. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_LEAK_MODULE_FAIL;
  848. DEBUG_INFO("ALARM_LEAK_MODULE_FAIL : recover \r\n");
  849. }
  850. }
  851. //=====================================
  852. // Shutter detection
  853. //=====================================
  854. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_SHUTTER_FAULT)
  855. {
  856. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault == OFF)
  857. {
  858. ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault = ON;
  859. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_SHUTTER_FAULT;
  860. DEBUG_INFO("ALARM_SHUTTER_FAULT : alarm \r\n");
  861. }
  862. }
  863. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_SHUTTER_FAULT))
  864. {
  865. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault == ON)
  866. {
  867. ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault = OFF;
  868. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_SHUTTER_FAULT;
  869. DEBUG_INFO("ALARM_SHUTTER_FAULT : recover \r\n");
  870. }
  871. }
  872. //=====================================
  873. // Locker detection
  874. //=====================================
  875. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LOCKER_FAULT)
  876. {
  877. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail == OFF)
  878. {
  879. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = ON;
  880. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_LOCKER_FAULT;
  881. DEBUG_INFO("ALARM_LOCKER_FAULT : alarm \r\n");
  882. }
  883. }
  884. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LOCKER_FAULT))
  885. {
  886. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail == ON)
  887. {
  888. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = OFF;
  889. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_LOCKER_FAULT;
  890. DEBUG_INFO("ALARM_LOCKER_FAULT : recover \r\n");
  891. }
  892. }
  893. //=====================================
  894. // Power drop detection
  895. //=====================================
  896. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_POWER_DROP)
  897. {
  898. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop == OFF)
  899. {
  900. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = ON;
  901. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_POWER_DROP;
  902. DEBUG_INFO("ALARM_POWER_DROP : alarm \r\n");
  903. }
  904. }
  905. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_POWER_DROP))
  906. {
  907. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop == ON)
  908. {
  909. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = OFF;
  910. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_POWER_DROP;
  911. DEBUG_INFO("ALARM_POWER_DROP : recover \r\n");
  912. }
  913. }
  914. //=====================================
  915. // OCPP error code message
  916. //=====================================
  917. if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_OVER_VOLTAGE) ||
  918. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_OVER_VOLTAGE) ||
  919. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_OVER_VOLTAGE))
  920. {
  921. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OverVoltage");
  922. }
  923. else if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_UNDER_VOLTAGE) ||
  924. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_UNDER_VOLTAGE) ||
  925. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_UNDER_VOLTAGE))
  926. {
  927. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "UnderVoltage");
  928. }
  929. else if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_OVER_CURRENT) ||
  930. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_OVER_CURRENT) ||
  931. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_OVER_CURRENT))
  932. {
  933. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OverCurrentFailure");
  934. }
  935. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_OVER_TEMPERATURE)
  936. {
  937. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "HighTemperature");
  938. }
  939. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_GROUND_FAIL)
  940. {
  941. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "GroundFailure");
  942. }
  943. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CP_ERROR)
  944. {
  945. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  946. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "CpError");
  947. }
  948. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CURRENT_LEAK_AC)
  949. {
  950. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  951. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "ACLeakage");
  952. }
  953. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CURRENT_LEAK_DC)
  954. {
  955. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  956. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "DCLeakage");
  957. }
  958. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_MCU_TESTFAIL)
  959. {
  960. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  961. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "McuTestFail");
  962. }
  963. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_HANDSHAKE_TIMEOUT)
  964. {
  965. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  966. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "HandshakeTimeout");
  967. }
  968. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_EMERGENCY_STOP)
  969. {
  970. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  971. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "EmergencyStop");
  972. }
  973. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_RELAY_WELDING)
  974. {
  975. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  976. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "RelayWelding");
  977. }
  978. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_LEAK_MODULE_FAIL)
  979. {
  980. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  981. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "LeakageModuleFail");
  982. }
  983. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_SHUTTER_FAULT)
  984. {
  985. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  986. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "ShutterFault");
  987. }
  988. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_LOCKER_FAULT)
  989. {
  990. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "ConnectorLockFailure");
  991. }
  992. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_POWER_DROP)
  993. {
  994. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  995. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "PowerDrop");
  996. }
  997. else if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_CIRCUIT_SHORT) ||
  998. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_CIRCUIT_SHORT) ||
  999. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_CIRCUIT_SHORT))
  1000. {
  1001. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1002. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "CircuitShort");
  1003. }
  1004. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_ROTATORY_SWITCH_FAULT)
  1005. {
  1006. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1007. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "RotatorySwitchFault");
  1008. }
  1009. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_RELAY_DRIVE_FAULT)
  1010. {
  1011. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1012. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "RelayDriveFault");
  1013. }
  1014. else
  1015. {
  1016. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "NoError");
  1017. memset(ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode, 0x00, ARRAY_SIZE(ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode));
  1018. }
  1019. //=====================================
  1020. // Latch alarm recover in state A
  1021. //=====================================
  1022. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 1))
  1023. {
  1024. /*
  1025. TODO: Recover latch alarm here
  1026. */
  1027. }
  1028. //=====================================
  1029. // Latch alarm recover in state B1 and B2
  1030. //=====================================
  1031. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 2) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 3))
  1032. {
  1033. /*
  1034. TODO: Recover latch alarm here
  1035. */
  1036. }
  1037. //=====================================
  1038. // Latch alarm recover in state C
  1039. //=====================================
  1040. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 4))
  1041. {
  1042. /*
  1043. TODO: Recover latch alarm here
  1044. */
  1045. }
  1046. ShmCharger->gun_info[gun_index].acCcsInfo.CSUAlarmStatusCode = ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode;
  1047. }
  1048. usleep(100000);
  1049. }
  1050. return FAIL;
  1051. }