1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284 |
- #include "plt.h"
- #define DELAY_CNT (200) // 10ms * DELAY_CNT
- static unsigned char dlt645_cal_chksum(int old_chk_sum, char *buf, int buf_sz)
- {
- unsigned int SumVal = old_chk_sum;
- int i;
- for (i = 0; i < buf_sz; i++)
- {
- SumVal += buf[i];
- }
- return (SumVal & 0xFF);
- }
- #define METER_STX 0x68
- #define ADR 0xaa
- #define METER_ADRLEN 6
- #define METER_EDX 0x16
- static void dlt645_pack_d07_frame(int idx, unsigned long inRulerID)
- {
- int i;
- struct dlt645_t *dev = &dlt645[idx];
- int chan_idx = dev->comm.chanidx;
- // struct chan_t* chan = &sta.chan[chan_idx];
- S_D07_RULER_INFO info = {0};
- char dump_buf[1024];
- int ret = get_d07_ruler_info(inRulerID, &info);
- if (ret != E_D07_OK)
- {
- log_dbg("%s, invalid ruler id", __func__);
- return;
- }
- unsigned char ucCtrl = 0;
- S_D07_CTRL_CODE stCtrl = {0};
- int dir = 0;
- char addr[64] = {0}; // 地址
- S_D07_PACK_FRAME pack_frame = {0};
- int length = 0;
- char buffer[256] = {0};
- chan_serial_ringbuffer_element_t e_arr[256];
- char data[256] = {0};
- char user[256] = {0};
- F_D07_RULER_TRANS func = NULL;
- strcpy(addr, dev->szaddr);
- dir = E_D07_CTRL_DIR_S2M;
- stCtrl.direct = (E_D07_CTRL_DIR)dir;
- func = info.func;
- if (info.type == E_D07_RULER_TYPE_COMB_HAVE_POWER_TOTAL)
- {
- sprintf(user, "%6.2f", dev->com_active_e / dev->pratio);
- }
- else if (info.type == E_D07_RULER_TYPE_FORTH_HAVE_POWER_TOTAL)
- {
- sprintf(user, "%6.2f", dev->pos_active_e / dev->pratio);
- }
- else if (info.type == E_D07_RULER_TYPE_BACK_HAVE_POWER_TOTAL)
- {
- sprintf(user, "%6.2f", dev->neg_active_e / dev->pratio);
- }
- else if (info.type == E_D07_RULER_TYPE_PHASE_A_VOLT)
- {
- sprintf(user, "%3.1f", dev->ua / dev->vratio);
- }
- else if (info.type == E_D07_RULER_TYPE_PHASE_B_VOLT)
- {
- sprintf(user, "%3.1f", dev->ub / dev->vratio);
- }
- else if (info.type == E_D07_RULER_TYPE_PHASE_C_VOLT)
- {
- sprintf(user, "%3.1f", dev->uc / dev->vratio);
- }
- else if (info.type == E_D07_RULER_TYPE_PHASE_A_ELEC)
- {
- sprintf(user, "%3.3f", dev->ia / dev->cratio);
- }
- else if (info.type == E_D07_RULER_TYPE_PHASE_B_ELEC)
- {
- sprintf(user, "%3.3f", dev->ib / dev->cratio);
- }
- else if (info.type == E_D07_RULER_TYPE_PHASE_C_ELEC)
- {
- sprintf(user, "%3.3f", dev->ic / dev->cratio);
- }
- else if (info.type == E_D07_RULER_TYPE_INSTANT_HAVE_POWER_RATE_TOTAL)
- {
- sprintf(user, "%2.4f", (double)dev->com_active_p / dev->pratio);
- }
- else if (info.type == E_D07_RULER_TYPE_UNKNOWN)
- {
- log_dbg("%s, info.type == E_D07_RULER_TYPE_UNKNOWN", __func__);
- return;
- }
- else
- {
- log_dbg("%s, TYPE_UNKNOWN", __func__);
- return;
- }
- func(E_D07_TRANS_U2F, user, data);
- // log_dbg("%s, user:%s, data:%s", __func__, user, data);
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data = data;
- pack_frame.data_len = info.len + 4;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl); // 将结构封装成字节
- if (ret != E_D07_OK)
- {
- log_dbg("%s, \ntrans_d07ctrl_struct2char failed %d\n", __func__, ret);
- return;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("%s, \npack frame failed %d\n", __func__, ret);
- return;
- }
- for (i = 0; i < length; i++)
- {
- e_arr[i].c = buffer[i];
- }
- // misc_dump(dump_buf, buffer, length);
- // log_dbg("%s, try to send %d bytes:%s", __func__, length, dump_buf);
- chan_lock(chan_idx);
- chan_serial_txrb_queue_arr(chan_idx, e_arr, length);
- chan_unlock(chan_idx);
- }
- static void dlt645_handle_d07_frame(int idx)
- {
- int i, j = 0;
- int ret = 0;
- S_D07_UNPACK stUnPack = {0};
- S_D07_RULER_INFO info = {0};
- struct dlt645_t *dev = &dlt645[idx];
- char *buf = dev->recvbuf;
- int len = dev->recvcnt;
- ret = unpack_d07_frame(buf, len, &stUnPack);
- if (ret != E_D07_OK)
- {
- log_dbg("%s, \n unpack fail! (error = %d : ", __func__, ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("%s, incomplete frame)\n", __func__);
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("%s, start byte 0x68 possition error)\n", __func__);
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("%s, chksum err)\n", __func__);
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("%s, end byte 0x16 err)\n", __func__);
- break;
- default:
- break;
- }
- return;
- }
- if (strcmp(stUnPack.address, dev->szaddr) == 0)
- {
- dlt645_pack_d07_frame(idx, stUnPack.ruler_id);
- }
- else
- {
- log_dbg("%s, addr not match: %s - %s", __func__, stUnPack.address, dev->szaddr);
- }
- }
- static void dlt645_proc_recv(int idx)
- {
- struct dlt645_t *dev = &dlt645[idx];
- int chan_idx = dev->comm.chanidx;
- // struct chan_t* chan = &sta.chan[chan_idx];
- size_t needprocess = 0;
- int nprocess = 0;
- chan_serial_ringbuffer_element_t e_arr[128];
- int i;
- char recvbyte;
- int *st = &dev->recvst;
- int *recvcnt = &dev->recvcnt;
- int *recvcnt2 = &dev->recvcnt2;
- char *recvbuf = dev->recvbuf;
- int *tick = &dev->tick;
- int *dl = &dev->dl;
- unsigned char chksum = 0;
- S_D07_UNPACK unpack;
- chan_lock(chan_idx);
- needprocess = chan_serial_rxrb_num_items(chan_idx);
- if (needprocess > 0)
- {
- nprocess = (needprocess > sizeof(e_arr) / sizeof(chan_serial_ringbuffer_element_t)) ? (sizeof(e_arr) / sizeof(chan_serial_ringbuffer_element_t)) : needprocess;
- chan_serial_rxrb_dequeue_arr(chan_idx, e_arr, nprocess);
- // log_dbg("%s, got %d bytes", __func__, nprocess);
- }
- chan_unlock(chan_idx);
- if (nprocess > 0)
- {
- for (i = 0; i < nprocess; i++)
- {
- recvbyte = e_arr[i].c;
- // log_dbg("%s, st:%d, got %02X-%c", __func__, *st, recvbyte,recvbyte);
- switch (*st)
- {
- case MRECV_WAIT4STX:
- if (recvbyte == METER_STX)
- {
- *recvcnt = 0;
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_ADDR;
- *recvcnt2 = 0;
- *tick = 0;
- }
- break;
- case MRECV_ADDR:
- recvbuf[(*recvcnt)++] = recvbyte;
- if (++(*recvcnt2) == METER_ADRLEN)
- {
- *st = MRECV_STX2;
- *tick = 0;
- }
- break;
- case MRECV_STX2:
- if (recvbyte == METER_STX)
- {
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_CTRL;
- *tick = 0;
- }
- else
- {
- *st = MRECV_WAIT4STX;
- }
- break;
- case MRECV_CTRL:
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_DL;
- *tick = 0;
- break;
- case MRECV_DL:
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_D;
- *tick = 0;
- *recvcnt2 = 0;
- *dl = recvbyte;
- break;
- case MRECV_D:
- recvbuf[(*recvcnt)++] = recvbyte;
- if (++(*recvcnt2) == *dl)
- {
- *st = MRECV_CS;
- *tick = 0;
- }
- break;
- case MRECV_CS:
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_ETX;
- *tick = 0;
- break;
- case MRECV_ETX:
- recvbuf[(*recvcnt)++] = recvbyte;
- chksum = dlt645_cal_chksum(0, recvbuf, *recvcnt - 2);
- if (chksum == recvbuf[*recvcnt - 2])
- { // chksum ok
- // log_dbg("%s, get cmd frame", __func__);
- dlt645_handle_d07_frame(idx);
- }
- else
- {
- log_dbg("%s, chksum err %d/%d", __func__, chksum, recvbuf[*recvcnt - 2]);
- }
- *st = MRECV_WAIT4STX;
- break;
- }
- }
- }
- else
- {
- if ((*tick)++ > 100)
- {
- *st = MRECV_WAIT4STX;
- }
- }
- }
- static int dlt645_recv_rsp(int idx)
- {
- struct dlt645_t *dev = &dlt645[idx];
- int chan_idx = dev->comm.chanidx;
- // struct chan_t* chan = &sta.chan[chan_idx];
- int needprocess = 0;
- int nprocess = 0;
- chan_serial_ringbuffer_element_t e_arr[128];
- int i;
- char recvbyte;
- int *st = &dev->recvst;
- int *recvcnt = &dev->recvcnt;
- int *recvcnt2 = &dev->recvcnt2;
- char *recvbuf = dev->recvbuf;
- int *tick = &dev->tick;
- int *dl = &dev->dl;
- unsigned char chksum = 0;
- S_D07_UNPACK unpack;
- int ret = -1;
- chan_lock(chan_idx);
- needprocess = chan_serial_rxrb_num_items(chan_idx);
- if (needprocess > 0)
- {
- nprocess = (needprocess > sizeof(e_arr) / sizeof(chan_serial_ringbuffer_element_t)) ? (sizeof(e_arr) / sizeof(chan_serial_ringbuffer_element_t)) : needprocess;
- chan_serial_rxrb_dequeue_arr(chan_idx, e_arr, nprocess);
- // log_dbg("%s, got %d bytes", __func__, nprocess);
- }
- chan_unlock(chan_idx);
- if (nprocess > 0)
- {
- for (i = 0; i < nprocess; i++)
- {
- recvbyte = e_arr[i].c;
- // log_dbg("%s, st:%d, got %02X-%c", __func__, *st, recvbyte,recvbyte);
- switch (*st)
- {
- case MRECV_WAIT4STX:
- if (recvbyte == METER_STX)
- {
- *recvcnt = 0;
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_ADDR;
- *recvcnt2 = 0;
- *tick = 0;
- }
- break;
- case MRECV_ADDR:
- recvbuf[(*recvcnt)++] = recvbyte;
- if (++(*recvcnt2) == METER_ADRLEN)
- {
- *st = MRECV_STX2;
- *tick = 0;
- }
- break;
- case MRECV_STX2:
- if (recvbyte == METER_STX)
- {
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_CTRL;
- *tick = 0;
- }
- else
- {
- *st = MRECV_WAIT4STX;
- }
- break;
- case MRECV_CTRL:
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_DL;
- *tick = 0;
- break;
- case MRECV_DL:
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_D;
- *tick = 0;
- *recvcnt2 = 0;
- *dl = recvbyte;
- break;
- case MRECV_D:
- recvbuf[(*recvcnt)++] = recvbyte;
- if (++(*recvcnt2) == *dl)
- {
- *st = MRECV_CS;
- *tick = 0;
- }
- break;
- case MRECV_CS:
- recvbuf[(*recvcnt)++] = recvbyte;
- *st = MRECV_ETX;
- *tick = 0;
- break;
- case MRECV_ETX:
- recvbuf[(*recvcnt)++] = recvbyte;
- chksum = dlt645_cal_chksum(0, recvbuf, *recvcnt - 2);
- if (chksum == recvbuf[*recvcnt - 2])
- { // chksum ok
- // log_dbg("%s, get cmd frame", __func__);
- return 0;
- // dlt645_handle_d07_frame(idx);
- }
- else
- {
- log_dbg("%s, chksum err %d/%d", __func__, chksum, recvbuf[*recvcnt - 2]);
- }
- *st = MRECV_WAIT4STX;
- break;
- }
- }
- }
- else
- {
- if ((*tick)++ > 100)
- {
- *st = MRECV_WAIT4STX;
- }
- }
- return ret;
- }
- int dlt645_read_com_ae(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int i, cnt, rc;
- int ret = -1;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_COMB_HAVE_POWER_TOTAL;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != E_D07_RULER_TYPE_COMB_HAVE_POWER_TOTAL)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->com_active_e = stUnPack.data_unpack.fPower * dev->pratio;
- // log_dbg("%s, com_ae = %.2f", __func__, dev->com_active_e);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_com_ap(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_INSTANT_HAVE_POWER_RATE_TOTAL;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != E_D07_RULER_TYPE_INSTANT_HAVE_POWER_RATE_TOTAL)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->com_active_p = stUnPack.data_unpack.fPower * dev->pratio;
- // log_dbg("%s, com_ap = %.1f", __func__, dev->com_active_p);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_ua(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_PHASE_A_VOLT;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != E_D07_RULER_TYPE_PHASE_A_VOLT)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->ua = stUnPack.data_unpack.fPower * dev->vratio;
- // log_dbg("%s, ua = %.1f", __func__, dev->ua);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_ub(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_PHASE_B_VOLT;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != inRulerID)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->ub = stUnPack.data_unpack.fPower * dev->vratio;
- // log_dbg("%s, ub = %.1f", __func__, dev->ub);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_uc(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_PHASE_C_VOLT;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != inRulerID)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->uc = stUnPack.data_unpack.fPower * dev->vratio;
- // log_dbg("%s, uc = %.1f", __func__, dev->uc);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_ia(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_PHASE_A_ELEC;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != E_D07_RULER_TYPE_PHASE_A_ELEC)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->ia = stUnPack.data_unpack.fPower * dev->cratio;
- // log_dbg("%s, ia = %.3f", __func__, dev->ia);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_ib(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_PHASE_B_ELEC;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != inRulerID)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->ib = stUnPack.data_unpack.fPower * dev->cratio;
- // log_dbg("%s, ib = %.3f", __func__, dev->ib);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_ic(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_PHASE_C_ELEC;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != inRulerID)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->ic = stUnPack.data_unpack.fPower * dev->cratio;
- // log_dbg("%s, ic = %.3f", __func__, dev->ic);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_pos_ae(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_FORTH_HAVE_POWER_TOTAL;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != E_D07_RULER_TYPE_FORTH_HAVE_POWER_TOTAL)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->pos_active_e = stUnPack.data_unpack.fPower * dev->pratio;
- // log_dbg("%s, pos_ae = %.2f", __func__, dev->pos_active_e);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- int dlt645_read_neg_ae(int idx)
- {
- int num = 1;
- struct dlt645_t *dev = &dlt645[idx];
- char addr[64] = {0};
- unsigned long inRulerID;
- S_D07_RULER_INFO info = {0};
- F_D07_RULER_TRANS func = NULL;
- S_D07_PACK_FRAME pack_frame = {0};
- S_D07_UNPACK stUnPack = {0};
- unsigned char ucCtrl = 0;
- int length = 0;
- char buffer[256] = {0};
- int ret, i, cnt, rc;
- chan_serial_ringbuffer_element_t e[256];
- // log_dbg("%s, ++", __func__);
- inRulerID = E_D07_RULER_TYPE_BACK_HAVE_POWER_TOTAL;
- ret = get_d07_ruler_info(inRulerID, &info);
- S_D07_CTRL_CODE stCtrl = {0};
- strcpy(addr, dev->szaddr);
- stCtrl.direct = E_D07_CTRL_DIR_M2S;
- stCtrl.funcode = E_D07_CTRL_READ_DATA;
- pack_frame.data_len = 4;
- pack_frame.data = NULL;
- ret = trans_d07ctrl_struct2char(&ucCtrl, &stCtrl);
- if (ret != E_D07_OK)
- {
- log_dbg("\ntrans_d07ctrl_struct2char failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- pack_frame.ruler_id = inRulerID;
- pack_frame.ctrl_code = ucCtrl;
- memcpy(pack_frame.address, addr, 13);
- ret = pack_d07_frame_by_data(&pack_frame, buffer, &length);
- if (ret != E_D07_OK)
- {
- log_dbg("\npack frame failed %d\n", ret);
- ret = -1;
- goto leave;
- }
- // dlt645api_show_packet(length, buffer);
- for (i = 0; i < length; i++)
- {
- e[i].c = buffer[i];
- // log_dbg("%02X ", buffer[i]);
- }
- // chan_lock(dev->comm.chanidx);
- chan_serial_rxrb_init(dev->comm.chanidx);
- chan_serial_txrb_init(dev->comm.chanidx);
- chan_serial_txrb_queue_arr(dev->comm.chanidx, e, length);
- dev->recvst = MRECV_WAIT4STX;
- cnt = DELAY_CNT;
- while (cnt-- > 0)
- {
- usleep(10000); /* 10ms */
- rc = dlt645_recv_rsp(idx);
- if (rc == 0)
- {
- break;
- }
- }
- // chan_unlock(dev->comm.chanidx);
- if (rc == 0)
- {
- // log_dbg("frame is : ");
- // for(i = 0; i < dev->recvcnt; i++){
- // log_dbg("%02X ",dev->recvbuf[i]);
- // }
- // dlt645api_debug_switch(D07_ON);
- rc = dlt645api_unpack_d07_frame(dev->recvbuf, dev->recvcnt, &stUnPack);
- // dlt645api_debug_switch(D07_OFF);
- if (ret != E_D07_OK)
- {
- log_dbg("\n error! (error = %d : ", ret);
- switch (ret)
- {
- case E_D07_ERRO_FRAME_UNCOMP:
- log_dbg("frame not complete)\n");
- break;
- case E_D07_ERRO_FRAME_0x68:
- log_dbg("start 0x68 position err)\n");
- break;
- case E_D07_ERRO_FRAME_CHECK_SUM:
- log_dbg("chksum error)\n");
- break;
- case E_D07_ERRO_FRAME_END_0x16:
- log_dbg("end 0x16 err)\n");
- break;
- default:
- break;
- }
- ret = -1;
- goto leave;
- }
- if (stUnPack.ruler_id != E_D07_RULER_TYPE_BACK_HAVE_POWER_TOTAL)
- {
- log_dbg("%s, stUnPack.ruler_id not correct ", __func__);
- ret = -1;
- goto leave;
- }
- else
- {
- dev->neg_active_e = stUnPack.data_unpack.fPower * dev->pratio;
- // log_dbg("%s, neg_ae = %.2f", __func__, dev->neg_active_e);
- ret = 0;
- goto leave;
- }
- }
- else
- {
- ret = -1;
- goto leave;
- }
- leave:
- if (ret < 0)
- {
- log_dbg("%s, --, ret:%d", __func__, ret);
- }
- return ret;
- }
- #if 0
- void dlt645_comm_dac(int idx)
- {
- struct dlt645_t* dev = &dlt645[idx];
- struct comm_t* comm = &dev->comm;
- int trycnt;
- if(comm_get_state(comm) != COMMST_NORMAL){
- return;
- }
- comm_start_cal_dac_timing(comm);
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_com_ap(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- if( dev->comm.dac.stp == 0 ){ /* com_ae */
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_com_ae(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 1;
- }else if( dev->comm.dac.stp == 1 ){
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_pos_ae(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 2;
- }else if( dev->comm.dac.stp == 2 ){
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_neg_ae(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 3;
- }else if( dev->comm.dac.stp == 3 ){
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_ua(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 4;
- }else if( dev->comm.dac.stp == 4 ){
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_ub(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 5;
- }else if( dev->comm.dac.stp == 5 ){
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_uc(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 6;
- }else if( dev->comm.dac.stp == 6 ){
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_ia(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 7;
- }else if( dev->comm.dac.stp == 7 ){
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_ib(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 8;
- }else if( dev->comm.dac.stp == 8 ){ /* ic */
- trycnt = 0;
- while( 1 ){
- if( dlt645_read_ic(idx) == 0){
- break;
- }else{
- if( trycnt++ >= 3 ){
- comm_set_state(comm, COMMST_ERR);
- return;
- }else{
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 0;
- comm_stop_cal_dac_timing(comm);
- }else{
- dev->comm.dac.stp = 0;
- }
- }
- #endif
- void dlt645_comm_dac(int idx)
- {
- struct dlt645_t *dev = &dlt645[idx];
- struct comm_t *comm = &dev->comm;
- int trycnt;
- if (comm_get_state(comm) != COMMST_NORMAL)
- {
- return;
- }
- comm_start_cal_dac_timing(comm);
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_com_ap(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_com_ae(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_pos_ae(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_neg_ae(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- if (dev->comm.dac.stp == 0)
- {
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_ua(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 1;
- }
- else if (dev->comm.dac.stp == 1)
- {
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_ub(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 2;
- }
- else if (dev->comm.dac.stp == 2)
- {
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_uc(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 3;
- }
- else if (dev->comm.dac.stp == 3)
- {
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_ia(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 4;
- }
- else if (dev->comm.dac.stp == 4)
- {
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_ib(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 5;
- }
- else if (dev->comm.dac.stp == 5)
- { /* ic */
- trycnt = 0;
- while (1)
- {
- if (dlt645_read_ic(idx) == 0)
- {
- break;
- }
- else
- {
- if (trycnt++ >= 3)
- {
- comm_set_state(comm, COMMST_ERR);
- return;
- }
- else
- {
- usleep(100000); /* 100ms */
- }
- }
- }
- usleep(100000); /* 100ms */
- dev->comm.dac.stp = 0;
- }
- else
- {
- dev->comm.dac.stp = 0;
- }
- comm_stop_cal_dac_timing(comm);
- }
- int dlt645_comm_init(int idx)
- {
- struct dlt645_t *dev = &dlt645[idx];
- struct comm_t *comm = &dev->comm;
- dev->recvst = MRECV_WAIT4STX;
- comm->dac.stp = 0;
- comm_set_state(comm, COMMST_ERR);
- }
- int dlt645_comm_reset(int idx)
- {
- struct dlt645_t *dev = &dlt645[idx];
- struct comm_t *comm = &dev->comm;
- dev->recvst = MRECV_WAIT4STX;
- comm_set_state(comm, COMMST_NORMAL);
- }
|