Module_AlarmDetect.c 47 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192
  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>
  19. #include <fcntl.h>
  20. #include <termios.h>
  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, (strrchr(__FILE__, '/') ? strrchr(__FILE__, '/') + 1 : __FILE__), __LINE__, __FUNCTION__, ##args)
  30. #define DEBUG_WARN(format, args...) StoreLogMsg("[%s:%d][%s][Warn] "format, (strrchr(__FILE__, '/') ? strrchr(__FILE__, '/') + 1 : __FILE__), __LINE__, __FUNCTION__, ##args)
  31. #define DEBUG_ERROR(format, args...) StoreLogMsg("[%s:%d][%s][Error] "format, (strrchr(__FILE__, '/') ? strrchr(__FILE__, '/') + 1 : __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. struct timeval tv;
  73. va_list args;
  74. va_start(args, fmt);
  75. int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
  76. va_end(args);
  77. memset(Buf,0,sizeof(Buf));
  78. CurrentTime = time(NULL);
  79. tm=localtime(&CurrentTime);
  80. gettimeofday(&tv, NULL); // get microseconds, 10^-6
  81. if((ShmSysConfigAndInfo->SysConfig.ModelName != NULL) && (ShmSysConfigAndInfo->SysConfig.SerialNumber != NULL) && (strlen((char*)ShmSysConfigAndInfo->SysConfig.ModelName) >= 14))
  82. {
  83. sprintf(Buf,"echo -n \"[%04d.%02d.%02d %02d:%02d:%02d.%06ld]%s\" >> /Storage/SystemLog/[%04d.%02d]%s_%s_SystemLog",
  84. tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,tv.tv_usec,
  85. buffer,
  86. tm->tm_year+1900,tm->tm_mon+1,
  87. ShmSysConfigAndInfo->SysConfig.ModelName,
  88. ShmSysConfigAndInfo->SysConfig.SerialNumber);
  89. }
  90. else
  91. {
  92. sprintf(Buf,"echo -n \"[%04d.%02d.%02d %02d:%02d:%02d.%06ld]%s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
  93. tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,tv.tv_usec,
  94. buffer,
  95. tm->tm_year+1900,tm->tm_mon+1);
  96. }
  97. #ifdef SystemLogMessage
  98. system(Buf);
  99. #endif
  100. #ifdef ConsloePrintLog
  101. printf("[%04d.%02d.%02d %02d:%02d:%02d.%06ld]%s", tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,tv.tv_usec, buffer);
  102. #endif
  103. return rc;
  104. }
  105. int DiffTimeb(struct timeb ST, struct timeb ET)
  106. {
  107. //return milli-second
  108. unsigned int StartTime,StopTime;
  109. StartTime=(unsigned int)ST.time;
  110. StopTime=(unsigned int)ET.time;
  111. return (StopTime-StartTime)*1000+ET.millitm-ST.millitm;
  112. }
  113. //==========================================
  114. // Init all share memory
  115. //==========================================
  116. int InitShareMemory()
  117. {
  118. int result = PASS;
  119. int MeterSMId;
  120. //creat ShmSysConfigAndInfo
  121. if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), 0777)) < 0)
  122. {
  123. #ifdef SystemLogMessage
  124. DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
  125. #endif
  126. result = FAIL;
  127. }
  128. else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  129. {
  130. #ifdef SystemLogMessage
  131. DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
  132. #endif
  133. result = FAIL;
  134. }
  135. else
  136. {}
  137. //creat ShmStatusCodeData
  138. if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), 0777)) < 0)
  139. {
  140. #ifdef SystemLogMessage
  141. DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
  142. #endif
  143. result = FAIL;
  144. }
  145. else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  146. {
  147. #ifdef SystemLogMessage
  148. DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
  149. #endif
  150. result = FAIL;
  151. }
  152. else
  153. {}
  154. //creat ShmStatusCodeData
  155. if ((MeterSMId = shmget(ShmChargerKey, sizeof(struct Charger), 0777)) < 0)
  156. {
  157. DEBUG_ERROR("shmget ShmCharger NG\n");
  158. result = FAIL;
  159. }
  160. else if ((ShmCharger = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  161. {
  162. DEBUG_ERROR("shmat ShmCharger NG\n");
  163. result = FAIL;
  164. }
  165. else
  166. {}
  167. //creat ShmOCPP16Data
  168. if ((MeterSMId = shmget(ShmOcppModuleKey, sizeof(struct OCPP16Data), 0777)) < 0)
  169. {
  170. DEBUG_ERROR("shmget ShmOCPP16Data NG\n");
  171. result = FAIL;
  172. }
  173. else if ((ShmOCPP16Data = shmat(MeterSMId, NULL, 0)) == (void *) -1)
  174. {
  175. DEBUG_ERROR("shmat ShmOCPP16Data NG\n");
  176. result = FAIL;
  177. }
  178. else
  179. {}
  180. return result;
  181. }
  182. //==========================================
  183. // Common routine
  184. //==========================================
  185. void trim(char *s)
  186. {
  187. int i=0, j, k, l=0;
  188. while((s[i]==' ')||(s[i]=='\t')||(s[i]=='\n'))
  189. i++;
  190. j = strlen(s)-1;
  191. while((s[j]==' ')||(s[j]=='\t')||(s[j]=='\n'))
  192. j--;
  193. if(i==0 && j==strlen(s)-1) { }
  194. else if(i==0) s[j+1] = '\0';
  195. else {
  196. for(k=i; k<=j; k++) s[l++] = s[k];
  197. s[l] = '\0';
  198. }
  199. }
  200. void substr(char *dest, const char* src, unsigned int start, unsigned int cnt)
  201. {
  202. strncpy(dest, src + start, cnt);
  203. dest[cnt] = 0;
  204. }
  205. //==========================================
  206. // Main process
  207. //==========================================
  208. int main(void)
  209. {
  210. if(InitShareMemory() == FAIL)
  211. {
  212. DEBUG_ERROR("InitShareMemory NG\n");
  213. if(ShmStatusCodeData!=NULL)
  214. {
  215. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory=1;
  216. }
  217. sleep(5);
  218. return FAIL;
  219. }
  220. for(;;)
  221. {
  222. for(int gun_index = 0;gun_index<AC_QUANTITY;gun_index++)
  223. {
  224. //=====================================
  225. // Over voltage detection
  226. //=====================================
  227. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_OVER_VOLTAGE)
  228. {
  229. if(Alarm_Counter[gun_index].OV[0] > FILTER_SPEC)
  230. {
  231. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == OFF)
  232. {
  233. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = ON;
  234. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L1_OVER_VOLTAGE;
  235. DEBUG_INFO("ALARM_L1_OVER_VOLTAGE : alarm \n");
  236. }
  237. }
  238. else
  239. {
  240. Alarm_Counter[gun_index].OV[0]++;
  241. }
  242. }
  243. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_OVER_VOLTAGE)))
  244. {
  245. Alarm_Counter[gun_index].OV[0] = 0;
  246. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == ON)
  247. {
  248. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP = OFF;
  249. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L1_OVER_VOLTAGE;
  250. DEBUG_INFO("ALARM_L1_OVER_VOLTAGE : recover \n");
  251. }
  252. }
  253. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  254. {
  255. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_OVER_VOLTAGE)
  256. {
  257. if(Alarm_Counter[gun_index].OV[1] > FILTER_SPEC)
  258. {
  259. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == OFF)
  260. {
  261. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = ON;
  262. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L2_OVER_VOLTAGE;
  263. DEBUG_INFO("ALARM_L2_OVER_VOLTAGE : alarm \n");
  264. }
  265. }
  266. else
  267. {
  268. Alarm_Counter[gun_index].OV[1]++;
  269. }
  270. }
  271. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_OVER_VOLTAGE)))
  272. {
  273. Alarm_Counter[gun_index].OV[1] = 0;
  274. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == ON)
  275. {
  276. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP = OFF;
  277. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L2_OVER_VOLTAGE;
  278. DEBUG_INFO("ALARM_L2_OVER_VOLTAGE : recover \n");
  279. }
  280. }
  281. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_OVER_VOLTAGE)
  282. {
  283. if(Alarm_Counter[gun_index].OV[2] > FILTER_SPEC)
  284. {
  285. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == OFF)
  286. {
  287. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = ON;
  288. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L3_OVER_VOLTAGE;
  289. DEBUG_INFO("ALARM_L3_OVER_VOLTAGE : alarm \n");
  290. }
  291. }
  292. else
  293. {
  294. Alarm_Counter[gun_index].OV[2]++;
  295. }
  296. }
  297. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_OVER_VOLTAGE)))
  298. {
  299. Alarm_Counter[gun_index].OV[2] = 0;
  300. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == ON)
  301. {
  302. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP = OFF;
  303. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L3_OVER_VOLTAGE;
  304. DEBUG_INFO("ALARM_L3_OVER_VOLTAGE : recover \n");
  305. }
  306. }
  307. }
  308. //=====================================
  309. // Under voltage detection
  310. //=====================================
  311. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_UNDER_VOLTAGE)
  312. {
  313. if(Alarm_Counter[gun_index].UV[0] > FILTER_SPEC)
  314. {
  315. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == OFF)
  316. {
  317. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = ON;
  318. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L1_UNDER_VOLTAGE;
  319. DEBUG_INFO("ALARM_L1_UNDER_VOLTAGE : alarm \n");
  320. }
  321. }
  322. else
  323. {
  324. Alarm_Counter[gun_index].UV[0]++;
  325. }
  326. }
  327. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_UNDER_VOLTAGE)))
  328. {
  329. Alarm_Counter[gun_index].UV[0] = 0;
  330. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == ON)
  331. {
  332. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP = OFF;
  333. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L1_UNDER_VOLTAGE;
  334. DEBUG_INFO("ALARM_L1_UNDER_VOLTAGE : recover \n");
  335. }
  336. }
  337. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  338. {
  339. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_UNDER_VOLTAGE)
  340. {
  341. if(Alarm_Counter[gun_index].UV[1] > FILTER_SPEC)
  342. {
  343. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == OFF)
  344. {
  345. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = ON;
  346. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L2_UNDER_VOLTAGE;
  347. DEBUG_INFO("ALARM_L2_UNDER_VOLTAGE : alarm \n");
  348. }
  349. }
  350. else
  351. {
  352. Alarm_Counter[gun_index].UV[1]++;
  353. }
  354. }
  355. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_UNDER_VOLTAGE)))
  356. {
  357. Alarm_Counter[gun_index].UV[1] = 0;
  358. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == ON)
  359. {
  360. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP = OFF;
  361. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L2_UNDER_VOLTAGE;
  362. DEBUG_INFO("ALARM_L2_UNDER_VOLTAGE : recover \n");
  363. }
  364. }
  365. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_UNDER_VOLTAGE)
  366. {
  367. if(Alarm_Counter[gun_index].UV[2] > FILTER_SPEC)
  368. {
  369. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == OFF)
  370. {
  371. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = ON;
  372. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L3_UNDER_VOLTAGE;
  373. DEBUG_INFO("ALARM_L3_UNDER_VOLTAGE : alarm \n");
  374. }
  375. }
  376. else
  377. {
  378. Alarm_Counter[gun_index].UV[2]++;
  379. }
  380. }
  381. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_UNDER_VOLTAGE)))
  382. {
  383. Alarm_Counter[gun_index].UV[2] = 0;
  384. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == ON)
  385. {
  386. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP = OFF;
  387. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L3_UNDER_VOLTAGE;
  388. DEBUG_INFO("ALARM_L3_UNDER_VOLTAGE : recover \n");
  389. }
  390. }
  391. }
  392. //=====================================
  393. // Over current detection
  394. //=====================================
  395. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_OVER_CURRENT)
  396. {
  397. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == OFF)
  398. {
  399. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = ON;
  400. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L1_OVER_CURRENT;
  401. DEBUG_INFO("ALARM_L1_OVER_CURRENT : alarm \n");
  402. }
  403. }
  404. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_OVER_CURRENT)))
  405. {
  406. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == ON)
  407. {
  408. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP = OFF;
  409. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L1_OVER_CURRENT;
  410. DEBUG_INFO("ALARM_L1_OVER_CURRENT : recover \n");
  411. }
  412. }
  413. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  414. {
  415. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_OVER_CURRENT)
  416. {
  417. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 == OFF)
  418. {
  419. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 = ON;
  420. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L2_OVER_CURRENT;
  421. DEBUG_INFO("ALARM_L2_OVER_CURRENT : alarm \n");
  422. }
  423. }
  424. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_OVER_CURRENT)))
  425. {
  426. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 == ON)
  427. {
  428. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 = OFF;
  429. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L2_OVER_CURRENT;
  430. DEBUG_INFO("ALARM_L2_OVER_CURRENT : recover \n");
  431. }
  432. }
  433. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_OVER_CURRENT)
  434. {
  435. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 == OFF)
  436. {
  437. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 = ON;
  438. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L3_OVER_CURRENT;
  439. DEBUG_INFO("ALARM_L3_OVER_CURRENT : alarm \n");
  440. }
  441. }
  442. else if ((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_OVER_CURRENT)))
  443. {
  444. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 == ON)
  445. {
  446. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 = OFF;
  447. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L3_OVER_CURRENT;
  448. DEBUG_INFO("ALARM_L3_OVER_CURRENT : recover \n");
  449. }
  450. }
  451. }
  452. //=====================================
  453. // Over temperature detection
  454. //=====================================
  455. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_TEMPERATURE)
  456. {
  457. if(Alarm_Counter[gun_index].OT_AMB > FILTER_SPEC)
  458. {
  459. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP == OFF)
  460. {
  461. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = ON;
  462. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_OVER_TEMPERATURE;
  463. DEBUG_INFO("ALARM_OVER_TEMPERATURE : alarm \n");
  464. }
  465. }
  466. else
  467. {
  468. Alarm_Counter[gun_index].OT_AMB++;
  469. }
  470. }
  471. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_OVER_TEMPERATURE)))
  472. {
  473. Alarm_Counter[gun_index].OT_AMB = 0;
  474. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP == ON)
  475. {
  476. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAmbientOTP = OFF;
  477. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_OVER_TEMPERATURE;
  478. DEBUG_INFO("ALARM_OVER_TEMPERATURE : recover \n");
  479. }
  480. }
  481. //=====================================
  482. // Ground fault detection
  483. //=====================================
  484. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_GROUND_FAIL)
  485. {
  486. if(Alarm_Counter[gun_index].GMI > FILTER_SPEC)
  487. {
  488. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail == OFF)
  489. {
  490. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = ON;
  491. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_GROUND_FAIL;
  492. DEBUG_INFO("ALARM_GROUND_FAIL : alarm \n");
  493. }
  494. }
  495. else
  496. {
  497. Alarm_Counter[gun_index].GMI++;
  498. }
  499. }
  500. else if (!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_GROUND_FAIL))
  501. {
  502. Alarm_Counter[gun_index].GMI = 0;
  503. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail == ON)
  504. {
  505. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.AcGroundfaultFail = OFF;
  506. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_GROUND_FAIL;
  507. DEBUG_INFO("ALARM_GROUND_FAIL : recover \n");
  508. }
  509. }
  510. //=====================================
  511. // CP level fail detection
  512. //=====================================
  513. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CP_ERROR)
  514. {
  515. if(Alarm_Counter[gun_index].CP_LevelFail > FILTER_SPEC)
  516. {
  517. if(ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault == OFF)
  518. {
  519. ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = ON;
  520. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_CP_ERROR;
  521. DEBUG_INFO("ALARM_CP_ERROR : alarm \n");
  522. }
  523. }
  524. else
  525. {
  526. Alarm_Counter[gun_index].CP_LevelFail++;
  527. }
  528. }
  529. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CP_ERROR))
  530. {
  531. Alarm_Counter[gun_index].CP_LevelFail= 0;
  532. if(ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault == ON)
  533. {
  534. ShmStatusCodeData->InfoCode.InfoEvents.bits.PilotFault = OFF;
  535. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_CP_ERROR;
  536. DEBUG_INFO("ALARM_CP_ERROR : recover \n");
  537. }
  538. }
  539. //=====================================
  540. // Current AC/DC leak detection
  541. //=====================================
  542. if((ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_AC) ||
  543. (ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_DC))
  544. {
  545. if(Alarm_Counter[gun_index].Leakage > FILTER_SPEC)
  546. {
  547. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip == OFF)
  548. {
  549. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = ON;
  550. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_AC)
  551. {
  552. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_CURRENT_LEAK_AC;
  553. ShmCharger->gun_info[gun_index].otherAlarmCode.isACLeakage = ON;
  554. DEBUG_INFO("ALARM_CURRENT_LEAK_AC : alarm \n");
  555. }
  556. else if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_DC)
  557. {
  558. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_CURRENT_LEAK_DC;
  559. ShmCharger->gun_info[gun_index].otherAlarmCode.isDcLeakage = ON;
  560. DEBUG_INFO("ALARM_CURRENT_LEAK_DC : alarm \n");
  561. }
  562. }
  563. }
  564. else
  565. {
  566. Alarm_Counter[gun_index].Leakage++;
  567. }
  568. }
  569. else if((!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_AC)) ||
  570. (!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_CURRENT_LEAK_DC)))
  571. {
  572. Alarm_Counter[gun_index].Leakage = 0;
  573. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip == ON)
  574. {
  575. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.RcdTrip = OFF;
  576. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isACLeakage == ON)
  577. {
  578. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_CURRENT_LEAK_AC;
  579. ShmCharger->gun_info[gun_index].otherAlarmCode.isACLeakage = OFF;
  580. DEBUG_INFO("ALARM_CURRENT_LEAK_AC : recover \n");
  581. }
  582. else if(ShmCharger->gun_info[gun_index].otherAlarmCode.isDcLeakage == ON)
  583. {
  584. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_CURRENT_LEAK_DC;
  585. ShmCharger->gun_info[gun_index].otherAlarmCode.isDcLeakage = OFF;
  586. DEBUG_INFO("ALARM_CURRENT_LEAK_DC : recover \n");
  587. }
  588. }
  589. }
  590. //=====================================
  591. // MCU self test fail detection
  592. //=====================================
  593. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_MCU_TESTFAIL)
  594. {
  595. if(Alarm_Counter[gun_index].MCU_SelfTestFail > FILTER_SPEC)
  596. {
  597. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail == OFF)
  598. {
  599. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = ON;
  600. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_MCU_TESTFAIL;
  601. DEBUG_INFO("ALARM_MCU_TESTFAIL : alarm \n");
  602. }
  603. }
  604. else
  605. {
  606. Alarm_Counter[gun_index].MCU_SelfTestFail++;
  607. }
  608. }
  609. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_MCU_TESTFAIL))
  610. {
  611. Alarm_Counter[gun_index].MCU_SelfTestFail = 0;
  612. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail == ON)
  613. {
  614. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.McuSelftestFail = OFF;
  615. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_MCU_TESTFAIL;
  616. DEBUG_INFO("ALARM_MCU_TESTFAIL : recover \n");
  617. }
  618. }
  619. //=====================================
  620. // Hand shaking timeout detection
  621. //=====================================
  622. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_HANDSHAKE_TIMEOUT)
  623. {
  624. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut == OFF)
  625. {
  626. ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut = ON;
  627. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_HANDSHAKE_TIMEOUT;
  628. DEBUG_INFO("ALARM_HANDSHAKE_TIMEOUT : alarm \n");
  629. }
  630. }
  631. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_HANDSHAKE_TIMEOUT))
  632. {
  633. if(ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut == ON)
  634. {
  635. ShmCharger->gun_info[gun_index].otherAlarmCode.isHandshakingTimeOut = OFF;
  636. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_HANDSHAKE_TIMEOUT;
  637. DEBUG_INFO("ALARM_HANDSHAKE_TIMEOUT : recover \n");
  638. }
  639. }
  640. //=====================================
  641. // Emergency stop detection
  642. //=====================================
  643. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_EMERGENCY_STOP)
  644. {
  645. if(Alarm_Counter[gun_index].EmrgencyBTN > FILTER_SPEC)
  646. {
  647. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == OFF)
  648. {
  649. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = ON;
  650. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_EMERGENCY_STOP;
  651. DEBUG_INFO("ALARM_EMERGENCY_STOP : alarm \n");
  652. }
  653. }
  654. else
  655. {
  656. Alarm_Counter[gun_index].EmrgencyBTN++;
  657. }
  658. }
  659. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_EMERGENCY_STOP))
  660. {
  661. Alarm_Counter[gun_index].EmrgencyBTN = 0;
  662. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip == ON)
  663. {
  664. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.EmergencyStopTrip = OFF;
  665. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_EMERGENCY_STOP;
  666. DEBUG_INFO("ALARM_EMERGENCY_STOP : recover \n");
  667. }
  668. }
  669. //=====================================
  670. // Relay welding detection
  671. //=====================================
  672. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_WELDING)
  673. {
  674. if(Alarm_Counter[gun_index].Relay_Welding > FILTER_SPEC)
  675. {
  676. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding == OFF)
  677. {
  678. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = ON;
  679. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_RELAY_WELDING;
  680. DEBUG_INFO("ALARM_RELAY_STATUS : alarm \n");
  681. }
  682. }
  683. else
  684. {
  685. Alarm_Counter[gun_index].Relay_Welding++;
  686. }
  687. }
  688. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_WELDING))
  689. {
  690. Alarm_Counter[gun_index].Relay_Welding = 0;
  691. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding == ON)
  692. {
  693. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayWelding = OFF;
  694. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_RELAY_WELDING;
  695. DEBUG_INFO("ALARM_RELAY_STATUS : recover \n");
  696. }
  697. }
  698. //=====================================
  699. // Relay driving fault detection
  700. //=====================================
  701. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_DRIVE_FAULT)
  702. {
  703. if(Alarm_Counter[gun_index].Relay_DrivingFault > FILTER_SPEC)
  704. {
  705. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault == OFF)
  706. {
  707. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = ON;
  708. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_RELAY_DRIVE_FAULT;
  709. DEBUG_INFO("ALARM_RELAY_DRIVE_FAULT : alarm \n");
  710. }
  711. }
  712. else
  713. {
  714. Alarm_Counter[gun_index].Relay_DrivingFault++;
  715. }
  716. }
  717. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_RELAY_DRIVE_FAULT))
  718. {
  719. Alarm_Counter[gun_index].Relay_DrivingFault = 0;
  720. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault == ON)
  721. {
  722. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcOutputRelayDrivingFault = OFF;
  723. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_RELAY_DRIVE_FAULT;
  724. DEBUG_INFO("ALARM_RELAY_DRIVE_FAULT : recover \n");
  725. }
  726. }
  727. //=====================================
  728. // Current short detection
  729. //=====================================
  730. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_CIRCUIT_SHORT)
  731. {
  732. if(Alarm_Counter[gun_index].Short[0] > FILTER_SPEC)
  733. {
  734. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort == OFF)
  735. {
  736. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = ON;
  737. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L1_CIRCUIT_SHORT;
  738. DEBUG_INFO("ALARM_L1_CIRCUIT_SHORT : alarm \n");
  739. }
  740. }
  741. else
  742. {
  743. Alarm_Counter[gun_index].Short[0]++;
  744. }
  745. }
  746. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L1_CIRCUIT_SHORT))
  747. {
  748. Alarm_Counter[gun_index].Short[0] = 0;
  749. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort == ON)
  750. {
  751. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort = OFF;
  752. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L1_CIRCUIT_SHORT;
  753. DEBUG_INFO("ALARM_L1_CIRCUIT_SHORT : recover \n");
  754. }
  755. }
  756. if(ShmSysConfigAndInfo->SysConfig.AcPhaseCount == 3)
  757. {
  758. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_CIRCUIT_SHORT)
  759. {
  760. if(Alarm_Counter[gun_index].Short[1] > FILTER_SPEC)
  761. {
  762. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 == OFF)
  763. {
  764. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 = ON;
  765. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L2_CIRCUIT_SHORT;
  766. DEBUG_INFO("ALARM_L2_CIRCUIT_SHORT : alarm \n");
  767. }
  768. }
  769. else
  770. {
  771. Alarm_Counter[gun_index].Short[1]++;
  772. }
  773. }
  774. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L2_CIRCUIT_SHORT))
  775. {
  776. Alarm_Counter[gun_index].Short[1] = 0;
  777. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 == ON)
  778. {
  779. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 = OFF;
  780. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L2_CIRCUIT_SHORT;
  781. DEBUG_INFO("ALARM_L2_CIRCUIT_SHORT : recover \n");
  782. }
  783. }
  784. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_CIRCUIT_SHORT)
  785. {
  786. if(Alarm_Counter[gun_index].Short[2] > FILTER_SPEC)
  787. {
  788. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 == OFF)
  789. {
  790. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 = ON;
  791. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_L3_CIRCUIT_SHORT;
  792. DEBUG_INFO("ALARM_L3_CIRCUIT_SHORT : alarm \n");
  793. }
  794. }
  795. else
  796. {
  797. Alarm_Counter[gun_index].Short[2]++;
  798. }
  799. }
  800. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_L3_CIRCUIT_SHORT))
  801. {
  802. Alarm_Counter[gun_index].Short[2] = 0;
  803. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 == ON)
  804. {
  805. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 = OFF;
  806. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_L3_CIRCUIT_SHORT;
  807. DEBUG_INFO("ALARM_L3_CIRCUIT_SHORT : recover \n");
  808. }
  809. }
  810. }
  811. //=====================================
  812. // Rotatory switch detection
  813. //=====================================
  814. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_ROTATORY_SWITCH_FAULT)
  815. {
  816. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault == OFF)
  817. {
  818. ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault = ON;
  819. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_ROTATORY_SWITCH_FAULT;
  820. DEBUG_INFO("ALARM_ROTATORY_SWITCH_FAULT : alarm \n");
  821. }
  822. }
  823. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_ROTATORY_SWITCH_FAULT))
  824. {
  825. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault == ON)
  826. {
  827. ShmStatusCodeData->FaultCode.FaultEvents.bits.RotarySwitchFault = OFF;
  828. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_ROTATORY_SWITCH_FAULT;
  829. DEBUG_INFO("ALARM_ROTATORY_SWITCH_FAULT : recover \n");
  830. }
  831. }
  832. //=====================================
  833. // Leakage module detection
  834. //=====================================
  835. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LEAK_MODULE_FAIL)
  836. {
  837. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail == OFF)
  838. {
  839. ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = ON;
  840. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_LEAK_MODULE_FAIL;
  841. DEBUG_INFO("ALARM_LEAK_MODULE_FAIL : alarm \n");
  842. }
  843. }
  844. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LEAK_MODULE_FAIL))
  845. {
  846. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail == ON)
  847. {
  848. ShmStatusCodeData->FaultCode.FaultEvents.bits.RcdSelfTestFail = OFF;
  849. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_LEAK_MODULE_FAIL;
  850. DEBUG_INFO("ALARM_LEAK_MODULE_FAIL : recover \n");
  851. }
  852. }
  853. //=====================================
  854. // Shutter detection
  855. //=====================================
  856. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_SHUTTER_FAULT)
  857. {
  858. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault == OFF)
  859. {
  860. ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault = ON;
  861. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_SHUTTER_FAULT;
  862. DEBUG_INFO("ALARM_SHUTTER_FAULT : alarm \n");
  863. }
  864. }
  865. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_SHUTTER_FAULT))
  866. {
  867. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault == ON)
  868. {
  869. ShmStatusCodeData->FaultCode.FaultEvents.bits.ShutterFault = OFF;
  870. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_SHUTTER_FAULT;
  871. DEBUG_INFO("ALARM_SHUTTER_FAULT : recover \n");
  872. }
  873. }
  874. //=====================================
  875. // Locker detection
  876. //=====================================
  877. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LOCKER_FAULT)
  878. {
  879. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail == OFF)
  880. {
  881. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = ON;
  882. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_LOCKER_FAULT;
  883. DEBUG_INFO("ALARM_LOCKER_FAULT : alarm \n");
  884. }
  885. }
  886. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_LOCKER_FAULT))
  887. {
  888. if(ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail == ON)
  889. {
  890. ShmStatusCodeData->FaultCode.FaultEvents.bits.AcConnectorLockFail = OFF;
  891. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_LOCKER_FAULT;
  892. DEBUG_INFO("ALARM_LOCKER_FAULT : recover \n");
  893. }
  894. }
  895. //=====================================
  896. // Power drop detection
  897. //=====================================
  898. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_POWER_DROP)
  899. {
  900. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop == OFF)
  901. {
  902. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = ON;
  903. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_POWER_DROP;
  904. DEBUG_INFO("ALARM_POWER_DROP : alarm \n");
  905. }
  906. }
  907. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_POWER_DROP))
  908. {
  909. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop == ON)
  910. {
  911. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop = OFF;
  912. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_POWER_DROP;
  913. DEBUG_INFO("ALARM_POWER_DROP : recover \n");
  914. }
  915. }
  916. //=====================================
  917. // Meter communication timeout detection
  918. //=====================================
  919. if(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_METER_TIMEOUT)
  920. {
  921. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout == OFF)
  922. {
  923. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout = ON;
  924. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode |= ALARM_METER_TIMEOUT;
  925. DEBUG_INFO("ALARM_METER_TIMEOUT : alarm \n");
  926. }
  927. }
  928. else if(!(ShmCharger->gun_info[gun_index].primaryMcuAlarm.InputAlarmCode & ALARM_METER_TIMEOUT))
  929. {
  930. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout == ON)
  931. {
  932. ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout = OFF;
  933. ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode &= ~ALARM_METER_TIMEOUT;
  934. DEBUG_INFO("ALARM_METER_TIMEOUT : recover \n");
  935. }
  936. }
  937. //=====================================
  938. // OCPP error code message
  939. //=====================================
  940. if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_OVER_VOLTAGE) ||
  941. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_OVER_VOLTAGE) ||
  942. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_OVER_VOLTAGE))
  943. {
  944. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  945. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputOVP == ON)
  946. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012200");
  947. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputOVP == ON)
  948. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012201");
  949. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputUVP == ON)
  950. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012202");
  951. }
  952. else if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_UNDER_VOLTAGE) ||
  953. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_UNDER_VOLTAGE) ||
  954. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_UNDER_VOLTAGE))
  955. {
  956. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  957. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputUVP == ON)
  958. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012203");
  959. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputUVP == ON)
  960. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012204");
  961. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputOVP == ON)
  962. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012205");
  963. }
  964. else if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_OVER_CURRENT) ||
  965. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_OVER_CURRENT) ||
  966. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_OVER_CURRENT))
  967. {
  968. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  969. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCP == ON)
  970. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012216");
  971. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL2 == ON)
  972. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012299");
  973. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemAcOutputOCPL3 == ON)
  974. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012300");
  975. }
  976. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_OVER_TEMPERATURE)
  977. {
  978. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  979. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012223");
  980. }
  981. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_GROUND_FAIL)
  982. {
  983. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  984. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012256");
  985. }
  986. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CP_ERROR)
  987. {
  988. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  989. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "023703");
  990. }
  991. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CURRENT_LEAK_AC)
  992. {
  993. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  994. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012233");
  995. }
  996. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_CURRENT_LEAK_DC)
  997. {
  998. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  999. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012233");
  1000. }
  1001. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_MCU_TESTFAIL)
  1002. {
  1003. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1004. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012257");
  1005. }
  1006. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_HANDSHAKE_TIMEOUT)
  1007. {
  1008. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1009. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "HandshakeTimeout");
  1010. }
  1011. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_EMERGENCY_STOP)
  1012. {
  1013. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1014. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012251");
  1015. }
  1016. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_RELAY_WELDING)
  1017. {
  1018. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1019. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "011009");
  1020. }
  1021. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_LEAK_MODULE_FAIL)
  1022. {
  1023. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1024. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "011004");
  1025. }
  1026. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_SHUTTER_FAULT)
  1027. {
  1028. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1029. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "011034");
  1030. }
  1031. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_LOCKER_FAULT)
  1032. {
  1033. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1034. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "011027");
  1035. }
  1036. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_POWER_DROP)
  1037. {
  1038. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1039. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL1InputDrop == ON)
  1040. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012212");
  1041. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL2InputDrop == ON)
  1042. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012213");
  1043. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.SystemL3InputDrop == ON)
  1044. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012214");
  1045. }
  1046. else if((ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L1_CIRCUIT_SHORT) ||
  1047. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L2_CIRCUIT_SHORT) ||
  1048. (ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_L3_CIRCUIT_SHORT))
  1049. {
  1050. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1051. if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShort == ON)
  1052. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012262");
  1053. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL2 == ON)
  1054. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012301");
  1055. else if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.CircuitShortL3 == ON)
  1056. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012302");
  1057. }
  1058. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_ROTATORY_SWITCH_FAULT)
  1059. {
  1060. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1061. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "011036");
  1062. }
  1063. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_RELAY_DRIVE_FAULT)
  1064. {
  1065. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1066. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "011010");
  1067. }
  1068. else if(ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode & ALARM_METER_TIMEOUT)
  1069. {
  1070. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "OtherError");
  1071. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode , "012305");
  1072. }
  1073. else
  1074. {
  1075. sprintf((char*)ShmOCPP16Data->StatusNotification[gun_index].ErrorCode , "NoError");
  1076. memset(ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode, 0x00, ARRAY_SIZE(ShmOCPP16Data->StatusNotification[gun_index].VendorErrorCode));
  1077. }
  1078. //=====================================
  1079. // Latch alarm recover in state A
  1080. //=====================================
  1081. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 1))
  1082. {
  1083. /*
  1084. TODO: Recover latch alarm here
  1085. */
  1086. }
  1087. //=====================================
  1088. // Latch alarm recover in state B1 and B2
  1089. //=====================================
  1090. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 2) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 3))
  1091. {
  1092. /*
  1093. TODO: Recover latch alarm here
  1094. */
  1095. }
  1096. //=====================================
  1097. // Latch alarm recover in state C
  1098. //=====================================
  1099. if((ShmSysConfigAndInfo->SysInfo.AcChargingData[gun_index].PilotState == 4))
  1100. {
  1101. /*
  1102. TODO: Recover latch alarm here
  1103. */
  1104. }
  1105. ShmCharger->gun_info[gun_index].acCcsInfo.CSUAlarmStatusCode = ShmCharger->gun_info[gun_index].systemAlarmCode.SystemAlarmCode;
  1106. }
  1107. usleep(100000);
  1108. }
  1109. return FAIL;
  1110. }