//OpenSCADA system module DAQ.DCON file: DCON_client.cpp /*************************************************************************** * Copyright (C) 2008-2011 by Roman Savochenko, Almaz Karimov * * * * This program is free software; you can redistribute it and/or modify * * it under the terms of the GNU General Public License as published by * * the Free Software Foundation; version 2 of the License. * * * * This program is distributed in the hope that it will be useful, * * but WITHOUT ANY WARRANTY; without even the implied warranty of * * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * * GNU General Public License for more details. * * * * You should have received a copy of the GNU General Public License * * along with this program; if not, write to the * * Free Software Foundation, Inc., * * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * ***************************************************************************/ #include #include #include #include #include #include #include #include #include #include #include "DCON_client.h" //************************************************* //* Modul info! * #define MOD_ID "DCON" #define MOD_NAME _("DCON client") #define MOD_TYPE SDAQ_ID #define VER_TYPE SDAQ_VER #define MOD_VER "0.5.1" #define AUTHORS _("Roman Savochenko, Almaz Karimov") #define DESCRIPTION _("Allow realization of DCON client service. Supported I-7000 DCON protocol.") #define LICENSE "GPL2" //************************************************* DCONDAQ::TTpContr *DCONDAQ::mod; //Pointer for direct access to the module extern "C" { #ifdef MOD_INCL TModule::SAt daq_DCON_module(int n_mod) #else TModule::SAt module(int n_mod) #endif { if(n_mod == 0) return TModule::SAt(MOD_ID,MOD_TYPE,VER_TYPE); return TModule::SAt(""); } #ifdef MOD_INCL TModule *daq_DCON_attach(const TModule::SAt &AtMod, const string &source) #else TModule *attach(const TModule::SAt &AtMod, const string &source) #endif { if(AtMod == TModule::SAt(MOD_ID,MOD_TYPE,VER_TYPE)) return new DCONDAQ::TTpContr(source); return NULL; } } using namespace DCONDAQ; //****************************************************** //* TTpContr * //****************************************************** TTpContr::TTpContr(string name) : TTipDAQ(MOD_ID) { mod = this; mName = MOD_NAME; mType = MOD_TYPE; mVers = MOD_VER; mAuthor = AUTHORS; mDescr = DESCRIPTION; mLicense = LICENSE; mSource = name; } TTpContr::~TTpContr() { } void TTpContr::postEnable( int flag ) { TTipDAQ::postEnable( flag ); //> Controler's bd structure fldAdd(new TFld("PRM_BD",_("Parameters table"),TFld::String,TFld::NoFlag,"30","")); fldAdd(new TFld("PERIOD",_("Gather data period (s)"),TFld::Integer,TFld::NoFlag,"6","0","0;100")); //!!!! Remove at further fldAdd(new TFld("SCHEDULE",_("Acquisition schedule"),TFld::String,TFld::NoFlag,"100","1")); fldAdd(new TFld("PRIOR",_("Gather task priority"),TFld::Integer,TFld::NoFlag,"2","0","-1;99")); fldAdd(new TFld("ADDR",_("Serial transport"),TFld::String,TFld::NoFlag,"30","")); fldAdd(new TFld("REQ_TRY",_("Request tries"),TFld::Integer,TFld::NoFlag,"1","3","1;10")); //> Parameter type bd structure int t_prm = tpParmAdd("std","PRM_BD",_("Standard")); tpPrmAt(t_prm).fldAdd(new TFld("MOD_ADDR",_("Module address"),TFld::Integer,TFld::NoFlag|TCfg::NoVal,"20","1","0;255")); tpPrmAt(t_prm).fldAdd(new TFld("CRC_CTRL",_("CRC control"),TFld::Boolean,TFld::NoFlag|TCfg::NoVal,"1","1")); tpPrmAt(t_prm).fldAdd(new TFld("HOST_SIGNAL",_("Host signal"),TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;1",_("No signal;HostOK"))); tpPrmAt(t_prm).fldAdd(new TFld("AI_METHOD",_("AI method"),TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;1;2;3;4;6;8;10;20;116;201;202;203;204;206;208;210;220;316", _("No AI;1AI (#AA);2AI (#AA);3AI (#AA);4AI (#AA);6AI (#AA);8AI (#AA);10AI (#AA);20AI (#AA);16AI (#AA^AA);1AI (#AAN);2AI (#AAN);3AI (#AAN);4AI (#AAN);6AI (#AAN);8AI (#AAN);10AI (#AANN);20AI (#AANN);16AI (#AAN^AAN)"))); tpPrmAt(t_prm).fldAdd(new TFld("AI_RANGE",""/*_("AI range")*/,TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;1;2",_("Engineer or percent;Hexadecimal (0000 FFFF);Hexadecimal (8000 7FFF)"))); tpPrmAt(t_prm).fldAdd(new TFld("AO_METHOD",_("AO method"),TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;1;2;4;14",_("No AO;1AO (#AA);2AO (#AAN);4AO (#AAN);4AO (#AACN)"))); tpPrmAt(t_prm).fldAdd(new TFld("AO_RANGE",""/*_("AO range")*/,TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;1;2;3;4;5;6;7;8;9;10", _("Engineer (00.000 20.000);Engineer (04.000 20.000);Engineer (00.000 10.000);Engineer (+00.000 +20.000);" "Engineer (+04.000 +20.000);Engineer (+00.000 +10.000);Engineer (-10.000 +10.000);Engineer (+00.000 +05.000);" "Engineer (-05.000 +05.000);Percent (+000.00 +100.00);Hexadecimal (000 FFF)"))); tpPrmAt(t_prm).fldAdd(new TFld("DI_METHOD",_("DI method"),TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;3;4;7;8;14;16;101;201", _("No DI;3DI ($AA6);4DI ($AA6);7DI ($AA6);8DI ($AA6);14DI ($AA6);16DI ($AA6);1DI (@AADI);8DI ($AA6,FF00)")) ); tpPrmAt(t_prm).fldAdd(new TFld("DO_METHOD",_("DO method"),TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;2;3;4;5;7;8;12;13;16;102;103;202;204;306;402;504;604;608,704,708,712)", _("No DO;2DO (@AA,0300);3DO (@AA,7);4DO (@AA,F);5DO (@AA,1F);7DO (@AA,7F);8DO (@AA,FF);12DO (@AA,0FFF);" "13DO (@AA,1FFF);16DO (@AA,FFFF);2DO (^AADOVVV);3DO (^AADOVVV);2DO (@AADO);4DO (@AADO);6DO (@AADODD);" "2DO (@AADO0D);4DO (@(^)AADO0D);4DO (@AA,0F00);8DO (@AA,FF00);4DO (#AA000F);8DO (#AA00FF);12DO (#AA000FFF)"))); tpPrmAt(t_prm).fldAdd(new TFld("CI_METHOD",_("CI method"),TFld::Integer,TFld::Selected|TCfg::NoVal,"1","0", "0;2;3",_("No CI;2CI (#AA);3CI (#AA)"))); } void TTpContr::load_( ) { //> Load parameters from command line } void TTpContr::save_() { } TController *TTpContr::ContrAttach( const string &name, const string &daq_db ) { return new TMdContr(name,daq_db,this); } //****************************************************** //* TMdContr * //****************************************************** TMdContr::TMdContr( string name_c, const string &daq_db, TElem *cfgelem ) : TController(name_c, daq_db, cfgelem), mPerOld(cfg("PERIOD").getId()), mPrior(cfg("PRIOR").getId()), connTry(cfg("REQ_TRY").getId()), prc_st(false), call_st(false), endrun_req(false), mPer(1e9), tm_gath(0) { cfg("PRM_BD").setS("DCONPrm_"+name_c); } TMdContr::~TMdContr() { if(run_st) stop(); } string TMdContr::getStatus( ) { string rez = TController::getStatus( ); if(startStat() && !redntUse()) { if(call_st) rez += TSYS::strMess(_("Call now. ")); if(period()) rez += TSYS::strMess(_("Call by period: %s. "),TSYS::time2str(1e-3*period()).c_str()); else rez += TSYS::strMess(_("Call next by cron '%s'. "),TSYS::time2str(TSYS::cron(cron()),"%d-%m-%Y %R").c_str()); rez += TSYS::strMess(_("Spent time: %s. "),TSYS::time2str(tm_gath).c_str()); } return rez; } TParamContr *TMdContr::ParamAttach( const string &name, int type ) { return new TMdPrm(name, &owner().tpPrmAt(type)); } void TMdContr::load_( ) { if(!SYS->chkSelDB(DB())) return; TController::load_( ); //> Check for get old period method value if(mPerOld) { cfg("SCHEDULE").setS(TSYS::int2str(mPerOld)); mPerOld = 0; } } void TMdContr::disable_( ) { } void TMdContr::start_( ) { if(prc_st) return; //> Schedule process mPer = TSYS::strSepParse(cron(),1,' ').empty() ? vmax(0,1e9*atof(cron().c_str())) : 0; SYS->transport().at().at("Serial").at().outAt(cfg("ADDR").getS()).at().start(); //> Start the gathering data task SYS->taskCreate(nodePath('.',true), mPrior, TMdContr::Task, this); } void TMdContr::stop_( ) { //> Stop the request and calc data task if(prc_st) SYS->taskDestroy(nodePath('.',true), &endrun_req); } bool TMdContr::cfgChange( TCfg &icfg ) { TController::cfgChange(icfg); return true; } void TMdContr::prmEn( const string &id, bool val ) { ResAlloc res( en_res, true ); unsigned i_prm; for(i_prm = 0; i_prm < p_hd.size(); i_prm++) if(p_hd[i_prm].at().id() == id) break; if(val && i_prm >= p_hd.size()) p_hd.push_back(at(id)); if(!val && i_prm < p_hd.size()) p_hd.erase(p_hd.begin()+i_prm); } string TMdContr::DCONCRC( string str ) { unsigned char CRC = 0; for(unsigned i = 0; i < str.size(); i++) CRC += (unsigned char)str[i]; return TSYS::strMess("%02X",CRC); } string TMdContr::DCONReq( string &pdu, bool CRC, unsigned acqLen, char resOK ) { ResAlloc res(req_res, true); char buf[1000]; string rez, err; try { AutoHD tr = SYS->transport().at().at("Serial").at().outAt(cfg("ADDR").getS()); if(!tr.at().startStat()) tr.at().start(); if(CRC) pdu += DCONCRC(pdu); if(messLev() == 0) mess_debug(nodePath().c_str(), _("REQ -> '%s'"), pdu.c_str()); pdu += "\r"; ResAlloc resN( tr.at().nodeRes(), true ); for(int i_tr = 0; i_tr < vmax(1,vmin(10,connTry)); i_tr++) { int resp_len = tr.at().messIO( pdu.data(), pdu.size(), buf, sizeof(buf), 0, true ); rez.assign(buf,resp_len); //> Wait tail while(resp_len && (rez.size() < 2 || rez[rez.size()-1] != '\r')) { try{ resp_len = tr.at().messIO(NULL, 0, buf, sizeof(buf), 0, true); } catch(TError er){ break; } rez.append(buf, resp_len); } if(rez.size() < 2 || rez[rez.size()-1] != '\r') { err = _("13:Error respond: Not full."); continue; } pdu = rez.substr(0,rez.size()-1); if(!pdu.size() || (CRC && pdu.size() < 3)) { err = _("20:Respond length error."); break; } if(CRC && strtol(pdu.substr(pdu.size()-2).c_str(),NULL,16) != strtol(DCONCRC(pdu.substr(0,pdu.size()-2)).c_str(),NULL,16)) { err = _("21:Invalid module CRC."); continue; } if(acqLen) { if(pdu[0] != resOK) { err = _("22:Invalid module response."); continue; } else if(((!CRC && acqLen != pdu.size()) || (CRC && (acqLen+2) != pdu.size()))) { err = _("20:Respond length error."); break; } } if(messLev() == 0) mess_debug(nodePath().c_str(), _("RESP -> '%s'"), pdu.c_str()); err = "0"; break; } } catch(TError er) { err = _("10:Transport error: ")+er.mess; } if(err != "0") { if(messLev() == 0) mess_debug(nodePath().c_str(), _("ERR -> '%s': %s"), pdu.c_str(), err.c_str()); pdu = ""; } return err; } void *TMdContr::Task( void *icntr ) { string str, pdu, ai_txterr, ao_txterr, di_txterr, do_txterr, ci_txterr; int n, m, i; TMdContr &cntr = *(TMdContr *)icntr; cntr.endrun_req = false; cntr.prc_st = true; try { while(!cntr.endrun_req) { if(!cntr.redntUse()) { cntr.call_st = true; int64_t t_cnt = TSYS::curTime(); //> Update controller's data ResAlloc res(cntr.en_res, false); for(unsigned i_p = 0; i_p < cntr.p_hd.size(); i_p++) { if(cntr.endrun_req) break; //> Reset errors ai_txterr = ao_txterr = di_txterr = do_txterr = ci_txterr = "0"; //AI n = 0; switch(cntr.p_hd[i_p].at().ai_method) { case 1: case 2: case 3: case 4: case 6: case 8: case 10: case 20: n = cntr.p_hd[i_p].at().ai_method; case 116: if(!n) n = 8; //#AA //> Request with module pdu = TSYS::strMess("#%02X",cntr.p_hd[i_p].at().mod_addr); m = (cntr.p_hd[i_p].at().ai_range == 0) ? 7 : 4; ai_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,(m*n+1)); for(i = 0; i < n; i++) { if(ai_txterr != "0") { cntr.p_hd[i_p].at().AI[i] = EVAL_REAL; continue; } if(m == 7) cntr.p_hd[i_p].at().AI[i] = atof(pdu.substr(i*m+1,m).c_str()); if(m == 4) cntr.p_hd[i_p].at().AI[i] = strtol(pdu.substr(i*m+1,m).c_str(),NULL,16); if(cntr.p_hd[i_p].at().ai_range == 2 && cntr.p_hd[i_p].at().AI[i] > 0x7fff) cntr.p_hd[i_p].at().AI[i]=cntr.p_hd[i_p].at().AI[i]-0x10000; } if(cntr.p_hd[i_p].at().ai_method == 116) { //^AA //> Request with module pdu = TSYS::strMess("^%02X",cntr.p_hd[i_p].at().mod_addr); m = (cntr.p_hd[i_p].at().ai_range == 0) ? 7 : 4; ai_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,1); for(i = 0; i < n; i++) { if(ai_txterr != "0") { cntr.p_hd[i_p].at().AI[i] = EVAL_REAL; continue; } if(m == 7) cntr.p_hd[i_p].at().AI[i+8] = atof(pdu.substr(i*m+1,m).c_str()); if(m == 4) cntr.p_hd[i_p].at().AI[i+8] = strtol(pdu.substr(i*m+1,m).c_str(),NULL,16); if(cntr.p_hd[i_p].at().ai_range == 2 && cntr.p_hd[i_p].at().AI[i+8] > 0x7fff) cntr.p_hd[i_p].at().AI[i+8] = cntr.p_hd[i_p].at().AI[i+8]-0x10000; } } break; case 201: case 202: case 203: case 204: case 206: case 208: case 210: case 220: n = cntr.p_hd[i_p].at().ai_method - 200; case 316: if(!n) n = 8; //#AAN //> Request with module m = (cntr.p_hd[i_p].at().ai_range == 0) ? 7 : 4; for(i = 0; i < n; i++) { if ((cntr.p_hd[i_p].at().ai_method == 210)||(cntr.p_hd[i_p].at().ai_method == 220)) pdu = TSYS::strMess("#%02X%02X",cntr.p_hd[i_p].at().mod_addr,i); else pdu = TSYS::strMess("#%02X%d",cntr.p_hd[i_p].at().mod_addr,i); ai_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,(m+1)); if(ai_txterr != "0") cntr.p_hd[i_p].at().AI[i] = EVAL_REAL; else { if(m == 7) cntr.p_hd[i_p].at().AI[i] = atof(pdu.substr(1,m).c_str()); if(m == 4) cntr.p_hd[i_p].at().AI[i] = strtol(pdu.substr(1,m).c_str(),NULL,16); if(cntr.p_hd[i_p].at().ai_range == 2 && cntr.p_hd[i_p].at().AI[i] > 0x7fff) cntr.p_hd[i_p].at().AI[i]=cntr.p_hd[i_p].at().AI[i]-0x10000; } } if(cntr.p_hd[i_p].at().ai_method == 316) { //^AAN //> Request with module m = (cntr.p_hd[i_p].at().ai_range == 0) ? 7 : 4; for(i = 0; i < n; i++) { pdu = TSYS::strMess("^%02X%d",cntr.p_hd[i_p].at().mod_addr,i); ai_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,1); if(ai_txterr != "0") cntr.p_hd[i_p].at().AI[i] = EVAL_REAL; else { if(m == 7) cntr.p_hd[i_p].at().AI[i+8] = atof(pdu.substr(1,m).c_str()); if(m == 4) cntr.p_hd[i_p].at().AI[i+8] = strtol(pdu.substr(1,m).c_str(),NULL,16); if(cntr.p_hd[i_p].at().ai_range == 2 && cntr.p_hd[i_p].at().AI[i+8] > 0x7fff) cntr.p_hd[i_p].at().AI[i+8] = cntr.p_hd[i_p].at().AI[i+8]-0x10000; } } } break; } //AO switch(cntr.p_hd[i_p].at().ao_method) { case 1: case 2: case 4: case 14: n = cntr.p_hd[i_p].at().ao_method; if (cntr.p_hd[i_p].at().ao_method == 14) n = 4; for(i = 0; i < n; i++) { //Control range switch(cntr.p_hd[i_p].at().ao_range) { case 0://Engineer (00.000 20.000) str = TSYS::strMess("%06.3f",vmax(0,vmin(20,cntr.p_hd[i_p].at().AO[i]))); break; case 1://Engineer (04.000 20.000) str = TSYS::strMess("%06.3f",vmax(4,vmin(20,cntr.p_hd[i_p].at().AO[i]))); break; case 2://Engineer (00.000 10.000) str = TSYS::strMess("%06.3f",vmax(0,vmin(10,cntr.p_hd[i_p].at().AO[i]))); break; case 3://Engineer (+00.000 +20.000) str = TSYS::strMess("%+07.3f",vmax(0,vmin(20,cntr.p_hd[i_p].at().AO[i]))); break; case 4://Engineer (+04.000 +20.000) str = TSYS::strMess("%+07.3f",vmax(4,vmin(20,cntr.p_hd[i_p].at().AO[i]))); break; case 5://Engineer (+00.000 +10.000) str = TSYS::strMess("%+07.3f",vmax(0,vmin(10,cntr.p_hd[i_p].at().AO[i]))); break; case 6://Engineer (-10.000 +10.000) str = TSYS::strMess("%+07.3f",vmax(-10,vmin(10,cntr.p_hd[i_p].at().AO[i]))); break; case 7://Engineer (+00.000 +05.000) str = TSYS::strMess("%+07.3f",vmax(0,vmin(5,cntr.p_hd[i_p].at().AO[i]))); break; case 8://Engineer (-05.000 +05.000) str = TSYS::strMess("%+07.3f",vmax(-5,vmin(5,cntr.p_hd[i_p].at().AO[i]))); break; case 9://Percent (+000.00 +100.00) str = TSYS::strMess("%+07.2f",vmax(0,vmin(100,cntr.p_hd[i_p].at().AO[i]))); break; case 10://Hexadecimal (000 FFF) str = TSYS::strMess("%03X",(int)vmax(0,vmin(0xFFF,cntr.p_hd[i_p].at().AO[i]))); break; default: ao_txterr = _("23:Undefined range"); break; } //> Request with module if (cntr.p_hd[i_p].at().ao_method == 1) pdu = TSYS::strMess("#%02X%s",cntr.p_hd[i_p].at().mod_addr,str.c_str()); else if (cntr.p_hd[i_p].at().ao_method == 14) pdu = TSYS::strMess("#%02XC%d%s",cntr.p_hd[i_p].at().mod_addr,i,str.c_str()); else pdu = TSYS::strMess("#%02X%d%s",cntr.p_hd[i_p].at().mod_addr,i,str.c_str()); if((ao_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,1)) == "0") ; else if(pdu.size() && pdu[0] == '?') ao_txterr = _("24:Module out of range"); else if(pdu.size() && pdu[0] == '!') ao_txterr = _("25:Command ignored (host watchdog)."); } } //DI unsigned int DI = 0; n = 0; switch(cntr.p_hd[i_p].at().di_method) { case 3: if(!n) n = 3; //3DI ($AA6) case 4: if(!n) n = 4; //4DI ($AA6) case 7: if(!n) n = 7; //7DI ($AA6) case 8: if(!n) n = 8; //8DI ($AA6) case 14:if(!n) n = 14; //14DI ($AA6) case 16:if(!n) n = 16; //16DI ($AA6) case 201:if(!n) n = 8; //8DI ($AA6,FF00) //> Request with module pdu = TSYS::strMess("$%02X6",cntr.p_hd[i_p].at().mod_addr); di_txterr = cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,7,'!'); if(di_txterr == "0") DI = strtoul(pdu.substr(1,4).c_str(),NULL,16); if(cntr.p_hd[i_p].at().di_method == 201) DI = DI>>8; for(int i_n = 0; i_n < n; i_n++) cntr.p_hd[i_p].at().DI[i_n] = (di_txterr == "0") ? ((DI>>i_n)&0x01) : EVAL_BOOL; break; case 101: //1DI (@AADI) //> Request with module pdu = TSYS::strMess("@%02XDI",cntr.p_hd[i_p].at().mod_addr); di_txterr = cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,7,'!'); cntr.p_hd[i_p].at().DI[0] = (di_txterr == "0") ? (char)strtoul(pdu.substr(6,2).c_str(),NULL,16) : EVAL_BOOL; break; } //DO unsigned code = 0; n = 0; pdu = ""; switch(cntr.p_hd[i_p].at().do_method) { case 2://2DO (@AA,0300) //> Request with module code = (cntr.p_hd[i_p].at().DO[1]?2:0)+(cntr.p_hd[i_p].at().DO[0]?1:0); pdu = TSYS::strMess("@%02X%02X00",cntr.p_hd[i_p].at().mod_addr,code); if((do_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,1)) == "0") ; else if(pdu.size() && pdu[0] == '!') do_txterr = _("25:Command ignored (host watchdog)."); break; case 604://4DO (@AA,0F00) for(unsigned i_n = 0; i_n < 4; i_n++) if(cntr.p_hd[i_p].at().DO[i_n]) code += (1< Request with module pdu = TSYS::strMess("^%02XDO",cntr.p_hd[i_p].at().mod_addr); pdu += cntr.p_hd[i_p].at().DO[0] ? "1" : "0"; pdu += cntr.p_hd[i_p].at().DO[1] ? "1" : "0"; pdu += "0"; if((do_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,1)) == "0") ; else if(pdu.size() && pdu[0] == '!') do_txterr = _("25:Command ignored (host watchdog)."); break; case 103://3DO (^AADOVVV) pdu = TSYS::strMess("^%02XDO",cntr.p_hd[i_p].at().mod_addr); pdu += cntr.p_hd[i_p].at().DO[0] ? "1" : "0"; pdu += cntr.p_hd[i_p].at().DO[1] ? "1" : "0"; pdu += cntr.p_hd[i_p].at().DO[2] ? "1" : "0"; if((do_txterr=cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,1)) == "0") ; else if(pdu.size() && pdu[0] == '!') do_txterr = _("25:Command ignored (host watchdog)."); break; case 202://2DO (@AADO) n = 2; case 204://4DO (@AADO) if(!n) n = 4; for(int i_r = 0; i_r < n/2; i_r++) { //> Request with module for(unsigned i_n = 0; i_n < 2; i_n++) if(cntr.p_hd[i_p].at().DO[i_r*2+i_n]) code += (1< Request with module for(unsigned i_n = 0; i_n < 6; i_n++) if(cntr.p_hd[i_p].at().DO[i_n]) code += (1< Request with module code = (cntr.p_hd[i_p].at().DO[1]?2:0)+(cntr.p_hd[i_p].at().DO[0]?1:0); pdu = TSYS::strMess("@%02XDO%02X",cntr.p_hd[i_p].at().mod_addr,code); do_txterr = cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,3,'!'); //> Request with module code = (cntr.p_hd[i_p].at().DO[3]?2:0)+(cntr.p_hd[i_p].at().DO[2]?1:0); pdu = TSYS::strMess("^%02XDO%02X",cntr.p_hd[i_p].at().mod_addr,code); do_txterr = cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl,3,'!'); break; case 704://4DO (#AA000F) for(unsigned i_n = 0; i_n < 4; i_n++) if(cntr.p_hd[i_p].at().DO[i_n]) code += (1< Request with module pdu = TSYS::strMess("#%02X%d",cntr.p_hd[i_p].at().mod_addr,i_n); if(cntr.p_hd[i_p].at().crc_ctrl) pdu += cntr.DCONCRC(pdu); if((ci_txterr=cntr.DCONReq(pdu,false,cntr.p_hd[i_p].at().crc_ctrl?11:9)) == "0") { if(cntr.p_hd[i_p].at().crc_ctrl) { pdu = pdu.substr(0,1) + pdu.substr(3,8) + pdu.substr(1,2); if(strtol(pdu.substr(9,2).c_str(),NULL,16) != strtol(cntr.DCONCRC(pdu.substr(0,9)).c_str(),NULL,16)) { ci_txterr=_("21:Invalid module CRC."); continue; } } cntr.p_hd[i_p].at().CI[i_n] = strtol(pdu.substr(1,8).c_str(),NULL,16); } } break; } //Host signal switch (cntr.p_hd[i_p].at().host_signal) { case 1://HostOK signal { pdu = "~**"; cntr.DCONReq(pdu,cntr.p_hd[i_p].at().crc_ctrl); break; } } cntr.p_hd[i_p].at().ai_err.setVal(ai_txterr); cntr.p_hd[i_p].at().ao_err.setVal(ao_txterr); cntr.p_hd[i_p].at().di_err.setVal(di_txterr); cntr.p_hd[i_p].at().do_err.setVal(do_txterr); cntr.p_hd[i_p].at().ci_err.setVal(ci_txterr); } res.release(); //> Calc acquisition process time cntr.tm_gath = TSYS::curTime()-t_cnt; cntr.call_st = false; } //> Calc next work time and sleep TSYS::taskSleep((int64_t)cntr.period(), (cntr.period()?0:TSYS::cron(cntr.cron()))); } } catch(TError err) { mess_err(err.cat.c_str(), err.mess.c_str()); } cntr.prc_st = false; return NULL; } void TMdContr::cntrCmdProc( XMLNode *opt ) { //> Get page info if(opt->name() == "info") { TController::cntrCmdProc(opt); ctrMkNode("fld",opt,-1,"/cntr/cfg/ADDR",cfg("ADDR").fld().descr(),startStat()?R_R_R_:RWRWR_,"root",SDAQ_ID,3, "tp","str","dest","select","select","/cntr/cfg/serDevLst"); ctrRemoveNode(opt,"/cntr/cfg/PERIOD"); ctrMkNode("fld",opt,-1,"/cntr/cfg/SCHEDULE",cfg("SCHEDULE").fld().descr(),startStat()?R_R_R_:RWRWR_,"root",SDAQ_ID,4, "tp","str","dest","sel_ed","sel_list",TMess::labSecCRONsel(),"help",TMess::labSecCRON()); ctrMkNode("fld",opt,-1,"/cntr/cfg/PRIOR",cfg("PRIOR").fld().descr(),startStat()?R_R_R_:RWRWR_,"root",SDAQ_ID,1,"help",TMess::labTaskPrior()); return; } //> Process command to page string a_path = opt->attr("path"); if(a_path == "/cntr/cfg/serDevLst" && ctrChkNode(opt)) { vector sls; if(SYS->transport().at().modPresent("Serial")) SYS->transport().at().at("Serial").at().outList(sls); for(unsigned i_s = 0; i_s < sls.size(); i_s++) opt->childAdd("el")->setText(sls[i_s]); } else TController::cntrCmdProc(opt); } //****************************************************** //* TMdPrm * //****************************************************** TMdPrm::TMdPrm( string name, TTipParam *tp_prm ) : TParamContr( name, tp_prm ), p_el("w_attr"), mod_addr(cfg("MOD_ADDR").getId()), crc_ctrl(cfg("CRC_CTRL").getBd()), host_signal(cfg("HOST_SIGNAL").getId()), ai_method(cfg("AI_METHOD").getId()), ai_range(cfg("AI_RANGE").getId()), ao_method(cfg("AO_METHOD").getId()), ao_range(cfg("AO_RANGE").getId()), di_method(cfg("DI_METHOD").getId()), do_method(cfg("DO_METHOD").getId()), ci_method(cfg("CI_METHOD").getId()) { ai_err.setVal("0"); ao_err.setVal("0"); di_err.setVal("0"); do_err.setVal("0"); ci_err.setVal("0"); // Default input/output data for(int i = 0; i < 32; i++) { AI[i] = AO[i] = CI[i] = 0; DI[i] = DO[i] = false; } } TMdPrm::~TMdPrm( ) { nodeDelAll( ); } void TMdPrm::postEnable( int flag ) { TParamContr::postEnable(flag); if(!vlElemPresent(&p_el)) vlElemAtt(&p_el); } TMdContr &TMdPrm::owner( ) { return (TMdContr&)TParamContr::owner(); } void TMdPrm::enable() { if(enableStat()) return; TParamContr::enable(); //> Delete DAQ parameter's attributes for(unsigned i_f = 0; i_f < p_el.fldSize(); ) { try { p_el.fldDel(i_f); continue; } catch(TError err) { mess_warning(err.cat.c_str(),err.mess.c_str()); } i_f++; } //> Make DAQ parameter's attributes unsigned itCnt = 0; //>> AI switch(ai_method) { case 1: case 201: itCnt = 1; break; //1AI (#AA,#AAN) case 2: case 202: itCnt = 2; break; //2AI (#AA,#AAN) case 3: case 203: itCnt = 3; break; //3AI (#AA,#AAN) case 4: case 204: itCnt = 4; break; //4AI (#AA,#AAN) case 6: case 206: itCnt = 6; break; //6AI (#AA,#AAN) case 8: case 208: itCnt = 8; break; //8AI (#AA,#AAN) case 10: case 210: itCnt = 10; break; //10AI (#AA,#AANN) case 20: case 220: itCnt = 20; break; //20AI (#AA,#AANN) case 16: case 316: itCnt = 16; break; //16AI (#AA^AA,#AAN^AAN) default: itCnt = 0; break; } if(itCnt) { string sai_method = TSYS::int2str(ai_method); p_el.fldAdd(new TFld("ai_err","ai_err",TFld::String,TFld::NoWrite|TVal::DirRead,"","","","",sai_method.c_str())); for(unsigned i_p = 0; i_p < itCnt; i_p++) p_el.fldAdd(new TFld(TSYS::strMess("AI%d",i_p).c_str(),TSYS::strMess("AI%d",i_p).c_str(), TFld::Real,TFld::NoWrite|TVal::DirRead,"","","","",sai_method.c_str())); } //>> AO string ao_d; switch(ao_range) { case 0: ao_d = "0;20"; break; //Engineer (00.000 20.000) case 1: ao_d = "4;20"; break; //Engineer (04.000 20.000) case 2: ao_d = "0;10"; break; //Engineer (00.000 10.000) case 3: ao_d = "0;20"; break; //Engineer (+00.000 +20.000) case 4: ao_d = "4;20"; break; //Engineer (+04.000 +20.000) case 5: ao_d = "0;10"; break; //Engineer (+00.000 +10.000) case 6: ao_d = "-10;10";break; //Engineer (-10.000 +10.000) case 7: ao_d = "0;5"; break; //Engineer (+00.000 +05.000) case 8: ao_d = "-5;5"; break; //Engineer (-05.000 +05.000) case 9: ao_d = "0;100"; break; //Percent (+000.00 +100.00) case 10:ao_d = "0;4095";break; //Hexadecimal (000 FFF) default:ao_d = ""; break; } switch(ao_method) { case 1: itCnt = 1; break; //1AO (#AA) case 2: itCnt = 2; break; //2AO (#AAN) case 4: itCnt = 4; break; //4AO (#AAN) case 14: itCnt = 4; break; //4AO (#AACN) default:itCnt = 0; break; } if(itCnt) { string sao_method = TSYS::int2str(ao_method); p_el.fldAdd(new TFld("ao_err","ao_err",TFld::String,TFld::NoWrite|TVal::DirRead,"","","","",sao_method.c_str()) ); for(unsigned i_p = 0; i_p < itCnt; i_p++) p_el.fldAdd(new TFld(TSYS::strMess("AO%d",i_p).c_str(),TSYS::strMess("AO%d",i_p).c_str(), TFld::Real,TVal::DirRead|TVal::DirWrite,"20","1",ao_d.c_str(),"",sao_method.c_str())); } //>> DI switch(di_method) { case 3: itCnt = 3; break; //3DI ($AA6) case 4: itCnt = 4; break; //4DI ($AA6) case 7: itCnt = 7; break; //7DI ($AA6) case 8: itCnt = 8; break; //8DI ($AA6) case 14:itCnt = 14; break; //14DI ($AA6) case 16:itCnt = 16; break; //16DI ($AA6) case 101:itCnt = 1; break; //1DI (@AADI) case 201:itCnt = 8; break; //8DI ($AA6,FF00) default:itCnt = 0; break; } if(itCnt) { string sdi_method = TSYS::int2str(di_method); p_el.fldAdd(new TFld("di_err","di_err",TFld::String,TFld::NoWrite|TVal::DirRead,"","","","",sdi_method.c_str())); for(unsigned i_p = 0; i_p < itCnt; i_p++) p_el.fldAdd(new TFld(TSYS::strMess("DI%d",i_p).c_str(),TSYS::strMess("DI%d",i_p).c_str(), TFld::Boolean,TFld::NoWrite|TVal::DirRead,"","","","",sdi_method.c_str())); } //>> DO switch(do_method) { case 2: itCnt = 2; break; //2DO (@AA,0300) case 3: itCnt = 3; break; //3DO (@AA,7) case 4: itCnt = 4; break; //4DO (@AA,F) case 5: itCnt = 5; break; //5DO (@AA,1F) case 7: itCnt = 7; break; //7DO (@AA,7F) case 8: itCnt = 8; break; //8DO (@AA,FF) case 12:itCnt = 12; break; //12DO (@AA,0FFF) case 13:itCnt = 13; break; //13DO (@AA,1FFF) case 16:itCnt = 16; break; //16DO (@AA,FFFF) case 102:itCnt = 2; break; //2DO (^AADOVVV) case 103:itCnt = 3; break; //3DO (^AADOVVV) case 202:itCnt = 2; break; //2DO (@AADO) case 204:itCnt = 4; break; //4DO (@AADO) case 306:itCnt = 6; break; //@AADODD case 402:itCnt = 2; break; //@AADO0D case 504:itCnt = 4; break; //4DO (@(^)AADO0D) case 604:itCnt = 4; break; //4DO (@AA,0F00) case 608:itCnt = 8; break; //8DO (@AA,FF00) case 704:itCnt = 4; break; //4DO (#AA000F) case 708:itCnt = 4; break; //8DO (#AA00FF) case 712:itCnt = 8; break; //12DO (#AA000FFF) default:itCnt = 0; break; } if(itCnt) { string sdo_method = TSYS::int2str(do_method); p_el.fldAdd(new TFld("do_err","do_err",TFld::String,TFld::NoWrite|TVal::DirRead,"","","","",sdo_method.c_str()) ); for(unsigned i_p = 0; i_p < itCnt; i_p++) p_el.fldAdd(new TFld(TSYS::strMess("DO%d",i_p).c_str(),TSYS::strMess("DO%d",i_p).c_str(), TFld::Boolean,TVal::DirRead|TVal::DirWrite,"","","","",sdo_method.c_str())); } //>> CI switch(ci_method) { case 2: itCnt = 2; break; //2CI (#AA) case 3: itCnt = 3; break; //3CI (#AA) default:itCnt = 0; break; } if(itCnt) { string sci_method = TSYS::int2str(ci_method); p_el.fldAdd(new TFld("ci_err","ci_err",TFld::String,TFld::NoWrite|TVal::DirRead,"","","","",sci_method.c_str())); for(unsigned i_p = 0; i_p < itCnt; i_p++) p_el.fldAdd( new TFld(TSYS::strMess("CI%d",i_p).c_str(),TSYS::strMess("CI%d",i_p).c_str(), TFld::Real,TFld::NoWrite|TVal::DirRead,"","","","",sci_method.c_str()) ); } owner().prmEn( id(), true ); } void TMdPrm::disable() { if(!enableStat()) return; owner().prmEn(id(), false); TParamContr::disable(); //> Set EVAL to parameter attributes vector ls; elem().fldList(ls); for(unsigned i_el = 0; i_el < ls.size(); i_el++) vlAt(ls[i_el]).at().setS(EVAL_STR, 0, true); } void TMdPrm::vlGet( TVal &val ) { if(!enableStat() || !owner().startStat()) { if(val.name() == "err") { if(!enableStat()) val.setS(_("1:Parameter is disabled."),0,true); else if(!owner().startStat()) val.setS(_("2:Acquisition is stopped."),0,true); } else val.setS(EVAL_STR,0,true); return; } if(owner().redntUse()) return; if(val.name() == "ai_err") val.setS(ai_err.getVal(),0,true); else if(val.name() == "ao_err") val.setS(ao_err.getVal(),0,true); else if(val.name() == "di_err") val.setS(di_err.getVal(),0,true); else if(val.name() == "do_err") val.setS(do_err.getVal(),0,true); else if(val.name() == "ci_err") val.setS(ci_err.getVal(),0,true); else if(val.name() == "err") { if(ai_err.getVal() != "0") val.setS(ai_err.getVal(),0,true); else if(ao_err.getVal() != "0") val.setS(ao_err.getVal(),0,true); else if(di_err.getVal() != "0") val.setS(di_err.getVal(),0,true); else if(do_err.getVal() != "0") val.setS(do_err.getVal(),0,true); else if(ci_err.getVal() != "0") val.setS(ci_err.getVal(),0,true); else val.setS("0",0,true); } else if(val.name().compare(0,2,"AI") == 0) val.setR(AI[atoi(val.name().substr(2,val.name().size()-2).c_str())],0,true); else if(val.name().compare(0,2,"AO") == 0) val.setR(AO[atoi(val.name().substr(2,val.name().size()-2).c_str())],0,true); else if(val.name().compare(0,2,"DI") == 0) val.setB(DI[atoi(val.name().substr(2,val.name().size()-2).c_str())],0,true); else if(val.name().compare(0,2,"DO") == 0) val.setB(DO[atoi(val.name().substr(2,val.name().size()-2).c_str())],0,true); else if(val.name().compare(0,2,"CI") == 0) val.setR(CI[atoi(val.name().substr(2,val.name().size()-2).c_str())],0,true); } void TMdPrm::vlSet( TVal &valo, const TVariant &pvl ) { if(!enableStat() || !owner().startStat()) { valo.setI(EVAL_INT, 0, true); return; } //> Send to active reserve station if(owner().redntUse()) { if(valo.getS() == pvl.getS()) return; XMLNode req("set"); req.setAttr("path",nodePath(0,true)+"/%2fserv%2fattr")->childAdd("el")->setAttr("id",valo.name())->setText(valo.getS()); SYS->daq().at().rdStRequest(owner().workId(),req); return; } //> Direct write if(valo.name().compare(0,2,"AO") == 0) AO[atoi(valo.name().substr(2,valo.name().size()-2).c_str())]=valo.getR(NULL,true); if(valo.name().compare(0,2,"DO") == 0) DO[atoi(valo.name().substr(2,valo.name().size()-2).c_str())]=valo.getB(NULL,true); } void TMdPrm::vlArchMake( TVal &val ) { TParamContr::vlArchMake(val); if(val.arch().freeStat()) return; val.arch().at().setSrcMode(TVArchive::PassiveAttr); val.arch().at().setPeriod(owner().period() ? (int64_t)owner().period()/1000 : 1000000); val.arch().at().setHardGrid(true); val.arch().at().setHighResTm(true); } bool TMdPrm::cfgChange( TCfg &icfg ) { TParamContr::cfgChange(icfg); if(enableStat() && (icfg.fld().name() == "AI_METHOD" || icfg.fld().name() == "AO_METHOD" || icfg.fld().name() == "DI_METHOD" || icfg.fld().name() == "DO_METHOD" || icfg.fld().name() == "CI_METHOD")) disable(); return true; } void TMdPrm::cntrCmdProc( XMLNode *opt ) { //> Get page info if(opt->name() == "info") { TParamContr::cntrCmdProc(opt); if(ai_method == 0) ctrRemoveNode(opt,"/prm/cfg/AI_RANGE"); if(ao_method == 0) ctrRemoveNode(opt,"/prm/cfg/AO_RANGE"); return; } //> Process command to page TParamContr::cntrCmdProc(opt); }