12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689 |
- /*===========================================================================
- Combined Charging System (CCS): SECC
- CsuComm.c
- initiated by Vern, Joseph
- (since 2019/07/19)
- =============================================================================*/
- #include <sys/types.h>
- #include <sys/stat.h>
- #include <fcntl.h>
- //#include <linux/termios.h>
- #include <stdio.h>
- #include <string.h>
- #include <time.h>
- #include <stdlib.h>
- #include <sys/ipc.h>
- #include <sys/shm.h>
- #include <sys/mman.h>
- #include <linux/sockios.h>
- #include <linux/socket.h>
- #include <linux/can.h>
- #include <linux/can/raw.h>
- #include <sys/socket.h>
- #include <netinet/in.h>
- #include <sys/time.h>
- #include <sys/timeb.h>
- #include <math.h>//for pow
- #include <net/if.h>
- #include <unistd.h>
- #include "define.h"
- #include "CsuComm.h"
- #include "SeccComm.h"
- #include "exi_engine/api/api.h"
- #ifdef AWCCS
- #include "../main.h"
- #endif
- struct SysConfigAndInfo *ShmSysConfigAndInfo;
- struct StatusCodeData *ShmStatusCodeData;
- struct CcsData *ShmCcsData;
- struct InternalComm *ShmInternalComm;
- //struct InternalCommAC *ShmInternalCommAC;
- #ifdef AWCCS
- struct Charger *ShmCharger;
- #endif
- pid_t PID_CAN_Rx_Task;
- pid_t PID_CsuComm_Error_Monitor_Task;
- int FD_CAN_Socket;
- unsigned char buf_log_csucomm[SIZE_OF_LOG_BUFFER];
- unsigned char buf_log_csucomm_fork1[SIZE_OF_LOG_BUFFER];
- unsigned char buf_log_csucomm_fork2[SIZE_OF_LOG_BUFFER];
- /*===========================================================================
- FUNCTION: GetSysTime()
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void PrintTimeStamp()
- {
- //static time_t CurrentTime;
- //static struct tm *tm;
- static struct timeval tv;
- //CurrentTime = time(NULL);
- //tm = localtime(&CurrentTime);
- gettimeofday(&tv, NULL); // get microseconds, 10^-6
- //printf("[%02d:%02d:%02d.%06d]",
- // tm->tm_hour, tm->tm_min, tm->tm_sec, tv.tv_usec);
- DEBUG_PRINTF_CSUCOMM_DETAIL("[%05d.%06d]", tv.tv_sec, tv.tv_usec);
- }
- /*===========================================================================
- FUNCTION: Check_V2G_Flow_Status
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- unsigned char Check_V2G_Flow_Status()
- {
- unsigned char result = 0;
- switch (ShmCcsData->CommProtocol)
- {
- case V2GT_MSG_PROTOCOL_DIN70121: //0
- {
- result = ShmCcsData->V2GMessage_DIN70121.PresentMsgFlowStatus;
- break;
- }
- case V2GT_MSG_PROTOCOL_ISO15118_2014: //1
- {
- result = ShmCcsData->V2GMessage_ISO15118_2014.PresentMsgFlowStatus;
- break;
- }
- case V2GT_MSG_PROTOCOL_ISO15118_2018: //2
- {
- result = ShmCcsData->V2GMessage_ISO15118_2018.PresentMsgFlowStatus;
- break;
- }
- default:
- break;
- }
- return result;
- }
- /*===========================================================================
- FUNCTION: StoreLogMsg
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- #if SAVE_SYS_LOG_MSG_CSUCOMM_SWITCH == ENABLE
- int StoreLogMsg2(unsigned char *DataString)
- {
- static unsigned char Buf[256*2];
- static time_t CurrentTime;
- static struct tm *tm;
- static struct timeval tv;
- memset(Buf, 0, sizeof(Buf));
- CurrentTime = time(NULL);
- tm = localtime(&CurrentTime);
- gettimeofday(&tv, NULL); // get microseconds, 10^-6
- #ifdef AWCCS
- sprintf(Buf, "echo \"[%04d%02d%02d: %02d:%02d:%02d.%06d][CsuComm][%d][%02d]%s\" >> /Storage/SystemLog/[%04d.%02d]CCS-SystemLog",
- tm->tm_year + 1900,
- tm->tm_mon + 1,
- tm->tm_mday,
- tm->tm_hour,
- tm->tm_min,
- tm->tm_sec,
- tv.tv_usec,
- EVCOMM_SYS_INFO.CpState,
- Check_V2G_Flow_Status(),
- DataString,
- tm->tm_year + 1900,
- tm->tm_mon + 1);
- #else
- sprintf(Buf, "echo \"[%04d%02d%02d: %02d:%02d:%02d.%06d][CsuComm][%d][%02d]%s\" >> /Storage/SystemLog/[%04d.%02d]SystemLog",
- tm->tm_year + 1900,
- tm->tm_mon + 1,
- tm->tm_mday,
- tm->tm_hour,
- tm->tm_min,
- tm->tm_sec,
- tv.tv_usec,
- EVCOMM_SYS_INFO.CpState,
- Check_V2G_Flow_Status(),
- DataString,
- tm->tm_year + 1900,
- tm->tm_mon + 1);
- #endif
- system(Buf);
- DEBUG_PRINTF_CSUCOMM_SYSTEM_LOG("[%02d:%02d:%02d.%06d][CsuComm][%d][%02d]%s \n",
- tm->tm_hour,
- tm->tm_min,
- tm->tm_sec,
- tv.tv_usec,
- EVCOMM_SYS_INFO.CpState,
- Check_V2G_Flow_Status(),
- DataString);
- //Reset the buf_log_csucomm Buffer, i.e. DataString
- memset(buf_log_csucomm, 0, SIZE_OF_LOG_BUFFER);
- }
- #endif
- /*===========================================================================
- FUNCTION: Array_Check_All_Zero
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- result:
- (1) TRUE: all zero
- (2) FALSE: not all zero
- GLOBAL VARIABLES:
- =============================================================================*/
- int Array_Check_All_Zero(unsigned char *ptr, int size)
- {
- int result = TRUE;
- int i = 0;
- for (i = 0; i < size; i++)
- {
- if (ptr[i] != 0)
- {
- result = FALSE;
- break;
- }
- }
- return result;
- }
- /*===========================================================================
- FUNCTION: Array_Compare_Identity
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- result = FALSE (not identical)
- result = TRUE (identical)
- GLOBAL VARIABLES:
- =============================================================================*/
- int Array_Compare_Identity(unsigned char *ptrA, unsigned char *ptrB, int size)
- {
- int result = TRUE;
- int i = 0;
- for (i = 0; i < size; i++)
- {
- if (ptrA[i] != ptrB[i])
- {
- result = FALSE;
- #if 0
- sprintf(buf_log_evcomm,
- "[Array_Compare_Identity]%02X%02X%02X%02X%02X%02X,%02X%02X%02X%02X%02X%02X(%d)\n",
- ptrA[0], ptrA[1], ptrA[2], ptrA[3], ptrA[4], ptrA[5],
- ptrB[0], ptrB[1], ptrB[2], ptrB[3], ptrB[4], ptrB[5],
- result);
- SAVE_SYS_LOG_MSG_EVCOMM(buf_log_evcomm);
- #endif
- break;
- }
- }
- return result;
- }
- /*===========================================================================
- FUNCTION: CAN_Tx_MSG
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int CAN_Tx_MSG(int Fd, unsigned int MsgId, unsigned char SlaveAddress, unsigned char DataLength, unsigned char *SendData)
- {
- struct can_frame frame;
- unsigned int tmp = 0;
- int nbytes = 0;
- int i = 0;
- //Protection: To avoid unexpected length for CAN bus payload.
- if (DataLength > 8)
- {
- DataLength = 8;
- }
- memset(&frame, 0, sizeof(struct can_frame));
- frame.can_id = 0x80000000 | CAN_SEND_DIRECTION | MsgId | SlaveAddress; //0x80000000: extension ID format
- frame.can_dlc = DataLength;
- memcpy(frame.data, SendData, DataLength);
- nbytes = write(Fd, &frame, sizeof(struct can_frame));
- #if 0
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][CAN_Tx_MSG] <%X> ", frame.can_id);
- for (i = 0; i < frame.can_dlc; i++)
- {
- DEBUG_PRINTF_CSUCOMM_DETAIL("%02X ", frame.data[i]);
- }
- DEBUG_PRINTF_CSUCOMM_DETAIL("(%d Bytes)\n", frame.can_dlc);
- #endif
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Sniffer_Candump
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- 0: accept
- -1: invalid
- GLOBAL VARIABLES:
- =============================================================================*/
- int Sniffer_Candump(char cmd)
- {
- #if (CANDUMP_PACKETS_SNIFFER_SWITCH == ENABLE)
- if (cmd == ENABLE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[candump]init");
- system("cd /mnt/;rm -rf candump/");
- system("cd /mnt/;mkdir candump");
- SAVE_SYS_LOG_MSG_CSUCOMM("[candump]on");
- system("cd /mnt/candump;candump -l can0 &");
- return 0;
- }
- else if (cmd == DISABLE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[candump]off");
- system("killall candump");
- SAVE_SYS_LOG_MSG_CSUCOMM("[candump]save");
- system("cd /;cp -rfv /mnt/candump /Storage/SystemLog/");
- return 0;
- }
- else
- {
- sprintf(buf_log_csucomm, "[candump]unexpected cmd(%d)", cmd);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- return -1;
- }
- #endif
- }
- /*===========================================================================
- FUNCTION: Checksum_Generator
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- unsigned char Checksum_Generator(unsigned int StartAdress, unsigned int length, unsigned char Data[])
- {
- unsigned char checksum = 0x00;
- for(unsigned int i = 0; i < length; i++)
- {
- //DEBUG_INFO("value = %x \n", Data[StartAdress + i]);
- checksum ^= Data[StartAdress + i];
- //DEBUG_INFO("checksum = %x \n", checksum);
- }
- return checksum;
- }
- /*===========================================================================
- FUNCTION: CRC32_Generator
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- unsigned int CRC32_Generator(unsigned char *data, unsigned int length)
- {
- unsigned char i;
- unsigned int cnt = 0;
- unsigned int crc = 0xffffffff; // Initial value
- while(length--)
- {
- if(cnt > 33 && cnt < 48)
- {
- data++;
- }
- else
- {
- crc ^= *data++; // crc ^= *data; data++;
- for (i = 0; i < 8; ++i)
- {
- if (crc & 1)
- {
- crc = (crc >> 1) ^ 0xEDB88320;// 0xEDB88320= reverse 0x04C11DB7
- }
- else
- {
- crc = (crc >> 1);
- }
- }
- }
- cnt++;
- }
- return ~crc;
- }
- /*===========================================================================
- FUNCTION: Get_GPIO_Value
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Get_GPIO_Value(unsigned int gpio)
- {
- int fd;
- char buf[32];
- char ch;
- snprintf(buf, sizeof(buf), GPIO_SYS_DIR"/gpio%d/value", gpio);
- fd = open(buf, O_RDONLY);
- if (fd < 0)
- {
- perror("gpio/get-value");
- return fd;
- }
- read(fd, &ch, 1);
- close(fd);
- if (ch != '0')
- {
- return 1;
- }
- else
- {
- return 0;
- }
- }
- /*===========================================================================
- FUNCTION: DiffTimeb
- DESCRIPTION:
- 1. Data structure of timeb.h
- The <sys/timeb.h> header defines the timeb structure that includes at least the following members:
- - time_t time the seconds portion of the current time
- - unsigned short millitm the milliseconds portion of the current time
- - short timezone the local timezone in minutes west of Greenwich
- - short dstflag TRUE if Daylight Savings Time is in effect
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- double DiffTimeb(struct timeb ST, struct timeb ET)
- {
- //return milli-second
- double StartTime, EndTime;
- double t_diff;
- StartTime = ((double)ST.time)*1000 + (double)ST.millitm;
- EndTime = ((double)ET.time)*1000 + (double)ET.millitm;
- t_diff = EndTime - StartTime;
- //printf("%.02lf - %.02lf = %.02lf\n", EndTime, StartTime, t_diff);
- if (t_diff < 0)
- {
- #if 0
- if (t_diff < -1000) //1000ms
- {
- sprintf(buf_log_csucomm,
- "[Warning]StartTime(%.02lf) > EndTime(%.02lf), d(%.02lf)",
- StartTime,
- EndTime,
- t_diff);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- #endif
- return -1;
- }
- return t_diff;
- }
- /*===========================================================================
- FUNCTION: DiffTimeb_CsuComm_fork1
- DESCRIPTION:
- 1. fork1
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- double DiffTimeb_CsuComm_fork1(struct timeb ST, struct timeb ET)
- {
- //return milli-second
- double StartTime, EndTime;
- double t_diff;
- StartTime = ((double)ST.time)*1000 + (double)ST.millitm;
- EndTime = ((double)ET.time)*1000 + (double)ET.millitm;
- t_diff = EndTime - StartTime;
- if (t_diff < 0)
- {
- #if 0
- if (t_diff < -1000) //1000ms
- {
- sprintf(buf_log_csucomm_fork1,
- "[fork1][Warning]StartTime(%.02lf) > EndTime(%.02lf), d(%.02lf)",
- StartTime,
- EndTime,
- t_diff);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm_fork1);
- }
- #endif
- return -1;
- }
- return t_diff;
- }
- /*===========================================================================
- FUNCTION: ShareMemory_Init
- DESCRIPTION
- Initialize all share memories.
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int ShareMemory_Init()
- {
- int MeterSMId;
-
- #ifdef AWCCS
- //[1/5] create ShmSysConfigAndInfo
- if((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), IPC_CREAT | 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmSysConfigAndInfo NG");
- return 0;
- }
- else if((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmSysConfigAndInfo NG");
- return 0;
- }
- memset(ShmSysConfigAndInfo, 0, sizeof(struct SysConfigAndInfo));
-
- //[2/5] create ShmStatusCodeData
- if((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), IPC_CREAT |0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmStatusCodeData NG");
- return 0;
- }
- else if((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmStatusCodeData NG");
- return 0;
- }
- memset(ShmStatusCodeData, 0, sizeof(struct StatusCodeData));
-
- //[3/5] create ShmCcsData
- if((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData), IPC_CREAT |0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmCcsData NG");
- return 0;
- }
- else if((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmCcsData NG");
- return 0;
- }
- memset(ShmCcsData, 0, sizeof(struct CcsData));
-
- //[4/5] create ShmInternalComm
- if((MeterSMId = shmget(ShmInternalCommKey, sizeof(struct InternalComm), IPC_CREAT | 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmInternalComm NG");
- return 0;
- }
- else if((ShmInternalComm = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmInternalComm NG");
- return 0;
- }
- memset(ShmInternalComm, 0, sizeof(struct InternalComm));
- #if 0
- //[5/5] create ShmInternalCommAC
- if((MeterSMId = shmget(ShmInternalCommACKey, sizeof(struct InternalCommAC), IPC_CREAT | 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmInternalCommAC NG");
- return 0;
- }
- else if((ShmInternalCommAC = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmInternalCommAC NG");
- return 0;
- }
- //memset(ShmInternalCommAC, 0, sizeof(struct InternalCommAC));
- #endif
-
- //creat ShmCharger
- if ((MeterSMId = shmget(ShmChargerKey, sizeof(struct Charger), 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("shmget ShmCharger NG\n");
- return 0;
- }
- else if ((ShmCharger = shmat(MeterSMId, NULL, 0)) == (void *) -1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("shmat ShmCharger NG\n");
- return 0;
- }
-
- #else
- //[1/5] create ShmSysConfigAndInfo
- if((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmSysConfigAndInfo NG");
- return 0;
- }
- else if((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmSysConfigAndInfo NG");
- return 0;
- }
- //[2/5] create ShmStatusCodeData
- if((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmStatusCodeData NG");
- return 0;
- }
- else if((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmStatusCodeData NG");
- return 0;
- }
- //[3/5] create ShmCcsData
- if((MeterSMId = shmget(ShmCcsCommKey, sizeof(struct CcsData), 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmCcsData NG");
- return 0;
- }
- else if((ShmCcsData = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmCcsData NG");
- return 0;
- }
- //[4/5] create ShmInternalComm
- if((MeterSMId = shmget(ShmInternalCommKey, sizeof(struct InternalComm), 0777)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmget ShmInternalComm NG");
- return 0;
- }
- else if((ShmInternalComm = shmat(MeterSMId, NULL, 0)) == (void *)-1)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("ShareMemory_Init:shmat ShmInternalComm NG");
- return 0;
- }
- //memset(ShmInternalComm, 0, sizeof(struct InternalComm));
- #endif
- return 1;
- }
- /*===========================================================================
- FUNCTION: CANBus_Init
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int CANBus_Init()
- {
- int s0, nbytes;
- struct timeval tv;
- struct ifreq ifr0;
- struct sockaddr_can addr0;
- system("/sbin/ip link set can0 type can bitrate 500000 restart-ms 100");
- system("/sbin/ip link set can0 up");
- s0 = socket(PF_CAN, SOCK_RAW, CAN_RAW);
- if (s0 < 0) //added by Joseph (not full implemented)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[ERROR] Fail on initializing CAN Bus socket");
- }
- tv.tv_sec = 0;
- tv.tv_usec = 10000;
- if(setsockopt(s0, SOL_SOCKET, SO_RCVTIMEO, (char *)&tv, sizeof(struct timeval)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("CANBus_Init:Set SO_RCVTIMEO NG");
- }
- nbytes = 40960;
- if(setsockopt(s0, SOL_SOCKET, SO_RCVBUF, &nbytes, sizeof(int)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("CANBus_Init:Set SO_RCVBUF NG");
- }
- nbytes = 40960;
- if(setsockopt(s0, SOL_SOCKET, SO_SNDBUF, &nbytes, sizeof(int)) < 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("CANBus_Init:Set SO_SNDBUF NG");
- }
- strcpy(ifr0.ifr_name, "can0" );
- ioctl(s0, SIOCGIFINDEX, &ifr0); /* ifr.ifr_ifindex gets filled with that device's index */
- addr0.can_family = AF_CAN;
- addr0.can_ifindex = ifr0.ifr_ifindex;
- bind(s0, (struct sockaddr *)&addr0, sizeof(addr0));
- return s0;
- }
- /*===========================================================================
- FUNCTION: Update_EVSE_INFO_to_SHMs
- DESCRIPTION:
- Updating all corresponding content in each Share Memory.
- 1. I_now
- 2. V_now
- 3. P_now
- 4. I_max
- 5. V_max
- 6. P_max
- PRE-CONDITION:
- INPUT:
- 1. ShmInternalComm
- OUTPUT:
- 1. ShmCcsData
- * PreChargeResponse
- * CurrentDemandResponse
- * WeldingDetectionResponse
- 2. ShmSysConfigAndInfo
- GLOBAL VARIABLES:
- =============================================================================*/
- void Update_EVSE_INFO_to_SHMs()
- {
- int I_now = 0; //0.1A
- int V_now = 0; //0.1V
- int P_now = 0; //0.1KW
- int I_max = 0; //0.1A
- int V_max = 0; //0.1V
- int P_max = 0; //0.1KW
- //[CAUTION] Re-initializing process is necessary. (to-be implemented)
- //----------[1/7] Permission --------
- if (ShmInternalComm->ChargingPermission_new != ShmInternalComm->ChargingPermission)
- {
- sprintf(buf_log_csucomm, "Permission: %d >> %d",
- ShmInternalComm->ChargingPermission,
- ShmInternalComm->ChargingPermission_new
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->ChargingPermission_pre = ShmInternalComm->ChargingPermission;
- ShmInternalComm->ChargingPermission = ShmInternalComm->ChargingPermission_new;
- }
- // -------- [3/7] V_now --------
- V_now = ShmInternalComm->PresentChargingVoltage;
- EVCOMM_SYS_INFO.PresentChargingVoltage = V_now / 10.0; //1V
- if (ShmInternalComm->PresentChargingVoltage_pre != ShmInternalComm->PresentChargingVoltage)
- {
- if (abs(ShmInternalComm->PresentChargingVoltage_pre - ShmInternalComm->PresentChargingVoltage) > 10) //10:1V
- {
- unsigned char state = 0;
- state = Check_V2G_Flow_Status();
- if(state == CableCheckRequest || state == CableCheckResponse || //37, 38
- state == PreChargeRequest || state == PreChargeResponse || //39, 40
- state == CurrentDemandRequest || state == CurrentDemandResponse) //45, 46
- {
- if ((ShmInternalComm->PresentChargingVoltage <= 600) || //600:60V
- (ShmInternalComm->PresentChargingVoltage >= 1500) //1500:150V
- )
- {
- sprintf(buf_log_csucomm, "V_now(EVSE): %d >> %d (0.1V, DEC)",
- ShmInternalComm->PresentChargingVoltage_pre,
- ShmInternalComm->PresentChargingVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- }
- else
- {
- sprintf(buf_log_csucomm, "V_now(EVSE): %d >> %d (0.1V, DEC)",
- ShmInternalComm->PresentChargingVoltage_pre,
- ShmInternalComm->PresentChargingVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- }
- ShmInternalComm->PresentChargingVoltage_pre = ShmInternalComm->PresentChargingVoltage;
- }
- // -------- [2/7] I_now --------
- I_now = ShmInternalComm->PresentChargingCurrent;
- EVCOMM_SYS_INFO.PresentChargingCurrent = I_now / 10.0; //1A
- if (ShmInternalComm->PresentChargingCurrent_pre != ShmInternalComm->PresentChargingCurrent)
- {
- if ((abs(ShmInternalComm->PresentChargingCurrent_pre - ShmInternalComm->PresentChargingCurrent) > 20)&&
- (ShmInternalComm->PresentChargingVoltage >= 100))
- {
- //memset(buf_log_csucomm, 0, sizeof(buf_log_csucomm));
- sprintf(buf_log_csucomm, "I_now(EVSE): %d >> %d (0.1A, DEC)",
- ShmInternalComm->PresentChargingCurrent_pre,
- ShmInternalComm->PresentChargingCurrent
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- ShmInternalComm->PresentChargingCurrent_pre = ShmInternalComm->PresentChargingCurrent;
- }
- // -------- [4/7] P_now --------
- ShmInternalComm->PresentChargingPower = (int)(((I_now/10) * (V_now/10)) / 100); //0.1KW
- P_now = ShmInternalComm->PresentChargingPower;
- EVCOMM_SYS_INFO.PresentChargingPower = P_now * 10.0; //1KW
- if (ShmInternalComm->PresentChargingPower_pre != ShmInternalComm->PresentChargingPower)
- {
- sprintf(buf_log_csucomm, "P_now(EVSE): %d >> %d (0.1KW, DEC)",
- ShmInternalComm->PresentChargingPower_pre,
- ShmInternalComm->PresentChargingPower);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->PresentChargingPower_pre = ShmInternalComm->PresentChargingPower;
- }
- // -------- [5/7] I_max --------
- I_max = ShmInternalComm->AvailableChargingCurrent;
- EVCOMM_SYS_INFO.AvailableChargingCurrent = I_max / 10.0; //1A
- if (ShmInternalComm->AvailableChargingCurrent_pre != ShmInternalComm->AvailableChargingCurrent)
- {
- sprintf(buf_log_csucomm, "I_max(EVSE): %d >> %d (0.1A, DEC)",
- ShmInternalComm->AvailableChargingCurrent_pre,
- ShmInternalComm->AvailableChargingCurrent);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AvailableChargingCurrent_pre = ShmInternalComm->AvailableChargingCurrent;
- }
- // -------- [6/7] V_max --------
- V_max = ShmInternalComm->MaximumChargingVoltage;
- EVCOMM_SYS_INFO.MaximumChargingVoltage = V_max / 10.0; //1V
- if (ShmInternalComm->MaximumChargingVoltage_pre != ShmInternalComm->MaximumChargingVoltage)
- {
- sprintf(buf_log_csucomm, "V_max(EVSE): %d >> %d (0.1V, DEC)",
- ShmInternalComm->MaximumChargingVoltage_pre,
- ShmInternalComm->MaximumChargingVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->MaximumChargingVoltage_pre = ShmInternalComm->MaximumChargingVoltage;
- }
- // -------- [7/7] P_max --------
- P_max = ShmInternalComm->AvailableChargingPower;
- EVCOMM_SYS_INFO.AvailableChargingPower = P_max / 10.0; //1KW
- if (ShmInternalComm->AvailableChargingPower_pre != ShmInternalComm->AvailableChargingPower)
- {
- sprintf(buf_log_csucomm, "P_max(EVSE): %d >> %d (0.1KW, DEC)",
- ShmInternalComm->AvailableChargingPower_pre,
- ShmInternalComm->AvailableChargingPower);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AvailableChargingPower_pre = ShmInternalComm->AvailableChargingPower;
- }
- }
- /*===========================================================================
- FUNCTION: Proc_EVBoardStatusRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_EVBoardStatusRes(int Fd)
- {
- int nbytes;
- unsigned char Buffer[8];
- memset(Buffer, 0, sizeof(Buffer));
- Buffer[0] = ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].ConnectorPlugIn;
- Buffer[1] = ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].CpState;
- /*
- if(strlen(ShmStatusCodeData->PresentStatusCode[0]) > 0)
- {
- memcpy(Buffer + 2, ShmStatusCodeData->PresentStatusCode[0], 6);
- }
- */
- Buffer[2] = ShmStatusCodeData->PresentStatusCode[0][0];
- Buffer[3] = ShmStatusCodeData->PresentStatusCode[0][1];
- Buffer[4] = ShmStatusCodeData->PresentStatusCode[0][2];
- Buffer[5] = ShmStatusCodeData->PresentStatusCode[0][3];
- Buffer[6] = ShmStatusCodeData->PresentStatusCode[0][4];
- Buffer[7] = ShmStatusCodeData->PresentStatusCode[0][5];
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_EV_BOARD_STATUS, ShmInternalComm->SlaveAddress, 8, Buffer);
- CSUCOMMDC_TASK_FLAG.Send_EVBoardStatus = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_AddressAssignRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_AddressAssignRes(int Fd)
- {
- }
- /*===========================================================================
- FUNCTION: Proc_AddressAssignReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_AddressAssignReq(struct can_frame *frame)
- {
- //[CAUTION] There should not be such message ID here.
- // A warning alarm should be recorded.
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_AddressAssignReq] Unexpected message of address assignment from CSU.\n");
- ShmInternalComm->SlaveAddress = frame->can_id & 0x000000FF;
- CSUCOMMDC_TASK_FLAG.Got_AssignedAddress = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_GetFirmwareVersionRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_GetFirmwareVersionRes(int Fd)
- {
- int i = 0, j = 0, nbytes = 0;
- unsigned char str[FIRMWARE_VERSION_LENGTH + 1];
- unsigned char buf[FIRMWARE_VERSION_LENGTH];
- memset(buf, 0, sizeof(buf));
- strcpy(str, FIRMWARE_VERSION);
- for(i = 0; i < FIRMWARE_VERSION_LENGTH + 3; i++)
- {
- if (str[i] != '_')
- {
- buf[j] = str[i];
- j++;
- }
- }
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_GET_FW_VERSION, ShmInternalComm->SlaveAddress, FIRMWARE_VERSION_LENGTH, buf);
- CSUCOMMDC_TASK_FLAG.Got_FWVersionReq = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_GetFirmwareVersionReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_GetFirmwareVersionReq(struct can_frame *frame)
- {
- CSUCOMMDC_TASK_FLAG.Got_FWVersionReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_HardwareVersionRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_HardwareVersionRes(int Fd)
- {
- int i = 0, nbytes = 0;
- unsigned char str[HARDWARE_VERSION_LENGTH + 1];
- unsigned char buf[HARDWARE_VERSION_LENGTH];
- memset(buf, 0, sizeof(buf));
- strcpy(str, HARDWARE_VERSION);
- for(i = 0; i < HARDWARE_VERSION_LENGTH; i++)
- {
- buf[i] = str[i];
- }
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_GET_HW_VERSION, ShmInternalComm->SlaveAddress, HARDWARE_VERSION_LENGTH, buf);
- CSUCOMMDC_TASK_FLAG.Got_HWVersionReq = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_HardwareVersionReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_HardwareVersionReq(struct can_frame *frame)
- {
- CSUCOMMDC_TASK_FLAG.Got_HWVersionReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_GetMiscellaneousInfoRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_GetMiscellaneousInfoRes(int Fd)
- {
- //DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_GetMiscellaneousInfoRes] To-be implemented.\n");
- int nbytes;
- unsigned char Buffer[8];
- unsigned short TmpValue;
- memset(Buffer, 0, sizeof(Buffer));
- Buffer[0] = ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].ConnectorLocked;
- Buffer[1] =ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp&0xFF;
- Buffer[2] =(ShmSysConfigAndInfo->SysInfo.CcsConnectorTemp>>8)&0xFF;
- Buffer[3] = (unsigned char)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].CpVoltage * 10);
- Buffer[4] = ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].CpState;
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_GET_MISC_INFO, ShmInternalComm->SlaveAddress, 7, Buffer);
- CSUCOMMDC_TASK_FLAG.Got_MiscellaneousInfoReq = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_GetMiscellaneousInfoReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_GetMiscellaneousInfoReq(struct can_frame *frame)
- {
- CSUCOMMDC_TASK_FLAG.Got_MiscellaneousInfoReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_ChargingPermissionRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_ChargingPermissionRes(int Fd)
- {
- //Save into ShmCcsData
- //[1/2] Updating Parameters
- Update_EVSE_INFO_to_SHMs();
- //[2/2] Check if SECC is in the End_Process or Initial stage
- if ((EVCOMM_SYS_INFO.End_Process_inused == TRUE) ||
- (EVCOMM_SYS_INFO.QCA7K_SetKeyDone == FALSE))
- {
- if (ShmInternalComm->ChargingPermission == TRUE)
- {
- //Update_ShmStatusCode(); //[To-Do] to be implemented
- //CCS_SECC_Not_Ready_For_Charging (023891)
- ShmStatusCodeData->PresentStatusCode[0][0] = 0;
- ShmStatusCodeData->PresentStatusCode[0][1] = 2;
- ShmStatusCodeData->PresentStatusCode[0][2] = 3;
- ShmStatusCodeData->PresentStatusCode[0][3] = 8;
- ShmStatusCodeData->PresentStatusCode[0][4] = 9;
- ShmStatusCodeData->PresentStatusCode[0][5] = 1;
- CSUCOMMDC_TASK_FLAG.Send_EVStopReq = TRUE;
- //This Stop command will be delivered to CSU once SECC receives
- //one permission as TRUE command.
- }
- }
- CSUCOMMDC_TASK_FLAG.Got_ChargingPermission = FALSE;
- }
- /*===========================================================================
- FUNCTION: Proc_ChargingPermissionReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_ChargingPermissionReq(struct can_frame *frame)
- {
- ShmInternalComm->ChargingPermission_new = frame->data[0];
- ShmInternalComm->AvailableChargingPower = (unsigned int) ((frame->data[2] << 8) | frame->data[1]);
- ShmInternalComm->AvailableChargingCurrent = (unsigned int) ((frame->data[4] << 8) | frame->data[3]);
- ShmInternalComm->MaximumChargingVoltage = (unsigned int) ((frame->data[6] << 8) | frame->data[5]);
- ShmInternalComm->MaximumAllowedChargingTime = frame->data[7]; //0: unlimited, 0x01: 1 minutes ~ 0xFF: 255 minutes, resolution: 1 minute
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][CAN_Rx]\n\
- \t - AvailableChargingPower = (%d, %02X, %02X)\n\
- \t - AvailableChargingCurrent = (%d, %02X, %02X)\n\
- \t - MaximumChargingVoltage = (%d, %02X, %02X)\n",
- ShmInternalComm->AvailableChargingPower, frame->data[2], frame->data[1],
- ShmInternalComm->AvailableChargingCurrent, frame->data[4], frame->data[3],
- ShmInternalComm->MaximumChargingVoltage, frame->data[6], frame->data[5]
- );
- //Update Flag
- CSUCOMMDC_TASK_FLAG.Got_ChargingPermission = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSEOutputStatusUpdateRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_EVSEOutputStatusUpdateRes(int Fd)
- {
- Update_EVSE_INFO_to_SHMs();
- //Update Flag
- CSUCOMMDC_TASK_FLAG.Got_EVSEOutputStatus = FALSE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSEOutputStatusUpdateReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_EVSEOutputStatusUpdateReq(struct can_frame *frame)
- {
- if(ShmInternalComm->SlaveAddress == 1)
- {
- ShmInternalComm->PresentChargingVoltage = ((unsigned int)frame->data[1] << 8 | frame->data[0]);
- ShmInternalComm->PresentChargingCurrent = ((unsigned int)frame->data[3] << 8 | frame->data[2]);
- }
- else
- {
- ShmInternalComm->PresentChargingVoltage = ((unsigned int)frame->data[5] << 8 | frame->data[4]);
- ShmInternalComm->PresentChargingCurrent = ((unsigned int)frame->data[7] << 8 | frame->data[6]);
- }
- //Update Flag
- CSUCOMMDC_TASK_FLAG.Got_EVSEOutputStatus = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSECapacityUpdateRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_EVSECapacityUpdateRes(int Fd)
- {
- Update_EVSE_INFO_to_SHMs();
- CSUCOMMDC_TASK_FLAG.Got_EnergyCapacity = FALSE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSECapacityUpdateReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_EVSECapacityUpdateReq(struct can_frame *frame)
- {
- if(ShmInternalComm->SlaveAddress == 1)
- {
- ShmInternalComm->AvailableChargingPower = ((unsigned int)frame->data[1] << 8 | frame->data[0]);
- ShmInternalComm->AvailableChargingCurrent = ((unsigned int)frame->data[3] << 8 | frame->data[2]);
- }
- else
- {
- ShmInternalComm->AvailableChargingPower = ((unsigned int)frame->data[5] << 8 | frame->data[4]);
- ShmInternalComm->AvailableChargingCurrent = ((unsigned int)frame->data[7] << 8 | frame->data[6]);
- }
- //Update Flag
- CSUCOMMDC_TASK_FLAG.Got_EnergyCapacity = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_GetEVTargetRes
- DESCRIPTION:
- #define CAN_CMD_GET_EV_TARGET_INFO 0x00000900
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_GetEVTargetRes(int Fd)
- {
- //DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_GetEVTargetRes] To-be implemented.\n");
- int nbytes;
- unsigned char Buffer[8];
- unsigned short TmpValue;
- static struct ChargingInfoData *sys;
- sys = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[0];
- memset(Buffer, 0, sizeof(Buffer));
- Buffer[0] = Check_V2G_Flow_Status();
- //[1/4] SOC
- if (sys->EvBatterySoc_pre != sys->EvBatterySoc)
- {
- //memset(buf_log_csucomm, 0, sizeof(buf_log_csucomm));
- sprintf(buf_log_csucomm, "SOC = %d >> %d",
- sys->EvBatterySoc_pre,
- sys->EvBatterySoc
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- sys->EvBatterySoc_pre = sys->EvBatterySoc;
- }
- Buffer[1] = sys->EvBatterySoc;
- //printf("[CsuComm] V_ev_target = %.02f\n", sys->EvBatterytargetVoltage);
- //[2/4] EV Target Voltage
- if (sys->EvBatterytargetVoltage_pre != sys->EvBatterytargetVoltage)
- {
- //memset(buf_log_csucomm, 0, sizeof(buf_log_csucomm));
- sprintf(buf_log_csucomm, "V_target = %.02f >> %.02f (1V, DEC)",
- sys->EvBatterytargetVoltage_pre,
- sys->EvBatterytargetVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- sys->EvBatterytargetVoltage_pre = sys->EvBatterytargetVoltage;
- }
- TmpValue = (unsigned short) (sys->EvBatterytargetVoltage * 10);
- memcpy(Buffer + 2, &TmpValue, 2);
- //[3/4] EV Target Current
- if (sys->EvBatterytargetCurrent_pre != sys->EvBatterytargetCurrent)
- {
- //memset(buf_log_csucomm, 0, sizeof(buf_log_csucomm));
- sprintf(buf_log_csucomm, "I_target = %.02f >> %.02f (1A, DEC)",
- sys->EvBatterytargetCurrent_pre,
- sys->EvBatterytargetCurrent
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- sys->EvBatterytargetCurrent_pre = sys->EvBatterytargetCurrent;
- }
- TmpValue = (unsigned short) (sys->EvBatterytargetCurrent * 10);
- memcpy(Buffer + 4, &TmpValue, 2);
- //[4/4] Remaining Time
- TmpValue = (unsigned short) sys->RemainChargingDuration;
- memcpy(Buffer + 6, &TmpValue, 2);
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_GET_EV_TARGET_INFO, ShmInternalComm->SlaveAddress, 8, Buffer);
- CSUCOMMDC_TASK_FLAG.Got_EVTargetReq = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_GetEVTargetReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_GetEVTargetReq(struct can_frame *frame)
- {
- CSUCOMMDC_TASK_FLAG.Got_EVTargetReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_GetEVBatteryInfoRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_GetEVBatteryInfoRes(int Fd)
- {
- int nbytes;
- unsigned char Buffer[8];
- unsigned short TmpValue;
- memset(Buffer, 0, sizeof(Buffer));
- //[To-Do] Adding the consideration of ISO15118_2018
- if((ShmCcsData->CommProtocol == V2GT_MSG_PROTOCOL_ISO15118_2014) &&
- (ShmCcsData->V2GMessage_ISO15118_2014.ChargeParameterDiscoveryRequest.RequestedEnergyTransferMode <= 1))
- {
- Buffer[0] = 1;//AC
- }
- else
- {
- Buffer[0] = 0;//DC
- }
- if(ShmCcsData->CommProtocol == V2GT_MSG_PROTOCOL_DIN70121)
- {
- //DIN70121
- TmpValue = DIN70121PhyValDecode(ShmCcsData->V2GMessage_DIN70121.ChargeParameterDiscoveryRequest.DC_EVChargeParameter.EVEnergyCapacity) * 10;
- memcpy(Buffer + 1, &TmpValue, 2);
- TmpValue = DIN70121PhyValDecode(ShmCcsData->V2GMessage_DIN70121.ChargeParameterDiscoveryRequest.DC_EVChargeParameter.EVMaximumVoltageLimit) * 10;
- memcpy(Buffer + 3, &TmpValue, 2);
- TmpValue = DIN70121PhyValDecode(ShmCcsData->V2GMessage_DIN70121.ChargeParameterDiscoveryRequest.DC_EVChargeParameter.EVMaximumCurrentLimit) * 10;
- memcpy(Buffer + 5, &TmpValue, 2);
- }
- else if(ShmCcsData->CommProtocol == V2GT_MSG_PROTOCOL_ISO15118_2014)
- {
- //ISO15118_2014
- if(Buffer[0] == 0)
- {
- //DC
- TmpValue = ISO151182014PhyValDecode(ShmCcsData->V2GMessage_ISO15118_2014.ChargeParameterDiscoveryRequest.DC_EVChargeParameter.EVEnergyCapacity) * 10;
- memcpy(Buffer + 1, &TmpValue, 2);
- TmpValue = ISO151182014PhyValDecode(ShmCcsData->V2GMessage_ISO15118_2014.ChargeParameterDiscoveryRequest.DC_EVChargeParameter.EVMaximumVoltageLimit) * 10;
- memcpy(Buffer + 3, &TmpValue, 2);
- TmpValue = ISO151182014PhyValDecode(ShmCcsData->V2GMessage_ISO15118_2014.ChargeParameterDiscoveryRequest.DC_EVChargeParameter.EVMaximumCurrentLimit) * 10;
- memcpy(Buffer + 5, &TmpValue, 2);
- }
- else
- {
- //AC
- TmpValue = ISO151182014PhyValDecode(ShmCcsData->V2GMessage_ISO15118_2014.ChargeParameterDiscoveryRequest.AC_EVChargeParameter.EAmount) * 10;
- memcpy(Buffer + 1, &TmpValue, 2);
- TmpValue = ISO151182014PhyValDecode(ShmCcsData->V2GMessage_ISO15118_2014.ChargeParameterDiscoveryRequest.AC_EVChargeParameter.EVMaxVoltage) * 10;
- memcpy(Buffer + 3, &TmpValue, 2);
- TmpValue = ISO151182014PhyValDecode(ShmCcsData->V2GMessage_ISO15118_2014.ChargeParameterDiscoveryRequest.AC_EVChargeParameter.EVMaxCurrent) * 10;
- memcpy(Buffer + 5, &TmpValue, 2);
- }
- }
- else if(ShmCcsData->CommProtocol == V2GT_MSG_PROTOCOL_ISO15118_2018)
- {
- //to be implemented
- }
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_GET_EV_BATTERY_INFO, ShmInternalComm->SlaveAddress, 7, Buffer);
- CSUCOMMDC_TASK_FLAG.Got_EVBatteryInfoReq = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_GetEVBatteryInfoReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_GetEVBatteryInfoReq()
- {
- CSUCOMMDC_TASK_FLAG.Got_EVBatteryInfoReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_IsolationStatusAnnounceRes
- DESCRIPTION:
- - ShmInternalComm->IsolationStatus:
- GFD_Invalid 0 //ongoing
- GFD_Valid 1
- GFD_Warning 2
- GFD_Fault 3
- GFD_No_IMD 4 //for ISO 15118
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_IsolationStatusAnnounceRes(int Fd)
- {
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_IsolationStatusAnnounceRes] %d (DEC, 0:ongoing, 1:valid, 2:warning/fault)\n",
- ShmInternalComm->IsolationStatus);
- if (ShmInternalComm->IsolationStatus_pre != ShmInternalComm->IsolationStatus)
- {
- //memset(buf_log_csucomm, 0, sizeof(buf_log_csucomm));
- sprintf(buf_log_csucomm, "Isolation: %d >> %d",
- ShmInternalComm->IsolationStatus_pre,
- ShmInternalComm->IsolationStatus);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->IsolationStatus_pre = ShmInternalComm->IsolationStatus;
- }
- //DC_EVSEStatus.EVSEIsolationStatus = dinisolationLevelType_Invalid; //0 (default)
- // dinisolationLevelType_Invalid = 0,
- // dinisolationLevelType_Valid = 1, (default)
- // dinisolationLevelType_Warning = 2,
- // dinisolationLevelType_Fault = 3
- CSUCOMMDC_TASK_FLAG.Got_IsolationStatus = FALSE;
- }
- /*===========================================================================
- FUNCTION: Proc_IsolationStatusAnnounceReq
- DESCRIPTION:
- - BYTE[0]:
- GFD_Invalid 0 //ongoing
- GFD_Valid 1
- GFD_Warning 2
- GFD_Fault 3
- GFD_No_IMD 4 //for ISO 15118
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_IsolationStatusAnnounceReq(struct can_frame *frame)
- {
- unsigned char gfd_rx = 0;
- gfd_rx = (unsigned char) frame->data[0];
- if (gfd_rx >= GFD_Invalid && gfd_rx <= GFD_No_IMD)
- {
- //Transfer Parameter
- if (gfd_rx == GFD_Warning)
- {
- gfd_rx = GFD_Fault;
- }
- else if (gfd_rx == GFD_Fault)
- {
- gfd_rx = GFD_Warning;
- }
- else
- {
- //no modification.
- }
- ShmInternalComm->IsolationStatus = gfd_rx;
- EVCOMM_SYS_INFO.IsolationStatus = ShmInternalComm->IsolationStatus;
- CSUCOMMDC_TASK_FLAG.Got_IsolationStatus = TRUE;
- }
- else
- {
- sprintf(buf_log_csucomm,
- "[WARNING]unexpected isolation status(%d)",
- frame->data[0]);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- }
- /*===========================================================================
- FUNCTION: Proc_CCSConnectorTypeSetRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_CCSConnectorTypeSetRes(int Fd)
- {
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_CCSConnectorTypeSetRes] To-be implemented. (checking for PP or not)\n");
- CSUCOMMDC_TASK_FLAG.Got_CCSConnectorReq = FALSE;
- }
- /*===========================================================================
- FUNCTION: Proc_CCSConnectorTypeSetReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_CCSConnectorTypeSetReq(struct can_frame *frame)
- {
- ShmInternalComm->CCSConnectorType = (unsigned char) frame->data[0];//0x00 : CCS1, 0x01 : CCS2
- CSUCOMMDC_TASK_FLAG.Got_CCSConnectorReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_RTCSetRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_RTCSetRes(int Fd)
- {
- int nbytes;
- unsigned char Buffer[1];
- memset(Buffer, 0, sizeof(Buffer));
- if (ShmInternalComm->RTC != 0)
- {
- //[CAUTION] updating RTC time only in IDLE mode
- //ShmInternalComm->RTC = 1575461829;
- sprintf(buf_log_csucomm, "[Proc_RTCSetRes] Got RTC Message: %lu (DEC)", ShmInternalComm->RTC);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- system("date");
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_RTCSetRes] RTC is updating...");
- #if 1
- time_t rtc_new;
- rtc_new = ShmInternalComm->RTC; //Epoch time
- stime(&rtc_new);
- ftime(&ShmInternalComm->Start_Time);
- ftime(&ShmInternalComm->End_Time);
- ftime(&ShmInternalComm->CAN_Rx_Timer_Start);
- ftime(&ShmInternalComm->CAN_Rx_Timer_End);
- #else //verified ok
- char buf[64];
- sprintf(buf, "date +%%s -s @%u", ShmInternalComm->RTC);
- system(buf);
- ftime(&ShmInternalComm->Start_Time);
- ftime(&ShmInternalComm->End_Time);
- ftime(&ShmInternalComm->CAN_Rx_Timer_Start);
- ftime(&ShmInternalComm->CAN_Rx_Timer_End);
- #endif
- system("date");
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_RTCSetRes] RTC is updated.\n");
- Buffer[0] = 1; //Accept
- }
- else
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_RTCSetRes] Reject.\n");
- Buffer[0] = 0; //Reject
- }
- CSUCOMMDC_TASK_FLAG.Got_RTC = FALSE;
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_RTC_INFO, ShmInternalComm->SlaveAddress, 1, Buffer);
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_RTCSetReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- 1. Epoch time
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_RTCSetReq(struct can_frame *frame)
- {
- //STEP 1: If the RTC time from CSU is older than CCS default time, ignore it.
- //(The RTC time of CSU might not be updated.)
- long int rtc_tmp = 0;
- memcpy(&rtc_tmp, &frame->data[0], 4); //Epoch time
- if (rtc_tmp < RTC_DEFAULT_TIME)
- {
- sprintf(buf_log_csucomm,
- "[WARNING] RTC time from CSU(%lu) is older than CCS(%lu): ignored",
- rtc_tmp,
- RTC_DEFAULT_TIME);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- return;
- }
- //STEP 2: Checking System State and Update RTC
- if (Check_V2G_Flow_Status() == IDLE &&
- ShmInternalComm->DownloadImageInfo.active == FALSE &&
- EVCOMM_SYS_INFO.End_Process_inused == FALSE)
- {
- #if 1
- //4-Byte EPOCH TIME: CAN: BYTE_TIME[0] BYTE_TIME[1] BYTE_TIME[2] BYTE_TIME[3]
- memcpy(&ShmInternalComm->RTC, &frame->data[0], 4); //Epoch time
- #else
- //4-Byte EPOCH TIME: CAN: BYTE_TIME[3] BYTE_TIME[2] BYTE_TIME[1] BYTE_TIME[0]
- unsigned char rtc[4], tmp;
- memcpy(&rtc[0], &frame->data[0], 4);
- tmp = rtc[0];
- rtc[0] = rtc[3];
- rtc[3] = tmp;
- tmp = rtc[1];
- rtc[1] = rtc[2];
- rtc[2] = tmp;
- memcpy(&ShmInternalComm->RTC, &rtc[0], 4); //Epoch time
- #endif
- }
- else
- {
- ShmInternalComm->RTC = 0;
- }
- //printf("\n%X %X %X %X (%X)\n", frame->data[0], frame->data[1], frame->data[2], frame->data[3], ShmInternalComm->RTC);
- CSUCOMMDC_TASK_FLAG.Got_RTC = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSEPrechargeInfoUpdateRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_EVSEPrechargeInfoUpdateRes(int Fd)
- {
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_EVSEPrechargeInfoUpdateRes]\n");
- int nbytes;
- unsigned char Buffer[8];
- unsigned short TmpValue;
- memset(Buffer, 0, sizeof(Buffer));
- //Buffer[0] = TRUE;
- Buffer[0] = ShmInternalComm->EVSEPrechargeStatus;
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_EVSE_PRECHARGE_INFO, ShmInternalComm->SlaveAddress, 1, Buffer);
- CSUCOMMDC_TASK_FLAG.Got_EVSE_Precharge_Info = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSEPrechargeInfoUpdateReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_EVSEPrechargeInfoUpdateReq(struct can_frame *frame)
- {
- static struct ChargingInfoData *sys;
- sys = &ShmSysConfigAndInfo->SysInfo.CcsChargingData[0];
- ShmInternalComm->EVSEPrechargeStatus = frame->data[0];
- sys->EVSEPrechargeStatus = ShmInternalComm->EVSEPrechargeStatus;
- if (sys->EVSEPrechargeStatus_pre != sys->EVSEPrechargeStatus)
- {
- //memset(buf_log_csucomm, 0, sizeof(buf_log_csucomm));
- sprintf(buf_log_csucomm, "Precharge Status: %d >> %d",
- sys->EVSEPrechargeStatus_pre,
- sys->EVSEPrechargeStatus
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- sys->EVSEPrechargeStatus_pre = sys->EVSEPrechargeStatus;
- }
- CSUCOMMDC_TASK_FLAG.Got_EVSE_Precharge_Info = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVCCIDRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_EVCCIDRes(int Fd)
- {
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_EVCCIDRes]\n");
- int i = 0;
- int nbytes = 0;
- unsigned char Buffer[8];
- /*+++ 20200707, vern, reduce 8 digital MAC from BMW i3 +++*/
- memset(Buffer, 0, sizeof(Buffer));
-
- if(EVCOMM_SYS_INFO.EVCCID_length>=8)
- {
- EVCOMM_SYS_INFO.EVCCID_length=8;
- if((EVCOMM_SYS_INFO.EVCCID[0]==0)&&(EVCOMM_SYS_INFO.EVCCID[1]==0))
- memcpy(EVCOMM_SYS_INFO.EVCCID,EVCOMM_SYS_INFO.EVCCID+2,6);
- EVCOMM_SYS_INFO.EVCCID_length=6;
- }
- memcpy(Buffer,EVCOMM_SYS_INFO.EVCCID,EVCOMM_SYS_INFO.EVCCID_length);
- /*--- 20200707, vern, reduce 8 digital MAC from BMW i3 ---*/
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_EVCCID_REQUEST, ShmInternalComm->SlaveAddress, EVCOMM_SYS_INFO.EVCCID_length, Buffer);
- CSUCOMMDC_TASK_FLAG.Got_EVCCID_Req = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_EVCCIDReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_EVCCIDReq(struct can_frame *frame)
- {
- CSUCOMMDC_TASK_FLAG.Got_EVCCID_Req = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVStopRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_EVStopRes(int Fd)
- {
- int nbytes;
- unsigned char Buffer[8];
- memset(Buffer, 0, sizeof(Buffer));
- /*
- if(strlen(ShmStatusCodeData->PresentStatusCode[0]) > 0)
- {
- memcpy(Buffer + 2, ShmStatusCodeData->PresentStatusCode[0], 6);
- }
- */
- Buffer[1] = ShmStatusCodeData->PresentStatusCode[0][0];
- Buffer[2] = ShmStatusCodeData->PresentStatusCode[0][1];
- Buffer[3] = ShmStatusCodeData->PresentStatusCode[0][2];
- Buffer[4] = ShmStatusCodeData->PresentStatusCode[0][3];
- Buffer[5] = ShmStatusCodeData->PresentStatusCode[0][4];
- Buffer[6] = ShmStatusCodeData->PresentStatusCode[0][5];
-
- if(( Buffer[1]== 0)&&( Buffer[2]== 2)&&( Buffer[3]== 3)&&( Buffer[4]== 9)&&( Buffer[5]== 7)&&( Buffer[6]== 9))
- CSUCOMMDC_TASK_FLAG.EV_Stop_Type_Emergency = FALSE;
- else
- CSUCOMMDC_TASK_FLAG.EV_Stop_Type_Emergency = TRUE;
-
- if (CSUCOMMDC_TASK_FLAG.EV_Stop_Type_Emergency == TRUE)
- {
- Buffer[0] = EV_EMERGENCY_STOP; //2
- }
- else
- {
- Buffer[0] = EV_NORMAL_STOP; //1
- }
-
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_EV_STOP_EVENT, ShmInternalComm->SlaveAddress, 7, Buffer);
- //system("echo 1000000 > /sys/class/pwm/pwmchip0/pwm0/duty_cycle"); //for test only
- //system("echo 0 > /sys/class/gpio/gpio89/value"); //for test
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_EVStopRes] Sending STOP Command to CSU");
- CSUCOMMDC_TASK_FLAG.EV_Stop_Type_Emergency = FALSE;
- CSUCOMMDC_TASK_FLAG.Send_EVStopReq = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSEStopRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_EVSEStopRes(int Fd)
- {
- if (EVCOMM_SYS_INFO.DC_EVSEStatus != EVSE_Shutdown &&
- EVCOMM_SYS_INFO.DC_EVSEStatus != EVSE_EmergencyShutdown)
- {
- //The above considtion will let this debug message to print once
- //even though the CSU sends several continuous stop commands.
- sprintf(buf_log_csucomm,
- "[Proc_EVSEStopRes] CSU Requests for STOP (Stop by EVSE: %d)",
- ShmInternalComm->EVSEStopChargingReq.type);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- //Once the stop command is received by CCS, this CAN message cannot
- //resume it back to normal state unless the End_Process is completed.
- if (ShmInternalComm->EVSEStopChargingReq.type == 1)
- {
- EVCOMM_SYS_INFO.DC_EVSEStatus = EVSE_Shutdown;
- }
- else if (ShmInternalComm->EVSEStopChargingReq.type == 2)
- {
- EVCOMM_SYS_INFO.DC_EVSEStatus = EVSE_EmergencyShutdown;
- }
- else
- {
- EVCOMM_SYS_INFO.DC_EVSEStatus = EVSE_Ready;
- }
- }
- CSUCOMMDC_TASK_FLAG.Got_EVSEStopReq = FALSE;
- }
- /*===========================================================================
- FUNCTION: Proc_EVSEStopReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_EVSEStopReq(struct can_frame *frame)
- {
- ShmInternalComm->EVSEStopChargingReq.type = frame->data[0];
- memcpy(&ShmInternalComm->EVSEStopChargingReq.alarmcode, &frame->data[1], 6);
- CSUCOMMDC_TASK_FLAG.Got_EVSEStopReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Check_DwnldImgParameter
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- 1. Parameter Validation (0: invalid, 1: valid)
- 2. final_canmsg_size
- 3. total_can_packets
- GLOBAL VARIABLES:
- =============================================================================*/
- int Check_DwnldImgParameter()
- {
- int image_size = 0; //unit: byte
- int total_can_packets = 0;
- unsigned char block_quantity = 0;
- unsigned char block_size_KByte = 0; //unit: Kbytes
- unsigned char final_canmsg_size = 0; //1~7
- image_size = ShmInternalComm->DownloadImageInfo.image_size;
- block_quantity = ShmInternalComm->DownloadImageInfo.block_quantity;
- block_size_KByte = ShmInternalComm->DownloadImageInfo.block_size_KByte;
- //Step 1: Caculate final_canmsg_size and total_can_packets
- final_canmsg_size = image_size % 8; //8: max of CAN bus payload
- total_can_packets = image_size / 8;
- if (final_canmsg_size != 0)
- {
- total_can_packets += 1;
- }
- ShmInternalComm->DownloadImageInfo.final_canmsg_size = final_canmsg_size;
- ShmInternalComm->DownloadImageInfo.total_can_packets = total_can_packets;
- DEBUG_PRINTF_CSUCOMM_DETAIL("[Check_DwnldImgParameter]\n");
- DEBUG_PRINTF_CSUCOMM_DETAIL("\t - final_canmsg_size = %d (DEC)\n\
- \t - total_can_packets = %d (DEC)\n\n",
- ShmInternalComm->DownloadImageInfo.final_canmsg_size,
- ShmInternalComm->DownloadImageInfo.total_can_packets
- );
- //Step 2: Check Parameter Validation
- //if ((block_quantity * block_size_KByte * 1024) > image_size)
- //[CAUTION] To increase type ID, please modify this condition.
- if (ShmInternalComm->DownloadImageInfo.type <= IMAGE_TYPE_USER_CONFIGURATION)
- {
- return TRUE;
- }
- else
- {
- sprintf(buf_log_csucomm,
- "[Check_DwnldImgParameter] type(%d) is not allowed, yet.",
- ShmInternalComm->DownloadImageInfo.type
- );
- SAVE_SYS_LOG_MSG_CSUCOMM("buf_log_csucomm");
- return FALSE;
- }
- }
- /*===========================================================================
- FUNCTION: Proc_DownloadImageRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_DownloadImageRes(int Fd)
- {
- int nbytes;
- unsigned char Buffer[1];
- memset(Buffer, 0, sizeof(Buffer));
- if (ShmInternalComm->DownloadImageInfo.active == TRUE)
- {
- //[VITAL] Closing unneccesary task to supoort rapid CAN data receving..
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadImageRes] closing SeccComm...");
- system("killall SeccComm");
- system("rm -f /Storage/tmp");
- system("touch /Storage/tmp");
- #if (FIRMWARE_VERSION_COMPILE_SETTING_RELEASE_MODE == DISABLE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadImageRes]sync...");
- system("sync");
- }
- #endif
- Buffer[0] = 1; //Accept
- }
- else
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadImageRes] Fail");
- Buffer[0] = 0; //Reject
- //[To-be-implemented][TBD] Sending alarm code or not?
- }
- DEBUG_PRINTF_CSUCOMM_DETAIL("[Proc_DownloadImageRes] %d (DEC)\n", Buffer[0]);
- CSUCOMMDC_TASK_FLAG.Got_DownloadImageReq = FALSE;
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_DOWNLOAD_REQUEST, ShmInternalComm->SlaveAddress, 1, Buffer);
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_DownloadImageReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_DownloadImageReq(struct can_frame *frame)
- {
- if (Check_V2G_Flow_Status() == IDLE)
- {
- ShmInternalComm->DownloadImageInfo.type = frame->data[0];
- memcpy(&ShmInternalComm->DownloadImageInfo.image_size, &frame->data[1], 4);
- ShmInternalComm->DownloadImageInfo.image_size_received = 0;
- ShmInternalComm->DownloadImageInfo.block_quantity = frame->data[5];
- ShmInternalComm->DownloadImageInfo.block_sequence_number = 0;
- ShmInternalComm->DownloadImageInfo.block_size_KByte = frame->data[6];
- ShmInternalComm->DownloadImageInfo.block_sequence_number = 0;
- ShmInternalComm->DownloadImageInfo.block_checksum = 0;
- ShmInternalComm->DownloadImageInfo.total_can_packets = 0;
- ShmInternalComm->DownloadImageInfo.image_rx_cnt = 0;
- ShmInternalComm->DownloadImageInfo.downlaod_percentage = 0;
- ShmInternalComm->DownloadImageInfo.downlaod_percentage_pre = 0;
- ShmInternalComm->DownloadImageInfo.active = FALSE;
- if (ShmInternalComm->DownloadImageInfo.image_size == 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadImageReq][Warning] image_size cannot be 0\n");
- }
- else if (ShmInternalComm->DownloadImageInfo.block_quantity == 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadImageReq][Warning] block_quantity cannot be 0\n");
- }
- else if (ShmInternalComm->DownloadImageInfo.block_size_KByte == 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadImageReq][Warning] block_size_KByte cannot be 0\n");
- }
- else if (Check_DwnldImgParameter() == FALSE)
- {
- sprintf(buf_log_csucomm, "[Proc_DownloadImageReq][Warning] nonlogical image_size(%d bytes, DEC), block_quantity(%d, DEC), block_size_KByte(%d, DEC)\n",
- ShmInternalComm->DownloadImageInfo.image_size,
- ShmInternalComm->DownloadImageInfo.block_quantity,
- ShmInternalComm->DownloadImageInfo.block_size_KByte
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- else
- {
- ShmInternalComm->DownloadImageInfo.active = TRUE;
- }
- }
- else
- {
- ShmInternalComm->DownloadImageInfo.active = FALSE;
- sprintf(buf_log_csucomm,
- "[Proc_BlockTransferStartReq] PresentMsgFlowStatus (%d, DEC) is not in IDLE\n",
- Check_V2G_Flow_Status()
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadImageReq] Got Request from CSU\n");
- sprintf(buf_log_csucomm, "\t - type = %d (DEC)\n\
- \t - image size = %d (DEC, bytes)\n\
- \t - block quantity = %d (DEC)\n\
- \t - block size = %d (DEC, KBytes)\n\n",
- ShmInternalComm->DownloadImageInfo.type,
- ShmInternalComm->DownloadImageInfo.image_size,
- ShmInternalComm->DownloadImageInfo.block_quantity,
- ShmInternalComm->DownloadImageInfo.block_size_KByte
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- CSUCOMMDC_TASK_FLAG.Got_DownloadImageReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_BlockTransferStartRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_BlockTransferStartRes(int Fd)
- {
- int nbytes;
- unsigned char Buffer[1];
- memset(Buffer, 0, sizeof(Buffer));
- if (ShmInternalComm->DownloadImageInfo.active == TRUE)
- {
- Buffer[0] = 1; //Accept
- }
- else
- {
- fclose(ShmInternalComm->DownloadImageInfo.file);
- Buffer[0] = 0; //Reject
- //[To-be-implemented][TBD] Sending alarm code or not?
- }
- DEBUG_PRINTF_CSUCOMM_DETAIL("[Proc_BlockTransferStartRes] %d (DEC)\n", Buffer[0]);
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_START_BLOCK_TRANSFER, ShmInternalComm->SlaveAddress, 1, Buffer);
- CSUCOMMDC_TASK_FLAG.Got_BlockTransferStartReq = FALSE;
- return nbytes;
- }
- /*===========================================================================
- FUNCTION: Proc_BlockTransferStartReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_BlockTransferStartReq(struct can_frame *frame)
- {
- if (Check_V2G_Flow_Status() == IDLE)
- {
- ShmInternalComm->DownloadImageInfo.block_sequence_number += 1; //1~255
- //Check the valid range (1 ~ 255)
- if (frame->data[0] >= 1 &&
- frame->data[0] <= 255 &&
- ShmInternalComm->DownloadImageInfo.block_sequence_number == frame->data[0] &&
- ShmInternalComm->DownloadImageInfo.block_sequence_number >= 1 &&
- ShmInternalComm->DownloadImageInfo.block_sequence_number <= 255
- )
- {
- ShmInternalComm->DownloadImageInfo.active = TRUE;
- }
- else
- {
- sprintf(buf_log_csucomm, "[Proc_BlockTransferStartReq][Warning] Unexpected block_sequence_number (%d, %d, DEC)\n",
- frame->data[0],
- ShmInternalComm->DownloadImageInfo.block_sequence_number
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->DownloadImageInfo.active = FALSE;
- }
- ShmInternalComm->DownloadImageInfo.block_checksum = frame->data[1];
- }
- else
- {
- ShmInternalComm->DownloadImageInfo.active = FALSE;
- sprintf(buf_log_csucomm,
- "[Proc_BlockTransferStartReq] PresentMsgFlowStatus (%d, DEC) is not in IDLE\n",
- Check_V2G_Flow_Status()
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- DEBUG_PRINTF_CSUCOMM_DETAIL("\n[Proc_BlockTransferStartReq] Got Request from CSU\n");
- sprintf(buf_log_csucomm, "\t - block_sequence_number = %d (DEC)\n\
- \t - block_checksum = %02X (HEX, bytes)\n\n",
- ShmInternalComm->DownloadImageInfo.block_sequence_number,
- ShmInternalComm->DownloadImageInfo.block_checksum
- );
- DEBUG_PRINTF_CSUCOMM_DETAIL(buf_log_csucomm);
- CSUCOMMDC_TASK_FLAG.Got_BlockTransferStartReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_DataTransferRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_DataTransferRes(int Fd)
- {
- //DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][Proc_DataTransferRes]\n");
- //[To-be-implemented] Check Block Checksum, if fail, we should use this response to ask CSU to resend this block again.
- CSUCOMMDC_TASK_FLAG.Got_DataTransferReq = FALSE;
- }
- /*===========================================================================
- FUNCTION: Proc_DataTransferReq
- DESCRIPTION:
- PRE-CONDITION:
- 1. The time interval between each CAN data should be 3ms at least to
- avoid data loss.
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_DataTransferReq(struct can_frame *frame)
- {
- if (Check_V2G_Flow_Status() == IDLE &&
- ShmInternalComm->DownloadImageInfo.active == 1)
- {
- if ((ShmInternalComm->DownloadImageInfo.image_rx_cnt + frame->can_dlc) <= ShmInternalComm->DownloadImageInfo.image_size)
- {
- //Saving Data
- FILE *file;
- file = fopen("/Storage/tmp", "ab+");
- int rlen = 0;
- DEBUG_PRINTF_CSUCOMM_DETAIL("[Proc_DataTransferReq] saving data... (%d bytes, DEC)\n", frame->can_dlc);
- //rlen = fwrite(&frame->data[0], sizeof(unsigned char), frame->can_dlc, ShmInternalComm->DownloadImageInfo.file);
- rlen = fwrite(&frame->data[0], sizeof(unsigned char), frame->can_dlc, file);
- if (rlen == frame->can_dlc)
- {
- fflush(ShmInternalComm->DownloadImageInfo.file);
- DEBUG_PRINTF_CSUCOMM_DETAIL("[Proc_DataTransferReq] fwrite: OK (rlen = %d)\n", rlen);
- ShmInternalComm->DownloadImageInfo.image_rx_cnt += frame->can_dlc;
- }
- else
- {
- DEBUG_PRINTF_CSUCOMM_DETAIL("[Proc_DataTransferReq] fwrite: FAIL (rlen = %d)\n", rlen);
- ShmInternalComm->DownloadImageInfo.active = FALSE;
- }
- fflush(file);
- fclose(file);
- DEBUG_PRINTF_CSUCOMM_DETAIL("\n", ShmInternalComm->DownloadImageInfo.image_rx_cnt);
- //Caculating the Download Percentage
- ShmInternalComm->DownloadImageInfo.downlaod_percentage = (ShmInternalComm->DownloadImageInfo.image_rx_cnt*100)/ShmInternalComm->DownloadImageInfo.image_size;
- if (ShmInternalComm->DownloadImageInfo.downlaod_percentage != ShmInternalComm->DownloadImageInfo.downlaod_percentage_pre)
- {
- sprintf(buf_log_csucomm,
- "[Proc_DataTransferReq] rx: %d\% (%d of %d bytes)\n", //showing the downlaod percentage
- ShmInternalComm->DownloadImageInfo.downlaod_percentage,
- ShmInternalComm->DownloadImageInfo.image_rx_cnt,
- ShmInternalComm->DownloadImageInfo.image_size
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->DownloadImageInfo.downlaod_percentage_pre = ShmInternalComm->DownloadImageInfo.downlaod_percentage;
- }
- }
- else
- {
- ShmInternalComm->DownloadImageInfo.active = FALSE;
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_BlockTransferStartReq] unexpected extra packets\n");
- }
- }
- else
- {
- ShmInternalComm->DownloadImageInfo.active = FALSE;
- sprintf(buf_log_csucomm, "[Proc_BlockTransferStartReq] PresentMsgFlowStatus (%d, DEC) \
- is not in IDLE or active flag (%d, DEC) is canceled\n",
- Check_V2G_Flow_Status(),
- ShmInternalComm->DownloadImageInfo.active
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- //Sending Stop Request to CSU to abort Data Transfer
- //CSUCOMMDC_TASK_FLAG.Send_EVStopReq = TRUE;
- //[To-be-implemented] Adding corresponding alarm code
- }
- CSUCOMMDC_TASK_FLAG.Got_DataTransferReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: Proc_DownloadFinishRes
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Proc_DownloadFinishRes(int Fd)
- {
- int nbytes;
- unsigned char Buffer[1];
- memset(Buffer, 0, sizeof(Buffer));
- //Step 1: Protection for receiving Firmware Update Req in non-IDLE mode
- if (Check_V2G_Flow_Status() != IDLE)
- {
- if (CSUCOMMDC_TASK_FLAG.FW_Update_Task_inused == FALSE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Warning]FW update Req: ignored (only for idle mode)");
- Buffer[0] = FAIL;
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_DOWNLOAD_FINISH, ShmInternalComm->SlaveAddress, 1, Buffer);
- if (nbytes > 0)
- {
- sprintf(buf_log_csucomm, "[Proc_DownloadFinishRes]Tx:ok(%d)", Buffer[0]);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- else
- {
- sprintf(buf_log_csucomm, "[Proc_DownloadFinishRes]Tx:fail(%d)", nbytes);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- return FAIL;
- }
- else if (CSUCOMMDC_TASK_FLAG.FW_Update_Task_inused == TRUE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Warning]FW update Req: ignored (in used, already)");
- //not sending response message, since it stands for end of update process.
- return FAIL;
- }
- else
- {
- sprintf(buf_log_csucomm,
- "[Warning]unexpected FW_Update_Task_inused value(%d)",
- CSUCOMMDC_TASK_FLAG.FW_Update_Task_inused
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- return FAIL;
- }
- }
- //Step 2: Execute the FW update task
- if (CSUCOMMDC_TASK_FLAG.FW_Update_Task_inused == FALSE)
- {
- CSUCOMMDC_TASK_FLAG.FW_Update_Task_inused = TRUE;
- //[VITAL] Closing unneccesary task to supoort rapid CAN data receving..
- SAVE_SYS_LOG_MSG_CSUCOMM("[Proc_DownloadFinishRes] closing SeccComm...");
- system("killall SeccComm");
- system("cd /root;./FWUpdate -w &");
- }
- //Step 3:Sending Response message with result once FW update is done.
- if (CSUCOMMDC_TASK_FLAG.FW_Update_Done == TRUE)
- {
- if (CSUCOMMDC_TASK_FLAG.FW_Update_result == PASS)
- {
- Buffer[0] = PASS;
- }
- else
- {
- Buffer[0] = FAIL;
- }
- nbytes = CAN_Tx_MSG(Fd, CAN_CMD_DOWNLOAD_FINISH, ShmInternalComm->SlaveAddress, 1, Buffer);
- if (nbytes > 0)
- {
- sprintf(buf_log_csucomm, "[Proc_DownloadFinishRes]Tx:ok(%d)", Buffer[0]);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- else
- {
- sprintf(buf_log_csucomm, "[Proc_DownloadFinishRes]Tx:fail(%d)", nbytes);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- sleep(2);
- //system("killall FWUpdate");
- CSUCOMMDC_TASK_FLAG.Got_DownloadFinishReq = FALSE;
-
- Reboot_Process();
-
- return nbytes;
- }
- }
- /*===========================================================================
- FUNCTION: Proc_DownloadFinishReq
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Proc_DownloadFinishReq(struct can_frame *frame)
- {
- CSUCOMMDC_TASK_FLAG.Got_DownloadFinishReq = TRUE;
- }
- /*===========================================================================
- FUNCTION: PRINT_CAN_FRAME
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void PRINT_CAN_FRAME(struct can_frame *frame)
- {
- if (frame->can_dlc != 0)
- {
- int i = 0;
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm] Got CAN Message: \n\
- \t - Length: %d (Bytes, DEC)\n\
- \t - ID: %08X\n\
- \t - Payload: ",
- frame->can_dlc,
- frame->can_id
- );
- for (i = 0; i< frame->can_dlc; i++)
- {
- DEBUG_PRINTF_CSUCOMM_DETAIL("%02X ", frame->data[i]);
- }
- DEBUG_PRINTF_CSUCOMM_DETAIL("\n");
- }
- }
- /*===========================================================================
- FUNCTION: CANRxTimeoutDetector
- DESCRIPTION:
- 1. fork1
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int CANRxTimeoutHandler()
- {
- #if (CAN_RX_TIMEOUT_MECHANISM == ENABLE)
- //#if 1
- if (CSUCOMMDC_TASK_FLAG.matched == TRUE &&
- CSUCOMMDC_TASK_FLAG.CAN_Rx_Timeout == FALSE)
- {
- long int time_diff = 0;
- ftime(&ShmInternalComm->CAN_Rx_Timer_End);
- time_diff = DiffTimeb_CsuComm_fork1(ShmInternalComm->CAN_Rx_Timer_Start, ShmInternalComm->CAN_Rx_Timer_End);
- if(time_diff >= CSUCOMM_CAN_RX_TIMEOUT) //5 sec
- {
- sprintf(buf_log_csucomm_fork1,
- "[fork1][Rx]CAN timeout(%ld of %dms) => reboot",
- time_diff,
- CSUCOMM_CAN_RX_TIMEOUT
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm_fork1);
- //Reboot the CCS Board
- //Update_ShmStatusCode();
- //CCS module communication fail (012248)
- ShmStatusCodeData->PresentStatusCode[0][0] = 0;
- ShmStatusCodeData->PresentStatusCode[0][1] = 1;
- ShmStatusCodeData->PresentStatusCode[0][2] = 2;
- ShmStatusCodeData->PresentStatusCode[0][3] = 2;
- ShmStatusCodeData->PresentStatusCode[0][4] = 4;
- ShmStatusCodeData->PresentStatusCode[0][5] = 8;
- CSUCOMMDC_TASK_FLAG.EV_Stop_Type_Emergency = TRUE;
- CSUCOMMDC_TASK_FLAG.Send_EVStopReq = TRUE;
- CSUCOMMDC_TASK_FLAG.CAN_Rx_Timeout = TRUE;
- Reboot_Process();
- }
- }
- #endif
- }
- /*===========================================================================
- FUNCTION: FWUpdateRebootDetector
- DESCRIPTION:
- 1. fork2
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- /*int FWUpdateRebootHandler()
- {
- if (CSUCOMMDC_TASK_FLAG.FW_Update_Done == TRUE &&
- CSUCOMMDC_TASK_FLAG.Got_DownloadFinishReq == FALSE &&
- CSUCOMMDC_TASK_FLAG.FW_Update_Reboot_inused == FALSE) //wait for CAN Res msg to be sent.
- {
- CSUCOMMDC_TASK_FLAG.FW_Update_Reboot_inused = TRUE;
- sprintf(buf_log_csucomm_fork1,
- "[fork1]FW Update Done(%d) => End_Process",
- CSUCOMMDC_TASK_FLAG.Got_DownloadFinishReq);
- SAVE_SYS_LOG_MSG_EVCOMM(buf_log_csucomm_fork1);
- Reboot_Process();
- }
- }*/
- /*===========================================================================
- FUNCTION: Error_Monitor_CsuComm
- DESCRIPTION:
- 1. fork1
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void Error_Monitor_CsuComm()
- {
- pid_t tmp = 0;
- if(PID_CsuComm_Error_Monitor_Task == 0)
- {
- tmp = fork(); //fork1
- if(tmp > 0)
- {
- PID_CsuComm_Error_Monitor_Task = tmp;
- sprintf(buf_log_csucomm_fork1,
- "[fork2][Error_Monitor]created(%d)",
- PID_CsuComm_Error_Monitor_Task);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm_fork1);
- #if 0
- unsigned char buf[64];
- memset(buf, 0, sizeof(buf));
- sprintf(buf, "renice -20 -p %d", tmp);
- system(buf);
- #endif
- return;
- }
- }
- while(1)
- {
- //CAN comm. Timeout Detector
- CANRxTimeoutHandler();
- //Check for FW Update Reboot Request
- // FWUpdateRebootHandler();
- }
- }
- /*===========================================================================
- FUNCTION: CAN_Rx
- DESCRIPTION:
- 1. fork2
- 2. Receiving Task (indivitual process)
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- void CAN_Rx(int fd)
- {
- pid_t tmp = 0;
- struct can_frame frame;
- int nbytes;
- if(PID_CAN_Rx_Task == 0)
- {
- tmp = fork(); //fork2
- if(tmp > 0)
- {
- PID_CAN_Rx_Task = tmp;
- sprintf(buf_log_csucomm_fork2,
- "[fork2][Error_Monitor]created(%d)",
- PID_CAN_Rx_Task);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm_fork2);
- #if 0
- unsigned char buf[64];
- memset(buf, 0, sizeof(buf));
- sprintf(buf, "renice -20 -p %d", tmp);
- system(buf);
- #endif
- return;
- }
- }
- ftime(&ShmInternalComm->CAN_Rx_Timer_Start); //ID is matched
- while(1) //Process after Matched
- {
- memset(&frame, 0, sizeof(struct can_frame));
- nbytes = read(fd, &frame, sizeof(struct can_frame));
- //For Test (Print Rx Messages)
- //PRINT_CAN_FRAME(&frame);
- //Filtering for legal CAN Rx Message
- if((frame.can_id == 0) || //Null CAN ID
- ((frame.can_id & 0x08000000) == 1) || //Direction
- (((frame.can_id & 0x000000FF) != ShmInternalComm->SlaveAddress) && ((frame.can_id & 0x000000FF) != 0))) //allow its SlaveAddress and Broadcasting Packetes (ID = 0x00)
- {
- continue;
- }
- //--------------------- Legal CAN Rx Message Zone ----------------------
- //CAN comm. Timeout Detector
- ftime(&ShmInternalComm->CAN_Rx_Timer_Start);
- //Extracting and Parsing Legal CAN Message ID (1-Byte)
- switch(frame.can_id & 0x0000FF00)
- {
- case CAN_CMD_ADDRESS_ASSIGN: //0x00000200
- {
- Proc_AddressAssignReq(&frame);
- break;
- }
- case CAN_CMD_GET_FW_VERSION: //0x00000400
- {
- Proc_GetFirmwareVersionReq(&frame);
- break;
- }
- case CAN_CMD_GET_HW_VERSION: //0x00000500
- {
- Proc_HardwareVersionReq(&frame);
- break;
- }
- case CAN_CMD_CHARGING_PERMISSION: //0x00000600
- {
- Proc_ChargingPermissionReq(&frame);
- break;
- }
- case CAN_CMD_EVSE_OUTPUT_STATUS_ANNOUNCEMENT: //0x00000700
- {
- Proc_EVSEOutputStatusUpdateReq(&frame);
- break;
- }
- case CAN_CMD_EVSE_CAPACITY_ANNOUNCEMENT: //0x00000800
- {
- Proc_EVSECapacityUpdateReq(&frame);
- break;
- }
- case CAN_CMD_GET_EV_TARGET_INFO: //0x00000900
- {
- Proc_GetEVTargetReq(&frame);
- break;
- }
- case CAN_CMD_GET_EV_BATTERY_INFO: //0x00000A00
- {
- Proc_GetEVBatteryInfoReq(&frame);
- break;
- }
- case CAN_CMD_EVSE_STOP_EVENT: //0x00000C00
- {
- Proc_EVSEStopReq(&frame);
- break;
- }
- case CAN_CMD_GET_MISC_INFO: //0x00000D00
- {
- Proc_GetMiscellaneousInfoReq(&frame);
- break;
- }
- case CAN_CMD_DOWNLOAD_REQUEST: //0x00000E00
- {
- //Proc_DownloadImageReq(&frame);
- break;
- }
- case CAN_CMD_START_BLOCK_TRANSFER: //0x00000F00
- {
- //Proc_BlockTransferStartReq(&frame);
- break;
- }
- case CAN_CMD_DATA_TRANSFER: //0x00001000
- {
- //Proc_DataTransferReq(&frame);
- break;
- }
- case CAN_CMD_DOWNLOAD_FINISH: //0x00001100
- {
- Proc_DownloadFinishReq(&frame);
- break;
- }
- case CAN_CMD_ISOLATION_STATUS: //0x00001200
- {
- Proc_IsolationStatusAnnounceReq(&frame);
- break;
- }
- case CAN_CMD_CCS_CONNECTOR_INFO: //0x00001300
- {
- Proc_CCSConnectorTypeSetReq(&frame);
- break;
- }
- case CAN_CMD_RTC_INFO: //0x00001400
- {
- Proc_RTCSetReq(&frame);
- break;
- }
- case CAN_CMD_EVSE_PRECHARGE_INFO: //0x00001500
- {
- Proc_EVSEPrechargeInfoUpdateReq(&frame);
- break;
- }
- case CAN_CMD_EVCCID_REQUEST:
- {
- Proc_EVCCIDReq(&frame);
- break;
- }
- default:
- {
- sprintf(buf_log_csucomm_fork2,
- "[fork2][ERROR]Unexpected CAN Command ID: %d (DEC)",
- (frame.can_id & 0x0000FF00));
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm_fork2);
- break;
- }
- }
- }
- }
- /*===========================================================================
- FUNCTION: Eth0_PortSetting
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Eth0_PortSetting_Add(unsigned char addr)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Eth0_PortSetting_Add]start");
- unsigned char cmd[128];
- if ((addr >= 1) && (addr <= 20))
- {
- addr = 20 + addr;
- //Step 0: shutdown eth0
- #if 0
- SAVE_SYS_LOG_MSG_CSUCOMM("[Eth0_PortSetting][eth0:0]down");
- system("/sbin/ifconfig eth0:0 down");
- sleep(1);
- #endif
- //Step 1: IP setting
- sprintf(buf_log_csucomm,
- "[Eth0_PortSetting_Add][eth0:0]IP >> 192.168.0.%d(up))",
- addr);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- sprintf(cmd, "/sbin/ifconfig eth0:0 192.168.0.%d netmask 255.255.255.0 up", addr);
- system(cmd);
- memset(cmd, 0, sizeof(cmd));
- sleep(1);
- sprintf(buf_log_csucomm,
- "[Eth0_PortSetting_Add][eth0:0]done",
- addr);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- return PASS;
- }
- else
- {
- sprintf(buf_log_csucomm,
- "[Eth0_PortSetting_Add][Error]addr(%d) is out of range(1~20)",
- addr);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- return FAIL;
- }
- }
- /*===========================================================================
- FUNCTION: Reboot_Process
- DESCRIPTION:
- 1. fork1
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int Reboot_Process()
- {
- if (CSUCOMMDC_TASK_FLAG.Reboot_Process_inused == FALSE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Reboot_Process]entered");
- CSUCOMMDC_TASK_FLAG.Reboot_Process_inused = TRUE;
- #if (FIRMWARE_VERSION_COMPILE_SETTING_RELEASE_MODE == DISABLE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[Reboot_Process]sync...");
- system("sync");
- }
- #endif
- system("sleep 2");
- system("cd /root;./reboot.sh");
- }
- }
- /*===========================================================================
- FUNCTION: CsuCommAC_GetCcsFirmwareVersion
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- int CsuCommAC_GetCcsFirmwareVersion(unsigned char *buf)
- {
- int i = 0, j = 0, err = PASS, leng = 0;
- unsigned char str[FIRMWARE_VERSION_LENGTH + 1];
- memset(buf, 0, sizeof(buf));
- strcpy(str, FIRMWARE_VERSION);
- leng = FIRMWARE_VERSION_LENGTH + 3;
- if (sizeof(buf) < leng)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[WARNING][CsuCommAC_GetCcsFirmwareVersion]ver size: too long");
- leng = sizeof(buf);
- }
- for(i = 0; i < leng; i++)
- {
- if (str[i] != '_')
- {
- buf[j] = str[i];
- j++;
- }
- }
- return err;
- }
- /*===========================================================================
- FUNCTION: CsuCommAC_Init
- DESCRIPTION:
- 1. Set CCS FW Version
-
- PRE-CONDITION:
- 1. Share Memory should be initialized in advance.
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- /*int CsuCommAC_Init()
- {
- int err = PASS;
- CsuCommAC_GetCcsFirmwareVersion(CSUCOMMAC_SHM.CCSLibRev);
- memset(CSUCOMMAC_SHM.EVCCID, 0, sizeof(CSUCOMMAC_SHM.EVCCID));
- CSUCOMMAC_SHM.PresentMsgFlowStatus = IDLE;
- CSUCOMMAC_SHM.ConnectorLockerStatus = FALSE;
- CSUCOMMAC_SHM.ConnectorTemperature1 = 0;
- CSUCOMMAC_SHM.ConnectorTemperature2 = 0;
- CSUCOMMAC_SHM.TotalBatteryCapacity = 0;
- CSUCOMMAC_SHM.BatteryMaximumVoltage = 0;
- CSUCOMMAC_SHM.BatteryMaximumCurrent = 0;
- CSUCOMMAC_SHM.CCSAlarmStatusCode = 0;
- CSUCOMMAC_SHM.PaymentOption = 0;
- CSUCOMMAC_SHM.EVSEMaxCurrent = 0;
- CSUCOMMAC_SHM.EVSEMinCurrent = 0;
- CSUCOMMAC_SHM.EVOperation = 0;
- CSUCOMMAC_SHM.EVChargeProgress = 0;
- CSUCOMMAC_SHM.CpSetPWMDuty = 0;
- CSUCOMMAC_SHM.CpSetStateE = 0;
- CSUCOMMAC_SHM.CcsHeartBeat = 0;
- return err;
- }*/
- /*===========================================================================
- FUNCTION: CsuCommAC_HeartBeat_Handler
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- /*int CsuCommAC_HeartBeat_Handler()
- {
- static unsigned int tmp = 0;
- if (tmp == 0)
- {
- tmp = time(NULL);
- }
- else
- {
- if ((time(NULL) - tmp) >= 1) //1 sec
- {
- CSUCOMMAC_SHM.CcsHeartBeat++;
- tmp = 0;
- //sprintf(buf_log_csucomm, "[CcsHeartBeat]%d", CSUCOMMAC_SHM.CcsHeartBeat);
- //SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- if (CSUCOMMAC_SHM.CcsHeartBeat >= 60) //timeout: 60 sec
- {
- sprintf(buf_log_csucomm,
- "[WARNING]CSU Comm: Fail(%d)",
- CSUCOMMAC_SHM.CcsHeartBeat);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- //[To-Do] Reboot or Send Error Code (TBD)
- }
- }
- }
- }*/
- /*===========================================================================
- FUNCTION: CsuCommAC_SHM_Rx_Update
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- #ifdef AWCCS
- int CsuCommAC_SHM_Rx_Update()
- {
- int gun_index=0;
- //[CAUTION] Re-initializing process is necessary. (to-be implemented)
- ShmCharger->gun_info[gun_index].acCcsInfo.PresentMsgFlowStatus=Check_V2G_Flow_Status();
- ShmCharger->gun_info[gun_index].acCcsInfo.EVChargeProgress = ShmCcsData->V2GMessage_ISO15118_2014.PowerDeliveryRequest.ChargeProgress;
- ShmCharger->gun_info[gun_index].acCcsInfo.CpSetPWMDuty=ShmSysConfigAndInfo->SysInfo.CcsChargingData[0].CpDuty;
- //----------[1] Permission --------
- // ShmInternalComm->ChargingPermission_new = (unsigned char) CSUCOMMAC_SHM.ChargingPermission;
- ShmInternalComm->ChargingPermission_new=ShmCharger->gun_info[gun_index].acCcsInfo.ChargingPermission;
- if (ShmInternalComm->ChargingPermission_new != ShmInternalComm->ChargingPermission)
- {
- sprintf(buf_log_csucomm, "Permission: %d >> %d",
- ShmInternalComm->ChargingPermission,
- ShmInternalComm->ChargingPermission_new
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->ChargingPermission_pre = ShmInternalComm->ChargingPermission;
- ShmInternalComm->ChargingPermission = ShmInternalComm->ChargingPermission_new;
- }
- #if 1
- // -------- [2] CpPresentPWMDuty --------
- ShmInternalComm->AC_CpPresentPWMDuty = ShmCharger->gun_info[gun_index].primaryMcuCp_Pwn_Duty.max_current; //unit: 1 sec.
- if (ShmInternalComm->AC_CpPresentPWMDuty_pre != ShmInternalComm->AC_CpPresentPWMDuty)
- {
- sprintf(buf_log_csucomm, "CP Duty(real): %d >> %d (1\%)",
- ShmInternalComm->AC_CpPresentPWMDuty_pre,
- ShmInternalComm->AC_CpPresentPWMDuty
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_CpPresentPWMDuty_pre = ShmInternalComm->AC_CpPresentPWMDuty;
- }
- #endif
-
- // -------- [3] CpPresentState --------
- //ShmInternalComm->AC_CpPresentState = CSUCOMMAC_SHM.CpPresentState; //unit: 1 sec.
- ShmInternalComm->AC_CpPresentState=ShmCharger->gun_info[gun_index].acCcsInfo.CpPresentState;
- if (ShmInternalComm->AC_CpPresentState_pre != ShmInternalComm->AC_CpPresentState)
- {
- sprintf(buf_log_csucomm, "CP State: %d >> %d",
- ShmInternalComm->AC_CpPresentState_pre,
- ShmInternalComm->AC_CpPresentState
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_CpPresentState_pre = ShmInternalComm->AC_CpPresentState;
- }
- #if 0
- // -------- [4] ChargingRemainTime --------
- ShmInternalComm->AC_ChargingRemainTime = CSUCOMMAC_SHM.ChargingRemainTime; //unit: 1 sec.
- if (ShmInternalComm->AC_ChargingRemainTime_pre != ShmInternalComm->AC_ChargingRemainTime)
- {
- sprintf(buf_log_csucomm, "ChargingRemainTime: %d >> %d (1 sec)",
- ShmInternalComm->AC_ChargingRemainTime_pre,
- ShmInternalComm->AC_ChargingRemainTime
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_ChargingRemainTime_pre = ShmInternalComm->AC_ChargingRemainTime;
- }
- #endif
- // -------- [5] CSUAlarmStatusCode --------
- //ShmInternalComm->AC_CSUAlarmStatusCode = CSUCOMMAC_SHM.CSUAlarmStatusCode;
- ShmInternalComm->AC_CSUAlarmStatusCode = ShmCharger->gun_info[gun_index].acCcsInfo.CSUAlarmStatusCode;
- if (ShmInternalComm->AC_CSUAlarmStatusCode_pre != ShmInternalComm->AC_CSUAlarmStatusCode)
- {
- sprintf(buf_log_csucomm, "CSUAlarmStatusCode: %X >> %X (1V)",
- ShmInternalComm->AC_CSUAlarmStatusCode_pre,
- ShmInternalComm->AC_CSUAlarmStatusCode
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_CSUAlarmStatusCode_pre = ShmInternalComm->AC_CSUAlarmStatusCode;
- }
- // -------- [6] MeterReadingValue --------
- // ShmInternalComm->AC_MeterReadingValue = CSUCOMMAC_SHM.MeterReadingValue; //unit: 1WH
- ShmInternalComm->AC_MeterReadingValue=((float)ShmCharger->gun_info[gun_index].powerConsumptionTotal.power_consumption/10.0);
- /* if (ShmInternalComm->AC_MeterReadingValue_pre != ShmInternalComm->AC_MeterReadingValue)
- {
- sprintf(buf_log_csucomm, "MeterReadingValue(Power): %.02f >> %.02f (1V)",
- ShmInternalComm->AC_MeterReadingValue_pre,
- ShmInternalComm->AC_MeterReadingValue
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_MeterReadingValue_pre = ShmInternalComm->AC_MeterReadingValue;
- }*/
- // -------- [7] CpPositiveVoltage --------
- //ShmInternalComm->AC_CpPositiveVoltage = CSUCOMMAC_SHM.CpPositiveVoltage; //unit: 1V
- ShmInternalComm->AC_CpPositiveVoltage=ShmCharger->gun_info[gun_index].acCcsInfo.CpPositiveVoltage;
- //the modification message will be logged via Check_CP_State_Update_fork1() in SeccComm task.
- if (abs(ShmInternalComm->AC_CpPositiveVoltage_pre - ShmInternalComm->AC_CpPositiveVoltage)>=0.5)
- {
- sprintf(buf_log_csucomm, "CP_P_V: %.02f >> %.02f (1V)",
- ShmInternalComm->AC_CpPositiveVoltage_pre,
- ShmInternalComm->AC_CpPositiveVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_CpPositiveVoltage_pre = ShmInternalComm->AC_CpPositiveVoltage;
- }
- // -------- [8] CpNegativeVoltage --------
- //ShmInternalComm->AC_CpNegativeVoltage = CSUCOMMAC_SHM.CpNegativeVoltage; //unit: 1V
- ShmInternalComm->AC_CpNegativeVoltage = ShmCharger->gun_info[gun_index].acCcsInfo.CpNegativeVoltage; //unit: 1V
- if (abs(ShmInternalComm->AC_CpNegativeVoltage_pre - ShmInternalComm->AC_CpNegativeVoltage>=0.5))
- {
- sprintf(buf_log_csucomm, "CP_N_V: - %.02f >> - %.02f (1V)",
- ShmInternalComm->AC_CpNegativeVoltage_pre,
- ShmInternalComm->AC_CpNegativeVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_CpNegativeVoltage_pre = ShmInternalComm->AC_CpNegativeVoltage;
- }
- // -------- [9] I_now: EVSEPresentCurrent[3] --------
- // memcpy(ShmInternalComm->AC_EVSEPresentCurrent, CSUCOMMAC_SHM.EVSEPresentCurrent, 3); //unit: 1A
- //EVCOMM_SYS_INFO.PresentChargingCurrent = ShmInternalComm->AC_EVSEPresentCurrent[0]; //unit: 1A (using phase L)
- //ShmInternalComm->PresentChargingCurrent = (int)(ShmInternalComm->AC_EVSEPresentCurrent[0] * 10); //unit: 0.1A
- EVCOMM_SYS_INFO.PresentChargingCurrent = (float)ShmCharger->gun_info[gun_index].outputCurrent.L1N_L12[0]; //unit: 1A (using phase L)
- ShmInternalComm->PresentChargingCurrent = (float)ShmCharger->gun_info[gun_index].outputCurrent.L1N_L12[0] * 10;
- ShmInternalComm->AC_EVSEPresentCurrent[0] = (float)ShmCharger->gun_info[gun_index].outputCurrent.L1N_L12[0]; //L1
- ShmInternalComm->AC_EVSEPresentCurrent[1] = (float)ShmCharger->gun_info[gun_index].outputCurrent.L2N_L23[0]; //L2
- ShmInternalComm->AC_EVSEPresentCurrent[2] = (float)ShmCharger->gun_info[gun_index].outputCurrent.L3N_L31[0]; //L3
- if ((ShmInternalComm->AC_EVSEPresentCurrent[0] != ShmInternalComm->AC_EVSEPresentCurrent[0]) ||
- (ShmInternalComm->AC_EVSEPresentCurrent[1] != ShmInternalComm->AC_EVSEPresentCurrent[1]) ||
- (ShmInternalComm->AC_EVSEPresentCurrent[2] != ShmInternalComm->AC_EVSEPresentCurrent[2])
- )
- {
- if ((abs(ShmInternalComm->AC_EVSEPresentCurrent_pre[0] - ShmInternalComm->AC_EVSEPresentCurrent[0]) > 10) || //10/;1A
- (abs(ShmInternalComm->AC_EVSEPresentCurrent_pre[1] - ShmInternalComm->AC_EVSEPresentCurrent[1]) > 10) || //10/;1A
- (abs(ShmInternalComm->AC_EVSEPresentCurrent_pre[2] - ShmInternalComm->AC_EVSEPresentCurrent[2]) > 10) //10/;1A
- )
- {
- sprintf(buf_log_csucomm, "I_now(EVSE): (%.02f,%.02f,%.02f) >> (%.02f,%.02f,%.02f) (1A)",
- ShmInternalComm->AC_EVSEPresentCurrent_pre[0],
- ShmInternalComm->AC_EVSEPresentCurrent_pre[1],
- ShmInternalComm->AC_EVSEPresentCurrent_pre[2],
- ShmInternalComm->AC_EVSEPresentCurrent[0],
- ShmInternalComm->AC_EVSEPresentCurrent[1],
- ShmInternalComm->AC_EVSEPresentCurrent[2]
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- ShmInternalComm->PresentChargingCurrent_pre = ShmInternalComm->PresentChargingCurrent;
- memcpy(ShmInternalComm->AC_EVSEPresentCurrent_pre, ShmInternalComm->AC_EVSEPresentCurrent, sizeof(ShmInternalComm->AC_EVSEPresentCurrent));
- }
- //-------- [10] OutputRelayStatus --------
- //ShmInternalComm->AC_OutputRelayStatus = CSUCOMMAC_SHM.OutputRelayStatus; //bool
- ShmInternalComm->AC_OutputRelayStatus= ShmCharger->gun_info[gun_index].acCcsInfo.OutputRelayStatus;
- if (ShmInternalComm->AC_OutputRelayStatus_pre != ShmInternalComm->AC_OutputRelayStatus)
- {
- sprintf(buf_log_csucomm, "RelayON: %d >> %d",
- ShmInternalComm->AC_OutputRelayStatus_pre,
- ShmInternalComm->AC_OutputRelayStatus
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_OutputRelayStatus_pre = ShmInternalComm->AC_OutputRelayStatus;
- }
-
- // -------- [11] GridVoltage (EVSENominalVoltage) --------
- //EVCOMM_SYS_INFO.AC_EVSENominalVoltage = CSUCOMMAC_SHM.GridVoltage[0]; //unit: 1V
- //memcpy(ShmInternalComm->AC_GridVoltage, CSUCOMMAC_SHM.GridVoltage, 3); //unit: 1V
- EVCOMM_SYS_INFO.AC_EVSENominalVoltage = ShmCharger->gun_info[gun_index].acCcsInfo.GridVoltage[0] ;
- ShmInternalComm->AC_GridVoltage[0]=ShmCharger->gun_info[gun_index].acCcsInfo.GridVoltage[0];
- ShmInternalComm->AC_GridVoltage[1]=ShmCharger->gun_info[gun_index].acCcsInfo.GridVoltage[1] ;
- ShmInternalComm->AC_GridVoltage[2]=ShmCharger->gun_info[gun_index].acCcsInfo.GridVoltage[2] ;
- if ((abs(ShmInternalComm->AC_GridVoltage_pre[0] - ShmInternalComm->AC_GridVoltage[0])>=10) ||
- (abs(ShmInternalComm->AC_GridVoltage_pre[0] - ShmInternalComm->AC_GridVoltage[0])>=10) ||
- (abs(ShmInternalComm->AC_GridVoltage_pre[0] - ShmInternalComm->AC_GridVoltage[0])>=10)
- )
- {
- sprintf(buf_log_csucomm, "V_grid: (%.02f,%.02f,%.02f) >> (%.02f,%.02f,%.02f) (1V)",
- ShmInternalComm->AC_GridVoltage_pre[0],
- ShmInternalComm->AC_GridVoltage_pre[1],
- ShmInternalComm->AC_GridVoltage_pre[2],
- ShmInternalComm->AC_GridVoltage[0],
- ShmInternalComm->AC_GridVoltage[1],
- ShmInternalComm->AC_GridVoltage[2]
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- memcpy(ShmInternalComm->AC_GridVoltage_pre, ShmInternalComm->AC_GridVoltage, sizeof(ShmInternalComm->AC_GridVoltage));
- }
- // -------- [12] V_now --------
- if (ShmInternalComm->AC_OutputRelayStatus == ENABLE)
- {
- EVCOMM_SYS_INFO.PresentChargingVoltage = ShmInternalComm->AC_GridVoltage[0]; //unit: 1V (using phase 1)
- ShmInternalComm->PresentChargingVoltage = (int)(ShmInternalComm->AC_GridVoltage[0] * 10); //unit: 0.1V (using phase 1)
- }
- else
- {
- EVCOMM_SYS_INFO.PresentChargingVoltage = 0;
- ShmInternalComm->PresentChargingVoltage = 0;
- }
-
- if (ShmInternalComm->PresentChargingVoltage_pre != ShmInternalComm->PresentChargingVoltage)
- {
- if (abs(ShmInternalComm->PresentChargingVoltage_pre - ShmInternalComm->PresentChargingVoltage) >= 10) //10:1V
- {
- sprintf(buf_log_csucomm, "V_now(EVSE): %d >> %d (0.1V, DEC)",
- ShmInternalComm->PresentChargingVoltage_pre,
- ShmInternalComm->PresentChargingVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- }
- ShmInternalComm->PresentChargingVoltage_pre = ShmInternalComm->PresentChargingVoltage;
- }
- // -------- [13] P_now --------
- EVCOMM_SYS_INFO.PresentChargingPower = (EVCOMM_SYS_INFO.PresentChargingVoltage * EVCOMM_SYS_INFO.PresentChargingCurrent)/1000; //1KW
- ShmInternalComm->PresentChargingPower = (int)(EVCOMM_SYS_INFO.PresentChargingPower * 10); //0.1KW
- if (ShmInternalComm->PresentChargingPower_pre != ShmInternalComm->PresentChargingPower)
- {
- sprintf(buf_log_csucomm, "P_now(EVSE): %d >> %d (0.1KW)",
- ShmInternalComm->PresentChargingPower_pre,
- ShmInternalComm->PresentChargingPower);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->PresentChargingPower_pre = ShmInternalComm->PresentChargingPower;
- }
- // -------- [14] I_max (EVSE)--------
- //EVCOMM_SYS_INFO.AvailableChargingCurrent = CSUCOMMAC_SHM.EVSEMaxCurrent; //unit: 1A
- //ShmInternalComm->AvailableChargingCurrent = (int)(CSUCOMMAC_SHM.EVSEMaxCurrent *10); //unit: 0.1A
- EVCOMM_SYS_INFO.AvailableChargingCurrent = ShmCharger->gun_info[gun_index].targetCurrent;; //unit: 1A
- ShmInternalComm->AvailableChargingCurrent = (int)(ShmCharger->gun_info[gun_index].targetCurrent*10); //unit: 0.1A
- ShmInternalComm->AC_EVSEMaxCurrent=ShmCharger->gun_info[gun_index].primaryMcuState.rating_current;
- if (ShmInternalComm->AvailableChargingCurrent_pre != ShmInternalComm->AvailableChargingCurrent)
- {
- sprintf(buf_log_csucomm, "I_max(EVSE): %d >> %d (0.1A)",
- ShmInternalComm->AvailableChargingCurrent_pre,
- ShmInternalComm->AvailableChargingCurrent);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AvailableChargingCurrent_pre = ShmInternalComm->AvailableChargingCurrent;
- }
- #if 0
- // -------- [15] I_min (EVSE)--------
- ShmInternalComm->AC_EVSEMinCurrent = CSUCOMMAC_SHM.EVSEMinCurrent; //unit: 1A
- if (ShmInternalComm->AC_EVSEMinCurrent_pre != ShmInternalComm->AC_EVSEMinCurrent)
- {
- sprintf(buf_log_csucomm, "I_min(EVSE): %.02f >> %.02f (1A)",
- ShmInternalComm->AC_EVSEMinCurrent_pre,
- ShmInternalComm->AC_EVSEMinCurrent);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_EVSEMinCurrent_pre = ShmInternalComm->AC_EVSEMinCurrent;
- }
-
- // -------- [16] V_max --------
- //EVCOMM_SYS_INFO.MaximumChargingVoltage = CSUCOMMAC_SHM.GridVoltage[0]; //unit: 1V (using phase 1)
- //ShmInternalComm->MaximumChargingVoltage = (int)(CSUCOMMAC_SHM.GridVoltage[0] * 10); //unit: 0.1V (using phase 1)
- EVCOMM_SYS_INFO.MaximumChargingVoltage =ShmCharger->gun_info[gun_index].acCcsInfo.GridVoltage[0]; //unit: 1V (using phase 1)
- ShmInternalComm->MaximumChargingVoltage = (int)(ShmCharger->gun_info[gun_index].acCcsInfo.GridVoltage[0]* 10); //unit: 0.1V (using phase 1)
- if (ShmInternalComm->MaximumChargingVoltage_pre != ShmInternalComm->MaximumChargingVoltage)
- {
- sprintf(buf_log_csucomm, "V_max(EVSE): %d >> %d (0.1V, DEC)",
- ShmInternalComm->MaximumChargingVoltage_pre,
- ShmInternalComm->MaximumChargingVoltage
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->MaximumChargingVoltage_pre = ShmInternalComm->MaximumChargingVoltage;
- }
-
- // -------- [17] P_max --------
- ShmInternalComm->AC_AvailableChargingPower = CSUCOMMAC_SHM.AvailableChargingPower; //unit: 1KW
- EVCOMM_SYS_INFO.AvailableChargingPower = ShmInternalComm->AC_AvailableChargingPower; //1KW
- ShmInternalComm->AvailableChargingPower = (int)(ShmInternalComm->AC_AvailableChargingPower * 10); //unit: 0.1KW
- if (ShmInternalComm->AvailableChargingPower_pre != ShmInternalComm->AvailableChargingPower)
- {
- sprintf(buf_log_csucomm, "P_max(EVSE): %d >> %d (0.1KW)",
- ShmInternalComm->AvailableChargingPower_pre,
- ShmInternalComm->AvailableChargingPower);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AvailableChargingPower_pre = ShmInternalComm->AvailableChargingPower;
- }
-
- // -------- [18] EVSEID[40] --------
- memcpy(ShmInternalComm->AC_EVSEID, CSUCOMMAC_SHM.EVSEID, 40);
- if (Array_Compare_Identity(ShmInternalComm->AC_EVSEID, CSUCOMMAC_SHM.EVSEID, 40) == FALSE)
- {
- sprintf(buf_log_csucomm, "EVSEID: [%02X %02X %02X %02X %02X %02X...] >> [%02X %02X %02X %02X %02X %02X...]",
- ShmInternalComm->AC_EVSEID_pre[0],
- ShmInternalComm->AC_EVSEID_pre[1],
- ShmInternalComm->AC_EVSEID_pre[2],
- ShmInternalComm->AC_EVSEID_pre[3],
- ShmInternalComm->AC_EVSEID_pre[4],
- ShmInternalComm->AC_EVSEID_pre[5],
- ShmInternalComm->AC_EVSEID[0],
- ShmInternalComm->AC_EVSEID[1],
- ShmInternalComm->AC_EVSEID[2],
- ShmInternalComm->AC_EVSEID[3],
- ShmInternalComm->AC_EVSEID[4],
- ShmInternalComm->AC_EVSEID[5]
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- memcpy(ShmInternalComm->AC_EVSEID_pre, ShmInternalComm->AC_EVSEID, 40);
- }
- #endif
-
- // -------- [19] MeterID[32] --------
- if(strlen(ShmInternalComm->AC_MeterID)<=1)
- {
- // memcpy(ShmInternalComm->AC_MeterID, CSUCOMMAC_SHM.MeterID, 32);
- memset(ShmInternalComm->AC_MeterID, 0, sizeof(ShmInternalComm->AC_MeterID));
- sprintf(ShmInternalComm->AC_MeterID,"%s_%s",ShmCharger->evseId.model_name,ShmCharger->evseId.serial_number);
- /* if (Array_Compare_Identity(ShmInternalComm->AC_MeterID, CSUCOMMAC_SHM.MeterID, 32) == FALSE)
- {
- sprintf(buf_log_csucomm, "MeterID: [%02X %02X %02X %02X %02X %02X...] >> [%02X %02X %02X %02X %02X %02X...]",
- ShmInternalComm->AC_MeterID_pre[0],
- ShmInternalComm->AC_MeterID_pre[1],
- ShmInternalComm->AC_MeterID_pre[2],
- ShmInternalComm->AC_MeterID_pre[3],
- ShmInternalComm->AC_MeterID_pre[4],
- ShmInternalComm->AC_MeterID_pre[5],
- ShmInternalComm->AC_MeterID[0],
- ShmInternalComm->AC_MeterID[1],
- ShmInternalComm->AC_MeterID[2],
- ShmInternalComm->AC_MeterID[3],
- ShmInternalComm->AC_MeterID[4],
- ShmInternalComm->AC_MeterID[5]
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
-
- memcpy(ShmInternalComm->AC_MeterID_pre, ShmInternalComm->AC_MeterID_pre, 32);
- }*/
- }
- // -------- [20] EVSEModelName[32] --------
- if(strlen(ShmInternalComm->AC_EVSEModelName)<=1)
- {
- // memcpy(ShmInternalComm->AC_EVSEModelName, CSUCOMMAC_SHM.EVSEModelName, 32);
- memset(ShmInternalComm->AC_EVSEModelName, 0, sizeof(ShmInternalComm->AC_EVSEModelName));
- strcpy(ShmInternalComm->AC_EVSEModelName,ShmCharger->evseId.model_name);
- /* if (Array_Compare_Identity(ShmInternalComm->AC_EVSEModelName, CSUCOMMAC_SHM.EVSEModelName, 32) == FALSE)
- {
- sprintf(buf_log_csucomm, "EVSEModelName: [%02X %02X %02X %02X %02X %02X...] >> [%02X %02X %02X %02X %02X %02X...]",
- ShmInternalComm->AC_EVSEModelName_pre[0],
- ShmInternalComm->AC_EVSEModelName_pre[1],
- ShmInternalComm->AC_EVSEModelName_pre[2],
- ShmInternalComm->AC_EVSEModelName_pre[3],
- ShmInternalComm->AC_EVSEModelName_pre[4],
- ShmInternalComm->AC_EVSEModelName_pre[5],
- ShmInternalComm->AC_EVSEModelName[0],
- ShmInternalComm->AC_EVSEModelName[1],
- ShmInternalComm->AC_EVSEModelName[2],
- ShmInternalComm->AC_EVSEModelName[3],
- ShmInternalComm->AC_EVSEModelName[4],
- ShmInternalComm->AC_EVSEModelName[5]
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
-
- memcpy(ShmInternalComm->AC_EVSEModelName_pre, ShmInternalComm->AC_EVSEModelName_pre, 32);
- }*/
- }
- #if 0
- // -------- [21] BatteryChargeType --------
- ShmInternalComm->AC_BatteryChargeType = CSUCOMMAC_SHM.BatteryChargeType;
- if (ShmInternalComm->AC_BatteryChargeType_pre != ShmInternalComm->AC_BatteryChargeType)
- {
- sprintf(buf_log_csucomm, "BatteryChargeType: %d >> %d",
- ShmInternalComm->AC_BatteryChargeType_pre,
- ShmInternalComm->AC_BatteryChargeType
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_BatteryChargeType_pre = ShmInternalComm->AC_BatteryChargeType;
- }
- #endif
- // -------- [21] RcdStatus --------
- //ShmInternalComm->AC_RcdStatus = CSUCOMMAC_SHM.RcdStatus;
- ShmInternalComm->AC_RcdStatus=ShmCharger->gun_info[gun_index].otherAlarmCode.isACLeakage;
- if (ShmInternalComm->AC_RcdStatus_pre != ShmInternalComm->AC_RcdStatus)
- {
- sprintf(buf_log_csucomm, "RCDStatus: %d >> %d",
- ShmInternalComm->AC_RcdStatus_pre,
- ShmInternalComm->AC_RcdStatus
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_RcdStatus_pre = ShmInternalComm->AC_RcdStatus;
- }
- #if 0
- // -------- [22] EVSENotification --------
- ShmInternalComm->AC_EVSENotification = CSUCOMMAC_SHM.EVSENotification;
- if (ShmInternalComm->AC_EVSENotification_pre != ShmInternalComm->AC_EVSENotification)
- {
- sprintf(buf_log_csucomm, "AC_EVSENotification: %d >> %d",
- ShmInternalComm->AC_EVSENotification_pre,
- ShmInternalComm->AC_EVSENotification
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- ShmInternalComm->AC_EVSENotification_pre = ShmInternalComm->AC_EVSENotification;
- }
- #endif
- }
- #endif
- /*===========================================================================
- FUNCTION: CsuCommAC_Error_Monitor
- DESCRIPTION:
- 1. fork1
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- /*void CsuCommAC_Error_Monitor()
- {
- pid_t tmp = 0;
- if(PID_CsuComm_Error_Monitor_Task == 0)
- {
- tmp = fork(); //fork1
- if(tmp > 0)
- {
- PID_CsuComm_Error_Monitor_Task = tmp;
- sprintf(buf_log_csucomm_fork1,
- "[fork2][Error_Monitor]created(%d)",
- PID_CsuComm_Error_Monitor_Task);
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm_fork1);
- #if 0
- unsigned char buf[64];
- memset(buf, 0, sizeof(buf));
- sprintf(buf, "renice -20 -p %d", tmp);
- system(buf);
- #endif
- return;
- }
- }
- while(1)
- {
- CsuCommAC_HeartBeat_Handler(); //timeout: 60s
- }
- }*/
- /*===========================================================================
- FUNCTION: CsuCommAC_Proc
- DESCRIPTION:
- PRE-CONDITION:
- 1. Share Memory should be initialized in advance.
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- =============================================================================*/
- #ifdef AWCCS
- int CsuCommAC_Proc()
- {
- //CsuCommAC_Init();
- //CsuCommAC_Error_Monitor(); //fork1
- while(1)
- {
- CsuCommAC_SHM_Rx_Update();
- usleep(100000);
- }
- }
- #endif
- void CheckID()
- {
- unsigned char BoardId;
- unsigned char buf[64];
-
- BoardId=(Get_GPIO_Value(GPIO_2_23_AM_IO_1) + 1) & 0x000000FF;//auto detect GPIO
- if(ShmInternalComm->SlaveAddress == BoardId)
- return;
-
- memset(buf,0,sizeof(buf));
- sprintf(buf,"SlaveAddress from %d to %d\n",ShmInternalComm->SlaveAddress,BoardId);
- ShmInternalComm->SlaveAddress = BoardId;
- SAVE_SYS_LOG_MSG_CSUCOMM(buf);
- CSUCOMMDC_TASK_FLAG.matched = TRUE;
-
- //Changing the eth0 to 192.168.1.20 + ID
- #if (DYNAMIC_ETH0_IP_MECHANISM == ENABLE)
- Eth0_PortSetting_Add(ShmInternalComm->SlaveAddress);
- #endif
- }
- /*===========================================================================
- FUNCTION: main
- DESCRIPTION:
- PRE-CONDITION:
- INPUT:
- OUTPUT:
- GLOBAL VARIABLES:
- 1. PID_CAN_Rx_Task
- =============================================================================*/
- int main(int argc, char *argv[])
- {
- // ======== [STEP 1/5] Initialize Share Memory ========
- if(ShareMemory_Init() == 0)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("[main]ShareMemory_Init NG");
- if(ShmStatusCodeData != NULL)
- {
- ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory = 1;
- }
- sleep(5);
- return 0;
- }
- #if ((CCS_ENERGY_TRANSFER_MODE == MODE_AC_SINGLE_PHASE_CORE) || (CCS_ENERGY_TRANSFER_MODE == MODE_AC_THREE_PHASE_CORE))
- {
- sprintf(buf_log_csucomm,
- "========= CCS: AC (%d)=========",
- CCS_ENERGY_TRANSFER_MODE
- );
- SAVE_SYS_LOG_MSG_CSUCOMM(buf_log_csucomm);
- CsuCommAC_Proc();
-
- while (1)
- {
- //null
- }
- }
- #endif
- int FD_CAN_Socket; //Socket File Descriptor
- struct can_frame frame;
- unsigned int value_random;
- unsigned char can_tx_payload[8];
- // ======== [STEP 2/5] Initialize CAN BUS ========
- FD_CAN_Socket = CANBus_Init();
- ShmInternalComm->FD_CAN_Socket = FD_CAN_Socket;
- PID_CAN_Rx_Task = 0;
- ShmInternalComm->SlaveAddress = 0xFF; //unmatched
- CSUCOMMDC_TASK_FLAG.matched = FALSE;
- //Sniffering CAN packets
- Sniffer_Candump(ENABLE);
- Error_Monitor_CsuComm(); //fork1
- #if 0 //disable ID assignmemt
- ftime(&ShmInternalComm->Start_Time);
- srandom(ShmInternalComm->Start_Time.millitm);
- value_random = random();
- value_random &= 0xFFFFFF00;
- value_random |= 0x000000CC; //adding a specific header for identification of CCS.
- // ======== [STEP 3/5] Request for A Slave Address ========
- while(ShmInternalComm->SlaveAddress == 0xFF)
- {
- ftime(&ShmInternalComm->Start_Time);
- // srandom(ShmInternalComm->Start_Time.millitm);
- // value_random = random();
- // value_random &= 0xFFFFFF00;
- // value_random |= 0x000000CC; //adding a specific header for identification of CCS.
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][main] value_random = %08X (4 Bytes, HEX)\n", value_random);
- memset(can_tx_payload, 0, sizeof(can_tx_payload));
- memcpy(can_tx_payload, &value_random, sizeof(int));
- //for test
- #if (CAN_RAMDOM_MATCHING_ID_MECHANISM == DISABLE)
- value_random = 0xC3B2A1CC;
- memset(can_tx_payload, 0, sizeof(can_tx_payload));
- memcpy(can_tx_payload, &value_random, sizeof(int));
- //can_tx_payload[0] = 0xA1;
- //can_tx_payload[1] = 0xB2;
- //can_tx_payload[2] = 0xC3;
- //can_tx_payload[3] = 0xD4;
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][main] replaced random number = %02X %02X %02X %02X (4 Bytes, HEX)\n",
- can_tx_payload[0],
- can_tx_payload[1],
- can_tx_payload[2],
- can_tx_payload[3],
- can_tx_payload[4]);
- #endif
- can_tx_payload[4] = Get_GPIO_Value(GPIO_2_23_AM_IO_1) + 1; //auto detect GPIO
- //can_tx_payload[4] = 0x01; //(to be implemented: auto detect GPIO)
- //0x01:connector 1
- //0x02:connector 2
- CAN_Tx_MSG(FD_CAN_Socket, CAN_CMD_ADDRESS_REQUEST, ShmInternalComm->SlaveAddress, 5, can_tx_payload);
- ftime(&ShmInternalComm->End_Time);
- //Here is the process after sending the CAN message (t = 0 to t = 100ms)
- while(DiffTimeb(ShmInternalComm->Start_Time, ShmInternalComm->End_Time) < 1000)//resend interval: 1000ms
- {
- unsigned int value_random_return = 0; //4 Bytes
-
- memset(&frame, 0, sizeof(struct can_frame));
- read(FD_CAN_Socket, &frame, sizeof(struct can_frame));
- ftime(&ShmInternalComm->End_Time);
- PRINT_CAN_FRAME(&frame);
- if( (frame.can_id == 0) || //all zero
- (frame.can_id & 0x08000000) || //to avoid incoreect DIRECTION bit
- ((frame.can_id & 0x0000FF00) != CAN_CMD_ADDRESS_ASSIGN) || //the 1st command ID from Master should be 0x02
- (frame.can_dlc != 5)) //payload length should be only 5 bytes.
- {
- continue;
- }
- memcpy(&value_random_return, frame.data, sizeof(int)); //only copy the previous 4 bytes
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][main] ori = %X, return = %X (HEX)\n", value_random, value_random_return);
- if(value_random_return == value_random)
- {
- //Getting a legal Slave Address, successfully.
- ShmInternalComm->SlaveAddress = frame.can_id & 0x000000FF;
- CSUCOMMDC_TASK_FLAG.matched = TRUE;
- #if (SAVE_SYS_LOG_MSG_CSUCOMM_SWITCH == ENABLE)
- {
- SAVE_SYS_LOG_MSG_CSUCOMM("Matched");
- }
- #endif
- DEBUG_PRINTF_CSUCOMM_DETAIL("[CsuComm][main] ShmInternalComm->SlaveAddres = %02X (1 Byte, HEX)\t(Matched NOW.)\n", ShmInternalComm->SlaveAddress);
- //Changing the eth0 to 192.168.1.20 + ID
- #if (DYNAMIC_ETH0_IP_MECHANISM == ENABLE)
- Eth0_PortSetting_Add(ShmInternalComm->SlaveAddress);
- #endif
- break;
- }
- }
- }
- #else
- sleep(5);
- CheckID();
- #endif
- // ======== [STEP 4/5] CAN RX ========
- CAN_Rx(FD_CAN_Socket); //precondition: matched already
- //Here is a indivitual process/task which is dealing with all CAN message and commands.
- // ======== [STEP 5/5] CAN TX ========
- //main loop
- ftime(&ShmInternalComm->Start_Time);
- while(1)
- {
- /*
- //CAN_CMD_ADDRESS_REQUEST 0x00000100
- if (CSUCOMMDC_TASK_FLAG.matched == TRUE)
- {
- //Proc_Match(FD_CAN_Socket);
- //CSUCOMMDC_TASK_FLAG.matched = FALSE;
- }
- //CAN_CMD_ADDRESS_ASSIGN 0x00000200
- if (CSUCOMMDC_TASK_FLAG.Got_AssignedAddress == TRUE)
- {
- //Proc_AddressAssignRes(FD_CAN_Socket);
- CSUCOMMDC_TASK_FLAG.Got_AssignedAddress = FALSE;
- }
- */
- //======================================================================
- // CAN_CMD_EV_BOARD_STATUS 0x00000300
- ftime(&ShmInternalComm->End_Time);
- if(DiffTimeb(ShmInternalComm->Start_Time, ShmInternalComm->End_Time) >= 1000) //ori = 1000ms
- {
- //Interval = 1000ms
- CSUCOMMDC_TASK_FLAG.Send_EVBoardStatus = TRUE;
- CheckID();
- }
- if (CSUCOMMDC_TASK_FLAG.Send_EVBoardStatus == TRUE)
- {
- //Tx Interval = 1000ms
- Proc_EVBoardStatusRes(FD_CAN_Socket);
- ftime(&ShmInternalComm->Start_Time);
- }
- // CAN_CMD_GET_FW_VERSION 0x00000400
- if(CSUCOMMDC_TASK_FLAG.Got_FWVersionReq == TRUE)
- {
- Proc_GetFirmwareVersionRes(FD_CAN_Socket);
- }
- // CAN_CMD_GET_HW_VERSION 0x00000500
- if(CSUCOMMDC_TASK_FLAG.Got_HWVersionReq == TRUE)
- {
- Proc_HardwareVersionRes(FD_CAN_Socket);
- }
- //CAN_CMD_CHARGING_PERMISSION 0x00000600
- if (CSUCOMMDC_TASK_FLAG.Got_ChargingPermission == TRUE)
- {
- Proc_ChargingPermissionRes(FD_CAN_Socket); //need real-time response
- }
- // CAN_CMD_EVSE_OUTPUT_STATUS_ANNOUNCEMENT 0x00000700
- if(CSUCOMMDC_TASK_FLAG.Got_EVSEOutputStatus == TRUE)
- {
- Proc_EVSEOutputStatusUpdateRes(FD_CAN_Socket); //need real-time response
- }
- // CAN_CMD_EVSE_CAPACITY_ANNOUNCEMENT 0x00000800
- if (CSUCOMMDC_TASK_FLAG.Got_EnergyCapacity == TRUE)
- {
- Proc_EVSECapacityUpdateRes(FD_CAN_Socket); //need real-time response
- }
- // CAN_CMD_GET_EV_TARGET_INFO 0x00000900
- if(CSUCOMMDC_TASK_FLAG.Got_EVTargetReq == TRUE)
- {
- Proc_GetEVTargetRes(FD_CAN_Socket);
- }
- // CAN_CMD_GET_EV_BATTERY_INFO 0x00000A00
- if(CSUCOMMDC_TASK_FLAG.Got_EVBatteryInfoReq == TRUE)
- {
- Proc_GetEVBatteryInfoRes(FD_CAN_Socket);
- }
- //#define CAN_CMD_EV_STOP_EVENT 0x00000B00
- if (CSUCOMMDC_TASK_FLAG.Send_EVStopReq == TRUE) //The Request is from SeccComm
- {
- Proc_EVStopRes(FD_CAN_Socket);
- }
- //#define CAN_CMD_EVSE_STOP_EVENT 0x00000C00
- if (CSUCOMMDC_TASK_FLAG.Got_EVSEStopReq == TRUE)
- {
- Proc_EVSEStopRes(FD_CAN_Socket);
- }
- //#define CAN_CMD_GET_MISC_INFO 0x00000D00
- if(CSUCOMMDC_TASK_FLAG.Got_MiscellaneousInfoReq == TRUE)
- {
- Proc_GetMiscellaneousInfoRes(FD_CAN_Socket);
- }
- //#define CAN_CMD_DOWNLOAD_REQUEST 0x00000E00
- if (CSUCOMMDC_TASK_FLAG.Got_DownloadImageReq == TRUE)
- {
- Proc_DownloadImageRes(FD_CAN_Socket);
- }
- //#define CAN_CMD_START_BLOCK_TRANSFER 0x00000F00
- if (CSUCOMMDC_TASK_FLAG.Got_BlockTransferStartReq == TRUE)
- {
- Proc_BlockTransferStartRes(FD_CAN_Socket);
- }
- // CAN_CMD_DATA_TRANSFER 0x00001000
- if(CSUCOMMDC_TASK_FLAG.Got_DataTransferReq == TRUE)
- {
- Proc_DataTransferRes(FD_CAN_Socket);
- }
- //CAN_CMD_DOWNLOAD_FINISH 0x00001100
- if (CSUCOMMDC_TASK_FLAG.Got_DownloadFinishReq == TRUE)
- {
- Proc_DownloadFinishRes(FD_CAN_Socket);
- }
- // CAN_CMD_ISOLATION_STATUS 0x00001200
- if (CSUCOMMDC_TASK_FLAG.Got_IsolationStatus == TRUE)
- {
- Proc_IsolationStatusAnnounceRes(FD_CAN_Socket);
- }
- // CAN_CMD_CCS_CONNECTOR_INFO 0x00001300
- if (CSUCOMMDC_TASK_FLAG.Got_CCSConnectorReq == TRUE)
- {
- Proc_CCSConnectorTypeSetRes(FD_CAN_Socket); //to-do
- }
- // CAN_CMD_RTC_INFO 0x00001400
- if (CSUCOMMDC_TASK_FLAG.Got_RTC == TRUE)
- {
- Proc_RTCSetRes(FD_CAN_Socket); //to-do
- }
- //CAN_CMD_EVSE_PRECHARGE_INFO //0x00001500
- if (CSUCOMMDC_TASK_FLAG.Got_EVSE_Precharge_Info == TRUE)
- {
- Proc_EVSEPrechargeInfoUpdateRes(FD_CAN_Socket);
- }
- //CAN_CMD_EVCCID_REQUEST //0x00001600
- if (CSUCOMMDC_TASK_FLAG.Got_EVCCID_Req == TRUE)
- {
- Proc_EVCCIDRes(FD_CAN_Socket);
- }
- }
- EndProcess:
- if(PID_CAN_Rx_Task > 0)
- {
- char Buf[32];
- memset(Buf, 0, 32);
- sprintf(Buf, "kill %d", PID_CAN_Rx_Task);
- system(Buf);
- }
- close(FD_CAN_Socket);
- system("/sbin/ip link set can0 down");
- system("/sbin/ip link set can0 type can bitrate 500000 restart-ms 100");
- system("/sbin/ip link set can0 up");
- system("/sbin/ip link set can0 down");
- system("killall CsuComm");
- }
|