1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123 |
- /*
- * Module_PhBackend.c
- *
- * Created on: 2020/06/11
- * Author: foluswen
- */
- #include "Module_PhBackend.h"
- #include "Module_RatedCurrent.h"
- ParsingRatedCur modelnameInfo = {0};
- int StoreLogMsg(const char *fmt, ...)
- {
- char Buf[65536+256];
- char buffer[65536];
- //char Buf[4096+256];
- //char buffer[4096];
- time_t CurrentTime;
- struct tm *tm;
- struct timeval tv;
- va_list args;
- va_start(args, fmt);
- int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
- va_end(args);
- memset(Buf,0,sizeof(Buf));
- CurrentTime = time(NULL);
- tm=localtime(&CurrentTime);
- gettimeofday(&tv, NULL); // get microseconds, 10^-6
- sprintf(Buf,"echo -n \"[%04d.%02d.%02d %02d:%02d:%02d.%03ld]%s\" >> /Storage/SystemLog/[%04d.%02d]Module_PhBackendLog",
- tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,tv.tv_usec/1000,
- buffer,
- tm->tm_year+1900,tm->tm_mon+1);
- system((const char*)Buf);
- #ifdef ConsloePrintLog
- printf("[%04d.%02d.%02d %02d:%02d:%02d.%03ld]%s", tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,tv.tv_usec/1000, buffer);
- #endif
- return rc;
- }
- uint8_t split(char *src, const char *separator, char **dest)
- {
- char *pNext;
- int count = 0;
- if (src == NULL || strlen(src) == 0)
- return count;
- if (separator == NULL || strlen(separator) == 0)
- return count;
- pNext = (char *)strtok(src,separator);
- while(pNext != NULL)
- {
- *dest++ = pNext;
- ++count;
- pNext = (char *)strtok(NULL,separator);
- }
- return count;
- }
- int decTobcd(int dec)
- {
- return (dec/10 * 16)+ (dec%10);
- }
- //==========================================
- // Init all share memory
- //==========================================
- int InitShareMemory()
- {
- int result = PASS;
- int MeterSMId;
- //creat ShmSysConfigAndInfo
- if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo), 0777)) < 0)
- {
- #ifdef SystemLogMessage
- DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
- #endif
- result = FAIL;
- }
- else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1)
- {
- #ifdef SystemLogMessage
- DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
- #endif
- result = FAIL;
- }
- else
- {}
- //creat ShmStatusCodeData
- if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData), 0777)) < 0)
- {
- #ifdef SystemLogMessage
- DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
- #endif
- result = FAIL;
- }
- else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1)
- {
- #ifdef SystemLogMessage
- DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
- #endif
- result = FAIL;
- }
- else
- {}
- return result;
- }
- uint8_t checksum_valid(struct Message *message)
- {
- uint8_t chksum = 0;
- for(uint16_t idx=6;idx<(message->buffer[2] | ((uint16_t)message->buffer[3]<<8));idx++)
- chksum += message->buffer[idx];
- chksum += 11;
- return ((chksum&0xff)==message->buffer[(message->buffer[2] | ((uint16_t)message->buffer[3]<<8))-1]?PASS:FAIL);
- }
- uint8_t checksum_cal(struct Message *message)
- {
- uint8_t chksum = 0;
- for(uint16_t idx=6;idx<(message->size-1);idx++)
- chksum += message->buffer[idx];
- chksum += 11;
- return (chksum & 0xff);
- }
- void showCmdRaw(struct Message *message, uint8_t isTx)
- {
- if(isTx)
- DEBUG_INFO("%s -----> Server\n", ShmSysConfigAndInfo->SysConfig.SystemId);
- else
- DEBUG_INFO("%s <----- Server\n", ShmSysConfigAndInfo->SysConfig.SystemId);
- DEBUG_INFO("- CMD_%04d ------------------------------------\n", (message->buffer[6] | ((uint16_t)message->buffer[7]<<8)));
- DEBUG_INFO("%02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X\n", 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15);
- DEBUG_INFO("-----------------------------------------------\n");
- for(uint8_t idx=0;idx<((message->size/16)+1);idx++)
- {
- DEBUG_INFO("%02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X\n", message->buffer[idx*16+0],
- message->buffer[idx*16+1],
- message->buffer[idx*16+2],
- message->buffer[idx*16+3],
- message->buffer[idx*16+4],
- message->buffer[idx*16+5],
- message->buffer[idx*16+6],
- message->buffer[idx*16+7],
- message->buffer[idx*16+8],
- message->buffer[idx*16+9],
- message->buffer[idx*16+10],
- message->buffer[idx*16+11],
- message->buffer[idx*16+12],
- message->buffer[idx*16+13],
- message->buffer[idx*16+14],
- message->buffer[idx*16+15]);
- }
- DEBUG_INFO("-----------------------------------------------\n");
- }
- void handle_cmd_1001(struct Message *in, struct Message *out)
- {
- uint32_t startAddr;
- uint32_t offset = 0;
- uint8_t count;
- uint32_t value;
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- if(in->buffer[12])
- DEBUG_INFO("CMD Type: Set\n");
- else
- DEBUG_INFO("CMD Type: Query\n");
- startAddr = in->buffer[13] | ((uint32_t)in->buffer[14]<<8) | ((uint32_t)in->buffer[15]<<16) | ((uint32_t)in->buffer[16]<<24);
- count = in->buffer[17];
- if(in->buffer[12])
- {
- for(int idx=startAddr;idx<(startAddr+count);idx++)
- {
- value = in->buffer[20+(offset*4)] | ((uint32_t)in->buffer[21+(offset*4)]<<8) | ((uint32_t)in->buffer[22+(offset*4)]<<16) | ((uint32_t)in->buffer[23+(offset*4)]<<24);
- switch(idx)
- {
- case 1:
- DEBUG_INFO("Sign in interval: %d\n", value);
- offset++;
- break;
- case 2:
- DEBUG_INFO("Charger type: %d\n", value);
- offset++;
- break;
- case 3:
- DEBUG_INFO("Charger gun count: %d\n", value);
- offset++;
- break;
- case 4:
- DEBUG_INFO("Communication No: %d\n", value);
- offset++;
- break;
- case 5:
- offset++;
- break;
- case 6:
- offset++;
- break;
- case 7:
- offset++;
- break;
- case 8:
- offset++;
- break;
- case 9:
- offset++;
- break;
- case 10:
- offset++;
- break;
- case 11:
- offset++;
- break;
- case 12:
- offset++;
- break;
- case 13:
- offset++;
- break;
- case 14:
- offset++;
- break;
- case 15:
- offset++;
- break;
- case 16:
- offset++;
- break;
- case 17:
- offset++;
- break;
- case 18:
- offset++;
- break;
- case 19:
- offset++;
- break;
- case 20:
- DEBUG_INFO("Report interval: %d\n", value);
- offset++;
- break;
- case 21:
- DEBUG_INFO("Heart beat interval: %d\n", value);
- backend_info.interval_heartbeat = value;
- offset++;
- break;
- case 22:
- DEBUG_INFO("Heart beat overtime count: %d\n", value);
- backend_info.retry_heartbeat = value;
- offset++;
- break;
- case 23:
- DEBUG_INFO("Status report interval: %d\n", value);
- backend_info.interval_status = value;
- offset++;
- break;
- case 24:
- offset++;
- break;
- case 25:
- offset++;
- break;
- case 26:
- offset++;
- break;
- case 27:
- DEBUG_INFO("Service price: %.2f\n", (value/100.0));
- offset++;
- break;
- case 28:
- DEBUG_INFO("Charging price: %.2f\n", (value/100.0));
- offset++;
- break;
- case 29:
- offset++;
- break;
- case 30:
- offset++;
- break;
- case 31:
- offset++;
- break;
- case 32:
- offset++;
- break;
- case 33:
- offset++;
- break;
- case 34:
- offset++;
- break;
- case 35:
- offset++;
- break;
- }
- }
- }
- create_Cmd_1002(out, in->buffer[12], startAddr, count);
- }
- void handle_cmd_1003(struct Message *in, struct Message *out)
- {
- uint32_t startAddr;
- uint8_t data[in->size-11-9];
- uint8_t *server_info[3];
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- if(in->buffer[12])
- DEBUG_INFO("CMD Type: Set\n");
- else
- DEBUG_INFO("CMD Type: Query\n");
- startAddr = in->buffer[13] | ((uint32_t)in->buffer[14]<<8) | ((uint32_t)in->buffer[15]<<16) | ((uint32_t)in->buffer[16]<<24);
- memcpy(&data[0], &in->buffer[19], ARRAY_SIZE(data));
- switch(startAddr)
- {
- case 1:
- break;
- case 2:
- DEBUG_INFO("Server time: %02X%02X-%02X-%02X %02X:%02X:%02X\n", data[0], data[1], data[2], data[3], data[4], data[5], data[6]);
- break;
- case 3:
- break;
- case 4:
- break;
- case 5:
- break;
- case 6:
- break;
- case 7:
- break;
- case 8:
- break;
- case 9:
- break;
- case 10:
- break;
- case 11:
- memset(server_addr, 0x00, ARRAY_SIZE(server_addr));
- memcpy(&server_addr[0], &in->buffer[19], 128);
- split((char*)server_addr, ":", (char**)server_info);
- message_header = strtol((char*)server_info[2], NULL, 16);
- server_port = atoi((char*)server_info[1]);
- sprintf((char*)server_addr, "%s", (char*)server_info[0]);
- DEBUG_INFO("Server address: %s\n", server_addr);
- DEBUG_INFO("Server port: %d\n", server_port);
- DEBUG_INFO("Message header: %04X\n", message_header);
- break;
- case 12:
- DEBUG_INFO("Customer ID: %s\n", data);
- break;
- }
- create_Cmd_1004(out, in->buffer[12], startAddr, &data[0], ARRAY_SIZE(data));
- }
- void handle_cmd_1005(struct Message *in, struct Message *out)
- {
- uint32_t startAddr;
- uint32_t offset = 0;
- uint8_t count;
- uint32_t value;
- uint8_t gun_index;
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- gun_index = in->buffer[12];
- startAddr = in->buffer[13] | ((uint32_t)in->buffer[14]<<8) | ((uint32_t)in->buffer[15]<<16) | ((uint32_t)in->buffer[16]<<24);
- count = in->buffer[17];
- for(int idx=startAddr;idx<(startAddr+count);idx++)
- {
- value = in->buffer[20+(offset*4)] | ((uint32_t)in->buffer[21+(offset*4)]<<8) | ((uint32_t)in->buffer[22+(offset*4)]<<16) | ((uint32_t)in->buffer[23+(offset*4)]<<24);
- switch(idx)
- {
- case 1:
- if(value == 0x55)
- {
- DEBUG_INFO("Charger start.\n");
- }
- offset++;
- break;
- case 2:
- if(value == 0x55)
- {
- DEBUG_INFO("Charger stop.\n");
- }
- offset++;
- break;
- case 3:
- if(value == 0)
- {
- DEBUG_INFO("Charge soon.\n");
- }
- else if(value ==1)
- {
- DEBUG_INFO("Charge reserve.\n");
- }
- offset++;
- break;
- case 4:
- if(value == 0)
- {
- DEBUG_INFO("BMS control charging.\n");
- }
- else if(value == 1)
- {
- DEBUG_INFO("Directly charging.\n");
- }
- offset++;
- break;
- case 5:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 6:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 7:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 8:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 9:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 10:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 11:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 12:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 13:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 14:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 15:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 16:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 17:
- if(value == 0x55)
- {
- DEBUG_INFO("Upload log request.\n");
- system("/usr/bin/run_tmate_restart.sh");
- }
- offset++;
- break;
- case 18:
- if(value == 0x55)
- {
- }
- offset++;
- break;
- case 19:
- if(value == 0x55)
- {
- DEBUG_INFO("Disable charger.\n");
- }
- offset++;
- break;
- case 20:
- if(value == 0x55)
- {
- DEBUG_INFO("Enable charger.\n");
- }
- offset++;
- break;
- }
- }
- create_Cmd_1006(out, gun_index, startAddr, count, true);
- }
- void handle_cmd_1101(struct Message *in)
- {
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- backend_info.sn_heartbeat = (in->buffer[12] | ((uint16_t)in->buffer[13]<<8));
- backend_info.counter_heartbeat_retry = 0;
- }
- void handle_cmd_1103(struct Message *in)
- {
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- DEBUG_INFO("Connector id: %d\n", in->buffer[12]);
- }
- void handle_cmd_1105(struct Message *in)
- {
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- DEBUG_INFO("Charger sign in OK.\n");
- backend_info.isSignin = ON;
- backend_info.st_hearbeat = time((time_t*)NULL);
- backend_info.counter_heartbeat_retry = 0;
- backend_info.interval_heartbeat = 10;
- backend_info.interval_status = 30;
- }
- void handle_cmd_2303(struct Message *in, struct Message *out)
- {
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- create_Cmd_2304(out);
- }
- void handle_cmd_2305(struct Message *in, struct Message *out)
- {
- DEBUG_INFO("User ID: %d\n", (in->buffer[8] | ((uint16_t)in->buffer[9]<<8)));
- DEBUG_INFO("CMD SN: %d\n", (in->buffer[10] | ((uint16_t)in->buffer[11]<<8)));
- create_Cmd_2306(out);
- }
- void create_Cmd_1002(struct Message *out, uint8_t cmd_type, uint32_t address, uint32_t count)
- {
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 9 + 43 + (count*4);
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (1002>>0) & 0xff;
- out->buffer[0x07] = (1002>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Charger ID
- memcpy(&out->buffer[0x0c], &ShmSysConfigAndInfo->SysConfig.SystemId[0], 32);
- // Command type (0:Check 1:Set)
- out->buffer[0x2c] = cmd_type;
- // Start adress
- out->buffer[0x2d] = (address>>0) & 0xff;
- out->buffer[0x2e] = (address>>8) & 0xff;
- out->buffer[0x2f] = (address>>16) & 0xff;
- out->buffer[0x30] = (address>>24) & 0xff;
- // Count
- out->buffer[0x31] = count;
- // Result (0:Success 1:Fail)
- out->buffer[0x31] = 0x00;
- memset(&out->buffer[0x32], 0x00, (count*4));
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- void create_Cmd_1004(struct Message *out, uint8_t cmd_type, uint32_t address, uint8_t *data, uint8_t data_len)
- {
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 9 + 42 + data_len;
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (1004>>0) & 0xff;
- out->buffer[0x07] = (1004>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Charger ID
- memcpy(&out->buffer[0x0c], &ShmSysConfigAndInfo->SysConfig.SystemId[0], 32);
- // Command type (0:Check 1:Set)
- out->buffer[0x2c] = cmd_type;
- // Start adress
- out->buffer[0x2d] = (address>>0) & 0xff;
- out->buffer[0x2e] = (address>>8) & 0xff;
- out->buffer[0x2f] = (address>>16) & 0xff;
- out->buffer[0x30] = (address>>24) & 0xff;
- // Result (0:Success 1:Fail)
- out->buffer[0x31] = 0x00;
- // Result data
- memcpy(&out->buffer[0x32], &data[0], data_len);
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- void create_Cmd_1006(struct Message *out, uint8_t gun_index, uint32_t address, uint8_t count, uint8_t isExecuted)
- {
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 0x34;
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (1006>>0) & 0xff;
- out->buffer[0x07] = (1006>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Charger ID
- memcpy(&out->buffer[0x0c], &ShmSysConfigAndInfo->SysConfig.SystemId[0], 32);
- // Gun index
- out->buffer[0x2c] = gun_index;
- // Start adress
- out->buffer[0x2d] = (address>>0) & 0xff;
- out->buffer[0x2e] = (address>>8) & 0xff;
- out->buffer[0x2f] = (address>>16) & 0xff;
- out->buffer[0x30] = (address>>24) & 0xff;
- // Command count
- out->buffer[0x31] = count;
- // Command execute result;
- out->buffer[0x32] = isExecuted;
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- void create_Cmd_1102(struct Message *out)
- {
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 0x2f;
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (1102>>0) & 0xff;
- out->buffer[0x07] = (1102>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Charger ID
- memcpy(&out->buffer[0x0c], &ShmSysConfigAndInfo->SysConfig.SystemId[0], 32);
- // Heart beat sn
- out->buffer[0x2c] = (backend_info.sn_heartbeat>>0) & 0xff;
- out->buffer[0x2d] = (backend_info.sn_heartbeat>>8) & 0xff;
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- void create_Cmd_1104(struct Message *out, uint8_t gun_index)
- {
- uint8_t tempIndex;
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 0xd7;
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (1104>>0) & 0xff;
- out->buffer[0x07] = (1104>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Charger ID
- memcpy(&out->buffer[0x0c], &ShmSysConfigAndInfo->SysConfig.SystemId[0], 0x20);
- // Charger connector quantity
- out->buffer[0x2c] = AC_QUANTITY + CCS_QUANTITY + GB_QUANTITY + CHAdeMO_QUANTITY;
- // Connector id
- out->buffer[0x2d] = gun_index;
- // Charger model type (1: DC, 2: AC)
- out->buffer[0x2e] = (ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D'?1:2);
- // Connector status
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_BOOTING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_MAINTAIN) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_UPDATE))
- out->buffer[0x2f] = 7;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_IDLE)
- out->buffer[0x2f] = 0;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_AUTHORIZING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_PREPARING))
- out->buffer[0x2f] = 1;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_CHARGING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_PREPARE_FOR_EV) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_TERMINATING))
- out->buffer[0x2f] = 2;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_COMPLETE)
- out->buffer[0x2f] = 3;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_ALARM) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_FAULT))
- out->buffer[0x2f] = 6;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_RESERVATION)
- out->buffer[0x2f] = 5;
- else
- out->buffer[0x2f] = 0;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_BOOTING) || (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_MAINTAIN) || (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_UPDATE))
- out->buffer[0x2f] = 7;
- else if(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_IDLE)
- out->buffer[0x2f] = 0;
- else if((ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_AUTHORIZING) || (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_PREPARING))
- out->buffer[0x2f] = 1;
- else if((ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_CHARGING) || (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_PREPARE_FOR_EV) || (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_TERMINATING))
- out->buffer[0x2f] = 2;
- else if(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_COMPLETE)
- out->buffer[0x2f] = 3;
- else if((ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_ALARM) || (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_FAULT))
- out->buffer[0x2f] = 6;
- else if(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_RESERVATION)
- out->buffer[0x2f] = 5;
- else
- out->buffer[0x2f] = 0;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_BOOTING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_MAINTAIN) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_UPDATE))
- out->buffer[0x2f] = 7;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_IDLE)
- out->buffer[0x2f] = 0;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_AUTHORIZING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_PREPARING))
- out->buffer[0x2f] = 1;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_CHARGING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_PREPARE_FOR_EV) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_TERMINATING))
- out->buffer[0x2f] = 2;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_COMPLETE)
- out->buffer[0x2f] = 3;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_ALARM) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_FAULT))
- out->buffer[0x2f] = 6;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_RESERVATION)
- out->buffer[0x2f] = 5;
- else
- out->buffer[0x2f] = 0;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_BOOTING) || (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_MAINTAIN) || (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_UPDATE))
- out->buffer[0x2f] = 7;
- else if(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_IDLE)
- out->buffer[0x2f] = 0;
- else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_AUTHORIZING) || (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_PREPARING))
- out->buffer[0x2f] = 1;
- else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_CHARGING) || (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_PREPARE_FOR_EV) || (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_TERMINATING))
- out->buffer[0x2f] = 2;
- else if(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_COMPLETE)
- out->buffer[0x2f] = 3;
- else if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_ALARM) || (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_FAULT))
- out->buffer[0x2f] = 6;
- else if(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_RESERVATION)
- out->buffer[0x2f] = 5;
- else
- out->buffer[0x2f] = 0;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_BOOTING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_MAINTAIN) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_UPDATE))
- out->buffer[0x2f] = 7;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_IDLE)
- out->buffer[0x2f] = 0;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_AUTHORIZING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_PREPARING))
- out->buffer[0x2f] = 1;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_CHARGING) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_PREPARE_FOR_EV) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_TERMINATING))
- out->buffer[0x2f] = 2;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_COMPLETE)
- out->buffer[0x2f] = 3;
- else if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_ALARM) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_FAULT))
- out->buffer[0x2f] = 6;
- else if(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_RESERVATION)
- out->buffer[0x2f] = 5;
- else
- out->buffer[0x2f] = 0;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_BOOTING) || (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_MAINTAIN) || (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_UPDATE))
- out->buffer[0x2f] = 7;
- else if(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_IDLE)
- out->buffer[0x2f] = 0;
- else if((ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_AUTHORIZING) || (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_PREPARING))
- out->buffer[0x2f] = 1;
- else if((ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_CHARGING) || (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_PREPARE_FOR_EV) || (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_TERMINATING))
- out->buffer[0x2f] = 2;
- else if(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_COMPLETE)
- out->buffer[0x2f] = 3;
- else if((ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_ALARM) || (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_FAULT))
- out->buffer[0x2f] = 6;
- else if(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_RESERVATION)
- out->buffer[0x2f] = 5;
- else
- out->buffer[0x2f] = 0;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_BOOTING) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_MAINTAIN) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_UPDATE))
- out->buffer[0x2f] = 7;
- else if(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_IDLE)
- out->buffer[0x2f] = 0;
- else if((ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_AUTHORIZING) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_PREPARING))
- out->buffer[0x2f] = 1;
- else if((ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_CHARGING) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_PREPARE_FOR_EV) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_TERMINATING))
- out->buffer[0x2f] = 2;
- else if(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_COMPLETE)
- out->buffer[0x2f] = 3;
- else if((ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_ALARM) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_FAULT))
- out->buffer[0x2f] = 6;
- else if(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_RESERVATION)
- out->buffer[0x2f] = 5;
- else
- out->buffer[0x2f] = 0;
- }
- }
- break;
- }
- // SOC
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x30] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.EvBatterySoc;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x30] = ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].EvBatterySoc;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x30] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.EvBatterySoc; }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x30] = ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].EvBatterySoc;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x30] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.EvBatterySoc;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x30] = ShmSysConfigAndInfo->SysInfo.GbChargingData[index].EvBatterySoc;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x30] = ShmSysConfigAndInfo->SysInfo.AcChargingData[index].EvBatterySoc;
- }
- }
- break;
- }
- // Alarm code
- out->buffer[0x31] = 0x00;
- out->buffer[0x32] = 0x00;
- out->buffer[0x33] = 0x00;
- out->buffer[0x34] = 0x00;
- // Connect status
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x35] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn?0x02:0x00;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x35] = ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].ConnectorPlugIn?0x02:0x00;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x35] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn?0x02:0x00;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x35] = ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].ConnectorPlugIn?0x02:0x00;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x35] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn?0x02:0x00;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x35] = ShmSysConfigAndInfo->SysInfo.GbChargingData[index].ConnectorPlugIn?0x02:0x00;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x35] = ((2<=ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PilotState)&&(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PilotState<=5))?0x02:0x00;
- }
- }
- break;
- }
- // Charging amount
- out->buffer[0x36] = 0x00;
- out->buffer[0x37] = 0x00;
- out->buffer[0x38] = 0x00;
- out->buffer[0x39] = 0x00;
- // Charging temperature
- out->buffer[0x3a] = 0x00;
- out->buffer[0x3b] = 0x00;
- out->buffer[0x3c] = 0x00;
- out->buffer[0x3d] = 0x00;
- // Total power consumption
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x3e] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)&0xff;
- out->buffer[0x3f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>8)&0xff;
- out->buffer[0x40] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>16)&0xff;
- out->buffer[0x41] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x3e] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x3f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x40] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x41] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x3e] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)&0xff;
- out->buffer[0x3f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>8)&0xff;
- out->buffer[0x40] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>16)&0xff;
- out->buffer[0x41] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x3e] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x3f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x40] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x41] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x3e] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)&0xff;
- out->buffer[0x3f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>8)&0xff;
- out->buffer[0x40] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>16)&0xff;
- out->buffer[0x41] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x3e] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x3f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x40] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x41] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x3e] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x3f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x40] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x41] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- break;
- }
- // DC voltage
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x42] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.FireChargingVoltage*10)&0xff;
- out->buffer[0x43] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.FireChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x42] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].FireChargingVoltage*10)&0xff;
- out->buffer[0x43] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].FireChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x42] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.FireChargingVoltage*10)&0xff;
- out->buffer[0x43] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.FireChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x42] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].FireChargingVoltage*10)&0xff;
- out->buffer[0x43] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].FireChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x42] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.FireChargingVoltage*10)&0xff;
- out->buffer[0x43] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.FireChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x42] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].FireChargingVoltage*10)&0xff;
- out->buffer[0x43] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].FireChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x42] = 0x00;
- out->buffer[0x43] = 0x00;
- }
- }
- break;
- }
- // DC current
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x44] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)&0xff;
- out->buffer[0x45] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x44] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrent*10)&0xff;
- out->buffer[0x45] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x44] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)&0xff;
- out->buffer[0x45] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x44] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrent*10)&0xff;
- out->buffer[0x45] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x44] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)&0xff;
- out->buffer[0x45] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x44] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrent*10)&0xff;
- out->buffer[0x45] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x44] = 0x00;
- out->buffer[0x45] = 0x00;
- }
- }
- break;
- }
- // BMS voltage request
- out->buffer[0x46] = 0x00;
- out->buffer[0x47] = 0x00;
- // BMS current request
- out->buffer[0x48] = 0x00;
- out->buffer[0x49] = 0x00;
- // BMS charging mode
- out->buffer[0x4a] = 0x00;
- // AC L1 voltage
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4b] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltage*10)&0xff;
- out->buffer[0x4c] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4b] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingVoltage*10)&0xff;
- out->buffer[0x4c] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4b] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltage*10)&0xff;
- out->buffer[0x4c] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4b] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingVoltage*10)&0xff;
- out->buffer[0x4c] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4b] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltage*10)&0xff;
- out->buffer[0x4c] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4b] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingVoltage*10)&0xff;
- out->buffer[0x4c] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingVoltage*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4b] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingVoltage*10)&0xff;
- out->buffer[0x4c] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingVoltage*10)>>8)&0xff;
- }
- }
- break;
- }
- // AC L2 voltage
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4d] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL2*10)&0xff;
- out->buffer[0x4e] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL2*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4d] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingVoltageL2*10)&0xff;
- out->buffer[0x4e] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingVoltageL2*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4d] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL2*10)&0xff;
- out->buffer[0x4e] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL2*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4d] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingVoltageL2*10)&0xff;
- out->buffer[0x4e] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingVoltageL2*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4d] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL2*10)&0xff;
- out->buffer[0x4e] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL2*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4d] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingVoltageL2*10)&0xff;
- out->buffer[0x4e] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingVoltageL2*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4d] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingVoltageL2*10)&0xff;
- out->buffer[0x4e] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingVoltageL2*10)>>8)&0xff;
- }
- }
- break;
- }
- // AC L3 voltage
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4f] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL3*10)&0xff;
- out->buffer[0x50] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL3*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4f] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingVoltageL3*10)&0xff;
- out->buffer[0x50] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingVoltageL3*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4f] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL3*10)&0xff;
- out->buffer[0x50] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL3*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4f] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingVoltageL3*10)&0xff;
- out->buffer[0x50] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingVoltageL3*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x4f] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL3*10)&0xff;
- out->buffer[0x50] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingVoltageL3*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4f] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingVoltageL3*10)&0xff;
- out->buffer[0x50] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingVoltageL3*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x4f] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingVoltageL3*10)&0xff;
- out->buffer[0x50] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingVoltageL3*10)>>8)&0xff;
- }
- }
- break;
- }
- // AC L1 current
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x51] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)&0xff;
- out->buffer[0x52] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x51] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrent*10)&0xff;
- out->buffer[0x52] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x51] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)&0xff;
- out->buffer[0x52] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x51] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrent*10)&0xff;
- out->buffer[0x52] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x51] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)&0xff;
- out->buffer[0x52] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x51] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrent*10)&0xff;
- out->buffer[0x52] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x51] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingCurrent*10)&0xff;
- out->buffer[0x52] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingCurrent*10)>>8)&0xff;
- }
- }
- break;
- }
- // AC L2 current
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x53] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL2*10)&0xff;
- out->buffer[0x54] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL2*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x53] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrentL2*10)&0xff;
- out->buffer[0x54] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrentL2*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x53] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL2*10)&0xff;
- out->buffer[0x54] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL2*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x53] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrentL2*10)&0xff;
- out->buffer[0x54] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrentL2*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x53] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL2*10)&0xff;
- out->buffer[0x54] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL2*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x53] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrentL2*10)&0xff;
- out->buffer[0x54] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrentL2*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x53] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingCurrentL2*10)&0xff;
- out->buffer[0x54] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingCurrentL2*10)>>8)&0xff;
- }
- }
- break;
- }
- // AC L3 current
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x55] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL3*10)&0xff;
- out->buffer[0x56] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL3*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x55] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrentL3*10)&0xff;
- out->buffer[0x56] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargingCurrentL3*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x55] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL3*10)&0xff;
- out->buffer[0x56] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL3*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x55] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrentL3*10)&0xff;
- out->buffer[0x56] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargingCurrentL3*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x55] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL3*10)&0xff;
- out->buffer[0x56] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargingCurrentL3*10)>>8)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x55] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrentL3*10)&0xff;
- out->buffer[0x56] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargingCurrentL3*10)>>8)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x55] = (uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingCurrentL3*10)&0xff;
- out->buffer[0x56] = ((uint16_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargingCurrentL3*10)>>8)&0xff;
- }
- }
- break;
- }
- // Charging remind time
- out->buffer[0x57] = 0x00;
- out->buffer[0x58] = 0x00;
- // Charging time
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x59] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)&0xff;
- out->buffer[0x5a] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>8)&0xff;
- out->buffer[0x5b] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>16)&0xff;
- out->buffer[0x5c] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x59] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedDuration*1)&0xff;
- out->buffer[0x5a] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedDuration*1)>>8)&0xff;
- out->buffer[0x5b] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedDuration*1)>>16)&0xff;
- out->buffer[0x5c] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedDuration*1)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x59] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)&0xff;
- out->buffer[0x5a] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>8)&0xff;
- out->buffer[0x5b] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>16)&0xff;
- out->buffer[0x5c] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x59] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedDuration*1)&0xff;
- out->buffer[0x5a] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedDuration*1)>>8)&0xff;
- out->buffer[0x5b] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedDuration*1)>>16)&0xff;
- out->buffer[0x5c] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedDuration*1)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x59] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)&0xff;
- out->buffer[0x5a] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>8)&0xff;
- out->buffer[0x5b] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>16)&0xff;
- out->buffer[0x5c] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedDuration*1)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x59] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedDuration*1)&0xff;
- out->buffer[0x5a] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedDuration*1)>>8)&0xff;
- out->buffer[0x5b] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedDuration*1)>>16)&0xff;
- out->buffer[0x5c] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedDuration*1)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x59] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedDuration*1)&0xff;
- out->buffer[0x5a] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedDuration*1)>>8)&0xff;
- out->buffer[0x5b] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedDuration*1)>>16)&0xff;
- out->buffer[0x5c] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedDuration*1)>>24)&0xff;
- }
- }
- break;
- }
- // Charging power consumption
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x5d] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)&0xff;
- out->buffer[0x5e] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>8)&0xff;
- out->buffer[0x5f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>16)&0xff;
- out->buffer[0x60] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x5d] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedEnergy*100)&0xff;
- out->buffer[0x5e] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedEnergy*100)>>8)&0xff;
- out->buffer[0x5f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedEnergy*100)>>16)&0xff;
- out->buffer[0x60] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PresentChargedEnergy*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x5d] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)&0xff;
- out->buffer[0x5e] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>8)&0xff;
- out->buffer[0x5f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>16)&0xff;
- out->buffer[0x60] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x5d] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedEnergy*100)&0xff;
- out->buffer[0x5e] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedEnergy*100)>>8)&0xff;
- out->buffer[0x5f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedEnergy*100)>>16)&0xff;
- out->buffer[0x60] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PresentChargedEnergy*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x5d] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)&0xff;
- out->buffer[0x5e] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>8)&0xff;
- out->buffer[0x5f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>16)&0xff;
- out->buffer[0x60] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PresentChargedEnergy*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x5d] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedEnergy*100)&0xff;
- out->buffer[0x5e] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedEnergy*100)>>8)&0xff;
- out->buffer[0x5f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedEnergy*100)>>16)&0xff;
- out->buffer[0x60] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PresentChargedEnergy*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x5d] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedEnergy*100)&0xff;
- out->buffer[0x5e] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedEnergy*100)>>8)&0xff;
- out->buffer[0x5f] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedEnergy*100)>>16)&0xff;
- out->buffer[0x60] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PresentChargedEnergy*100)>>24)&0xff;
- }
- }
- break;
- }
- // Before charging meter value
- out->buffer[0x61] = 0x00;
- out->buffer[0x62] = 0x00;
- out->buffer[0x63] = 0x00;
- out->buffer[0x64] = 0x00;
- // After charging meter value
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x65] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)&0xff;
- out->buffer[0x66] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>8)&0xff;
- out->buffer[0x67] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>16)&0xff;
- out->buffer[0x68] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x65] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x66] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x67] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x68] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x65] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)&0xff;
- out->buffer[0x66] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>8)&0xff;
- out->buffer[0x67] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>16)&0xff;
- out->buffer[0x68] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x65] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x66] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x67] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x68] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x65] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)&0xff;
- out->buffer[0x66] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>8)&0xff;
- out->buffer[0x67] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>16)&0xff;
- out->buffer[0x68] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x65] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x66] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x67] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x68] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x65] = (uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)&0xff;
- out->buffer[0x66] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)>>8)&0xff;
- out->buffer[0x67] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)>>16)&0xff;
- out->buffer[0x68] = ((uint32_t)(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PowerConsumption*100)>>24)&0xff;
- }
- }
- break;
- }
- // Start method
- out->buffer[0x69] = 0x00;
- // Charging strategy
- out->buffer[0x6a] = 0x00;
- // Charging parameter
- out->buffer[0x6b] = 0x00;
- out->buffer[0x6c] = 0x00;
- out->buffer[0x6d] = 0x00;
- out->buffer[0x6e] = 0x00;
- // Reservation flag
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x6f] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_RESERVATION?0x01:0x00;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- out->buffer[0x6f] = ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus == SYS_MODE_RESERVATION?0x01:0x00;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x6f] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_RESERVATION?0x01:0x00;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- out->buffer[0x6f] = ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus == SYS_MODE_RESERVATION?0x01:0x00;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- out->buffer[0x6f] = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus == SYS_MODE_RESERVATION?0x01:0x00;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- out->buffer[0x6f] = ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus == SYS_MODE_RESERVATION?0x01:0x00;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- out->buffer[0x6f] = ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus == SYS_MODE_RESERVATION?0x01:0x00;
- }
- }
- break;
- }
- // User
- memset(&out->buffer[0x70], 0x00, 0x24);
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- memcpy(&out->buffer[0x70], ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartUserId, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartUserId));
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- memcpy(&out->buffer[0x70], ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].StartUserId, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].StartUserId));
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- memcpy(&out->buffer[0x70], ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartUserId, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartUserId));
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- memcpy(&out->buffer[0x70], ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].StartUserId, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].StartUserId));
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- memcpy(&out->buffer[0x70], ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartUserId, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartUserId));
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- memcpy(&out->buffer[0x70], ShmSysConfigAndInfo->SysInfo.GbChargingData[index].StartUserId, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.GbChargingData[index].StartUserId));
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- memcpy(&out->buffer[0x70], ShmSysConfigAndInfo->SysInfo.AcChargingData[index].StartUserId, ARRAY_SIZE(ShmSysConfigAndInfo->SysInfo.AcChargingData[index].StartUserId));
- }
- }
- break;
- }
- // Reservation over time
- out->buffer[0x94] = 0x00;
- // Start time
- struct ParsingResult
- {
- int year;
- int month;
- int mday;
- int hour;
- int min;
- int sec;
- }result;
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- sscanf((char*)ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartDateTime, "%04d.%02d.%02d %02d:%02d:%02d",
- &result.year,
- &result.month,
- &result.mday,
- &result.hour,
- &result.min,
- &result.sec);
- out->buffer[0x95] = decTobcd(result.year/100) & 0xff;
- out->buffer[0x96] = decTobcd(result.year%100) & 0xff;
- out->buffer[0x97] = decTobcd(result.month) & 0xff;
- out->buffer[0x98] = decTobcd(result.mday) & 0xff;
- out->buffer[0x99] = decTobcd(result.hour) & 0xff;
- out->buffer[0x9a] = decTobcd(result.min) & 0xff;
- out->buffer[0x9b] = decTobcd(result.sec) & 0xff;
- out->buffer[0x9c] = 0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- sscanf((char*)ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].StartDateTime, "%04d.%02d.%02d %02d:%02d:%02d",
- &result.year,
- &result.month,
- &result.mday,
- &result.hour,
- &result.min,
- &result.sec);
- out->buffer[0x95] = decTobcd(result.year/100) & 0xff;
- out->buffer[0x96] = decTobcd(result.year%100) & 0xff;
- out->buffer[0x97] = decTobcd(result.month) & 0xff;
- out->buffer[0x98] = decTobcd(result.mday) & 0xff;
- out->buffer[0x99] = decTobcd(result.hour) & 0xff;
- out->buffer[0x9a] = decTobcd(result.min) & 0xff;
- out->buffer[0x9b] = decTobcd(result.sec) & 0xff;
- out->buffer[0x9c] = 0xff;
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- sscanf((char*)ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartDateTime, "%04d.%02d.%02d %02d:%02d:%02d",
- &result.year,
- &result.month,
- &result.mday,
- &result.hour,
- &result.min,
- &result.sec);
- out->buffer[0x95] = decTobcd(result.year/100) & 0xff;
- out->buffer[0x96] = decTobcd(result.year%100) & 0xff;
- out->buffer[0x97] = decTobcd(result.month) & 0xff;
- out->buffer[0x98] = decTobcd(result.mday) & 0xff;
- out->buffer[0x99] = decTobcd(result.hour) & 0xff;
- out->buffer[0x9a] = decTobcd(result.min) & 0xff;
- out->buffer[0x9b] = decTobcd(result.sec) & 0xff;
- out->buffer[0x9c] = 0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- sscanf((char*)ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].StartDateTime, "%04d.%02d.%02d %02d:%02d:%02d",
- &result.year,
- &result.month,
- &result.mday,
- &result.hour,
- &result.min,
- &result.sec);
- out->buffer[0x95] = decTobcd(result.year/100) & 0xff;
- out->buffer[0x96] = decTobcd(result.year%100) & 0xff;
- out->buffer[0x97] = decTobcd(result.month) & 0xff;
- out->buffer[0x98] = decTobcd(result.mday) & 0xff;
- out->buffer[0x99] = decTobcd(result.hour) & 0xff;
- out->buffer[0x9a] = decTobcd(result.min) & 0xff;
- out->buffer[0x9b] = decTobcd(result.sec) & 0xff;
- out->buffer[0x9c] = 0xff;
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- sscanf((char*)ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.StartDateTime, "%04d.%02d.%02d %02d:%02d:%02d",
- &result.year,
- &result.month,
- &result.mday,
- &result.hour,
- &result.min,
- &result.sec);
- out->buffer[0x95] = decTobcd(result.year/100) & 0xff;
- out->buffer[0x96] = decTobcd(result.year%100) & 0xff;
- out->buffer[0x97] = decTobcd(result.month) & 0xff;
- out->buffer[0x98] = decTobcd(result.mday) & 0xff;
- out->buffer[0x99] = decTobcd(result.hour) & 0xff;
- out->buffer[0x9a] = decTobcd(result.min) & 0xff;
- out->buffer[0x9b] = decTobcd(result.sec) & 0xff;
- out->buffer[0x9c] = 0xff;
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- sscanf((char*)ShmSysConfigAndInfo->SysInfo.GbChargingData[index].StartDateTime, "%04d.%02d.%02d %02d:%02d:%02d",
- &result.year,
- &result.month,
- &result.mday,
- &result.hour,
- &result.min,
- &result.sec);
- out->buffer[0x95] = decTobcd(result.year/100) & 0xff;
- out->buffer[0x96] = decTobcd(result.year%100) & 0xff;
- out->buffer[0x97] = decTobcd(result.month) & 0xff;
- out->buffer[0x98] = decTobcd(result.mday) & 0xff;
- out->buffer[0x99] = decTobcd(result.hour) & 0xff;
- out->buffer[0x9a] = decTobcd(result.min) & 0xff;
- out->buffer[0x9b] = decTobcd(result.sec) & 0xff;
- out->buffer[0x9c] = 0xff;
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- sscanf((char*)ShmSysConfigAndInfo->SysInfo.AcChargingData[index].StartDateTime, "%d.%d.%d %d:%d:%d",
- &result.year,
- &result.month,
- &result.mday,
- &result.hour,
- &result.min,
- &result.sec);
- out->buffer[0x95] = decTobcd(result.year/100) & 0xff;
- out->buffer[0x96] = decTobcd(result.year%100) & 0xff;
- out->buffer[0x97] = decTobcd(result.month) & 0xff;
- out->buffer[0x98] = decTobcd(result.mday) & 0xff;
- out->buffer[0x99] = decTobcd(result.hour) & 0xff;
- out->buffer[0x9a] = decTobcd(result.min) & 0xff;
- out->buffer[0x9b] = decTobcd(result.sec) & 0xff;
- out->buffer[0x9c] = 0xff;
- }
- }
- break;
- }
- // Surplus
- memset(&out->buffer[0x9d], 0x00, 0x04);
- // System variable reserve
- memset(&out->buffer[0xa1], 0x00, 0x14);
- // RFID/Member flag
- out->buffer[0xb5] = 0x00;
- // Order No.
- memset(&out->buffer[0xb6], 0x00, 0x20);
- // SN
- memset(&out->buffer[0xd6], 0x00, 0x10);
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- void create_Cmd_1106(struct Message *out)
- {
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 0x63;
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (1106>>0) & 0xff;
- out->buffer[0x07] = (1106>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Charger ID
- memcpy(&out->buffer[0x0c], &ShmSysConfigAndInfo->SysConfig.SystemId[0], 32);
- // Charger type (0:Normal 1:none polar 2:polling)
- out->buffer[0x2c] = 0x00;
- // Software version
- out->buffer[0x2d] = 0x01;
- out->buffer[0x2e] = 0x00;
- out->buffer[0x2f] = 0x00;
- out->buffer[0x30] = 0x00;
- // Charger item type
- out->buffer[0x31] = 0x00;
- out->buffer[0x32] = 0x00;
- // Start count
- out->buffer[0x33] = 0x00;
- out->buffer[0x34] = 0x00;
- out->buffer[0x35] = 0x00;
- out->buffer[0x36] = 0x00;
- // Data upload type (1:Handshake 2:Report)
- out->buffer[0x37] = 0x02;
- // Register time (Minute)
- out->buffer[0x38] = 0x00;
- out->buffer[0x39] = 0x00;
- // Spare
- out->buffer[0x3a] = 0x00;
- // Charge gun count
- out->buffer[0x3b] = 0x01;
- // Heart beat upload cycle
- out->buffer[0x3c] = 0x98;
- // Heart beat overtime count
- out->buffer[0x3d] = 0x00;
- // Charge record count
- out->buffer[0x3e] = 0x00;
- out->buffer[0x3f] = 0x00;
- out->buffer[0x40] = 0x00;
- out->buffer[0x41] = 0x00;
- // Current system time
- out->buffer[0x42] = 0x20;
- out->buffer[0x43] = 0x20;
- out->buffer[0x44] = 0x06;
- out->buffer[0x45] = 0x11;
- out->buffer[0x46] = 0x11;
- out->buffer[0x47] = 0x02;
- out->buffer[0x48] = 0x18;
- out->buffer[0x49] = 0xff;
- // Latest charge time
- out->buffer[0x4a] = 0x20;
- out->buffer[0x4b] = 0x20;
- out->buffer[0x4c] = 0x06;
- out->buffer[0x4d] = 0x11;
- out->buffer[0x4e] = 0x11;
- out->buffer[0x4f] = 0x01;
- out->buffer[0x50] = 0x52;
- out->buffer[0x51] = 0xff;
- // Latest start time
- out->buffer[0x52] = 0x20;
- out->buffer[0x53] = 0x20;
- out->buffer[0x54] = 0x06;
- out->buffer[0x55] = 0x11;
- out->buffer[0x56] = 0x11;
- out->buffer[0x57] = 0x01;
- out->buffer[0x58] = 0x52;
- out->buffer[0x59] = 0xff;
- // Latest register time
- out->buffer[0x5a] = 0x20;
- out->buffer[0x5b] = 0x20;
- out->buffer[0x5c] = 0x06;
- out->buffer[0x5d] = 0x11;
- out->buffer[0x5e] = 0x11;
- out->buffer[0x5f] = 0x02;
- out->buffer[0x60] = 0x08;
- out->buffer[0x61] = 0xff;
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- void create_Cmd_2304(struct Message *out)
- {
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 0x0e;
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (2304>>0) & 0xff;
- out->buffer[0x07] = (2304>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Result (0:Success 1:Fail)
- out->buffer[0x0c] = 0x00;
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- void create_Cmd_2306(struct Message *out)
- {
- memset(out->buffer, 0, ARRAY_SIZE(out->buffer));
- out->size = 0x11;
- // Message header
- out->buffer[0x00] = (message_header>>8) & 0xff;
- out->buffer[0x01] = (message_header>>0) & 0xff;
- // Message length
- out->buffer[0x02] = (out->size>>0) & 0xff;
- out->buffer[0x03] = (out->size>>8) & 0xff;
- // Message protocol version
- out->buffer[0x04] = PROTOCOL_VER;
- // Message server command serial number
- out->buffer[0x05] = server_cmd_sn & 0xff;
- // Message command
- out->buffer[0x06] = (2306>>0) & 0xff;
- out->buffer[0x07] = (2306>>8) & 0xff;
- // Message user id
- out->buffer[0x08] = (server_user_id>>0) & 0xff;
- out->buffer[0x09] = (server_user_id>>8) & 0xff;
- // Message server command serial number
- out->buffer[0x0a] = (server_cmd_sn>>0) & 0xff;
- out->buffer[0x0b] = (server_cmd_sn>>8) & 0xff;
- // Result (0:Success 1:Fail)
- out->buffer[0x0c] = 0x00;
- out->buffer[0x0d] = 0x00;
- out->buffer[0x0e] = 0x00;
- out->buffer[0x0f] = 0x00;
- // Checksum
- out->buffer[out->size-1] = checksum_cal(out);
- showCmdRaw(out, true);
- }
- int main(void)
- {
- struct PreviousState
- {
- uint8_t sys_mode;
- uint8_t connector_status;
- uint8_t isReportStatusReq:1;
- }previousState[3];
- int sockfd;
- struct sockaddr_in info;
- struct hostent *ghbn;
- struct timeval tv;
- uint8_t socketEnable;
- struct Message input;
- struct Message intputBuf;
- struct Message output;
- sprintf((char*)server_addr, "evsocket.phihong.com.tw");
- server_port = 9999;
- if(InitShareMemory() == FAIL)
- {
- DEBUG_ERROR("InitShareMemory NG\n");
- if(ShmStatusCodeData!=NULL)
- {
- ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory=ON;
- }
- sleep(5);
- return 0;
- }
- RatedCurrentParsing((char*)ShmSysConfigAndInfo->SysConfig.ModelName, &modelnameInfo);
- DEBUG_INFO("Initialize OK!\n");
- for(;;)
- {
- while(!ShmSysConfigAndInfo->SysInfo.InternetConn)
- {
- sleep(1);
- }
- bzero(&info,sizeof(info));
- ghbn = gethostbyname((char*)server_addr);
- info.sin_family = PF_INET;
- info.sin_addr.s_addr = inet_addr(inet_ntoa(*(struct in_addr *)ghbn->h_addr_list[0]));
- info.sin_port = htons(server_port);
- DEBUG_INFO("Connecto to %s:%d\n", inet_ntoa(*(struct in_addr *)ghbn->h_addr_list[0]), server_port);
- sockfd = socket(AF_INET, SOCK_STREAM, 0);
- if (sockfd == -1)
- {
- DEBUG_ERROR("Fail to create a socket.");
- return 0;
- }
- if(connect(sockfd, (struct sockaddr *)&info,sizeof(info)) ==-1)
- {
- DEBUG_ERROR("Connection error");
- }
- else
- {
- DEBUG_INFO("Connect success.\n");
- tv.tv_sec = 0;
- tv.tv_usec = 500000;
- setsockopt(sockfd, SOL_SOCKET, SO_RCVTIMEO, (const char*)&tv, sizeof tv);
- socketEnable = ON;
- }
- while(socketEnable)
- {
- memset(input.buffer, 0, ARRAY_SIZE(input.buffer));
- if((input.size = recv(sockfd, input.buffer, ARRAY_SIZE(input.buffer), 0)) > 0)
- {
- if(input.size < ARRAY_SIZE(input.buffer))
- {
- //DEBUG_INFO("Receive size: %d.\n", input.size);
- for(uint16_t idx=0;idx<input.size;idx++)
- {
- if((input.buffer[idx] == ((message_header>>8) & 0xff)) && (input.buffer[idx+1] == ((message_header>>0) & 0xff)))
- {
- //DEBUG_INFO("idx: %d\n", idx);
- memset(&intputBuf.buffer[0], 0x00, ARRAY_SIZE(intputBuf.buffer));
- memcpy(&intputBuf.buffer[0], &input.buffer[idx], input.buffer[idx+2] | ((uint16_t)input.buffer[idx+3]<<8));
- intputBuf.size = input.buffer[idx+2] | ((uint16_t)input.buffer[idx+3]<<8);
- idx += (input.buffer[idx+2] | (uint16_t)input.buffer[idx+3]) -1;
- server_cmd_sn = intputBuf.buffer[10] | ((uint16_t)intputBuf.buffer[11]<<8);
- if(!checksum_valid(&intputBuf))
- DEBUG_INFO("Message checksum wrong.\n");
- else
- {
- showCmdRaw(&intputBuf, OFF);
- switch(intputBuf.buffer[6] | ((uint16_t)intputBuf.buffer[7]<<8))
- {
- case 1001:
- handle_cmd_1001(&intputBuf, &output);
- send(sockfd, output.buffer, output.size, 0);
- break;
- case 1003:
- handle_cmd_1003(&intputBuf, &output);
- send(sockfd, output.buffer, output.size, 0);
- break;
- case 1005:
- handle_cmd_1005(&intputBuf, &output);
- send(sockfd, output.buffer, output.size, 0);
- break;
- case 1101:
- handle_cmd_1101(&intputBuf);
- break;
- case 1103:
- handle_cmd_1103(&intputBuf);
- break;
- case 1105:
- handle_cmd_1105(&intputBuf);
- break;
- case 2303:
- handle_cmd_2303(&intputBuf, &output);
- send(sockfd, output.buffer, output.size, 0);
- break;
- case 2305:
- handle_cmd_2305(&intputBuf, &output);
- send(sockfd, output.buffer, output.size, 0);
- break;
- }
- }
- }
- }
- }
- }
- else if(input.size == 0)
- {
- DEBUG_INFO("Disconnected.\n");
- fflush(stdout);
- backend_info.isSignin = OFF;
- socketEnable = OFF;
- }
- else if(input.size == -1)
- {
- // Sign in request
- if(!backend_info.isSignin)
- {
- create_Cmd_1106(&output);
- send(sockfd, output.buffer, output.size, 0);
- }
- // Heart beat request
- if(backend_info.isSignin && (difftime(time((time_t*)NULL), backend_info.st_hearbeat) > backend_info.interval_heartbeat))
- {
- create_Cmd_1102(&output);
- send(sockfd, output.buffer, output.size, 0);
- backend_info.st_hearbeat = time((time_t*)NULL);
- backend_info.counter_heartbeat_retry++;
- }
- // Heart beat retry fail
- if(backend_info.isSignin && (backend_info.counter_heartbeat_retry > backend_info.retry_heartbeat))
- {
- fflush(stdout);
- backend_info.isSignin = OFF;
- socketEnable = OFF;
- DEBUG_ERROR("Heart beat retry over count.\n");
- }
- for(uint8_t gun_index=0;gun_index<modelnameInfo.GetGunCount;gun_index++)
- {
- uint8_t tempIndex;
- switch(modelnameInfo.ParsingInfo[gun_index].GunType)
- {
- case Gun_Type_Chademo:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus != previousState[index].sys_mode) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn != previousState[index].connector_status) )
- {
- previousState[index].sys_mode = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus;
- previousState[index].connector_status = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn;
- previousState[gun_index].isReportStatusReq = ON;
- }
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CHAdeMO_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus != previousState[index].sys_mode) || (ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].ConnectorPlugIn != previousState[index].connector_status) )
- {
- previousState[index].sys_mode = ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].SystemStatus;
- previousState[index].connector_status = ShmSysConfigAndInfo->SysInfo.ChademoChargingData[index].ConnectorPlugIn;
- previousState[gun_index].isReportStatusReq = ON;
- }
- }
- }
- }
- break;
- case Gun_Type_CCS_2:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus != previousState[index].sys_mode) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn != previousState[index].connector_status) )
- {
- previousState[index].sys_mode = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus;
- previousState[index].connector_status = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn;
- previousState[gun_index].isReportStatusReq = ON;
- }
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < CCS_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus != previousState[index].sys_mode) || (ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].ConnectorPlugIn != previousState[index].connector_status) )
- {
- previousState[index].sys_mode = ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].SystemStatus;
- previousState[index].connector_status = ShmSysConfigAndInfo->SysInfo.CcsChargingData[index].ConnectorPlugIn;
- previousState[gun_index].isReportStatusReq = ON;
- }
- }
- }
- }
- break;
- case Gun_Type_GB:
- if((ShmSysConfigAndInfo->SysConfig.ModelName[0] == 'D') && ((ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'O') || (ShmSysConfigAndInfo->SysConfig.ModelName[1] == 'K')))
- {
- tempIndex = gun_index;
- for (int index = 0; index < GENERAL_GUN_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus != previousState[index].sys_mode) || (ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn != previousState[index].connector_status) )
- {
- previousState[index].sys_mode = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.SystemStatus;
- previousState[index].connector_status = ShmSysConfigAndInfo->SysInfo.ConnectorInfo[index].GeneralChargingData.ConnectorPlugIn;
- previousState[gun_index].isReportStatusReq = ON;
- }
- }
- }
- }
- else
- {
- if(ShmSysConfigAndInfo->SysConfig.ModelName[8] != '0')
- {
- tempIndex = ((gun_index==2) ? 1: 0);
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < GB_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus != previousState[index].sys_mode) || (ShmSysConfigAndInfo->SysInfo.GbChargingData[index].ConnectorPlugIn != previousState[index].connector_status) )
- {
- previousState[index].sys_mode = ShmSysConfigAndInfo->SysInfo.GbChargingData[index].SystemStatus;
- previousState[index].connector_status = ShmSysConfigAndInfo->SysInfo.GbChargingData[index].ConnectorPlugIn;
- previousState[gun_index].isReportStatusReq = ON;
- }
- }
- }
- }
- break;
- case Gun_Type_AC:
- if(ShmSysConfigAndInfo->SysConfig.ModelName[0]=='D')
- {
- tempIndex = 2;
- }
- else
- {
- tempIndex = gun_index;
- }
- for (int index = 0; index < AC_QUANTITY; index++)
- {
- if (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].Index == tempIndex)
- {
- if((ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus != previousState[index].sys_mode) || (ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PilotState != previousState[index].connector_status) )
- {
- previousState[index].sys_mode = ShmSysConfigAndInfo->SysInfo.AcChargingData[index].SystemStatus;
- previousState[index].connector_status = ShmSysConfigAndInfo->SysInfo.AcChargingData[index].PilotState;
- previousState[gun_index].isReportStatusReq = ON;
- }
- }
- }
- break;
- }
- // Send status to backend server
- if(previousState[gun_index].isReportStatusReq || (difftime(time((time_t*)NULL), backend_info.st_status[gun_index]) > backend_info.interval_status))
- {
- create_Cmd_1104(&output, gun_index);
- send(sockfd, output.buffer, output.size, 0);
- previousState[gun_index].isReportStatusReq = OFF;
- backend_info.st_status[gun_index] = time((time_t*)NULL);
- }
- }
- }
- usleep(100000);
- }
- close(sockfd);
- sleep(5);
- }
- return 0;
- }
|