(ModbusMaster): исправлена ошибка начальной инициализации (setbug# 5583)

conf/libuniset2.spec

@@ -413,6 +413,7 @@ mv -f %buildroot%python_sitelibdir_noarch/* %buildroot%python_sitelibdir/%oname
 - codegen: set default argprefix=myname (object name)
 - codegen: fixed minor bug in mylog..
 - refactoring IORFile interface
+- (modbusmaster): fixed bug (setbug #5583) in initialization..
 
 * Sat Feb 21 2015 Pavel Vainerman <pv@altlinux.ru> 2.0-alt17
 - use omni_options[] argument for ORB_init().

conf/test.xml

@@ -244,6 +244,7 @@
 			<item id="62" iotype="AI" name="LogLevel_S" textname="LogLevel control"/>
 			<item id="63" iotype="AI" name="SVU_AskCount_AS" textname="svu asl count"/>
 			<item id="64" iotype="AI" name="AI64_AS" textname="AI64" mbaddr="0x01" mbfunc="0x03" mbreg="64" mbtype="rtu" rs="5"/>
+			<item id="66" iotype="DI" name="DI66_AS" textname="DI66" mbaddr="0x01" mbfunc="0x01" mbreg="66" mbtype="rtu" rs="5"/>
 			<item id="65" iotype="DI" name="D65_S" textname="D65" threshold_aid="AI64_AS" lowlimit="3" hilimit="5" threshold_invert="1" rs="5" />
 		</sensors>
 		<thresholds name="thresholds">

extensions/ModbusMaster/MBExchange.cc

@@ -86,6 +86,8 @@ pollActivated(false)
     defaultMBtype = conf->getArg2Param("--" + prefix + "-default-mbtype",it.getProp("default_mbtype"),"rtu");
     defaultMBaddr = conf->getArg2Param("--" + prefix + "-default-mbaddr",it.getProp("default_mbaddr"),"");
 
+    defaultMBinitOK = conf->getArgPInt("--" + prefix + "-default-mbinit-ok",it.getProp("default_mbinitOK"), 0);
+
     // ********** HEARTBEAT *************
     string heart = conf->getArgParam("--" + prefix + "-heartbeat-id",it.getProp("heartbeat_id"));
     if( !heart.empty() )
@@ -162,6 +164,7 @@ void MBExchange::help_print( int argc, const char* const* argv )
     cout << "--prefix-set-prop-prefix val    - Использовать для свойств указанный или пустой префикс." << endl;
     cout << "--prefix-default-mbtype [rtu|rtu188|mtr]  - У датчиков которых не задан 'mbtype' использовать данный. По умолчанию: 'rtu'" << endl;
     cout << "--prefix-default-mbadd addr     - У датчиков которых не задан 'mbaddr' использовать данный. По умолчанию: ''" << endl;
+    cout << "--prefix-default-mbinit-ok 0,1  - Флаг инициализации. 1 - не ждать первого обмена с устройством, а сохранить при старте в SM значение 'default'" << endl;
 }
 // -----------------------------------------------------------------------------
 MBExchange::~MBExchange()
@@ -336,6 +339,27 @@ void MBExchange::initIterators()
     }
 }
 // -----------------------------------------------------------------------------
+void MBExchange::initValues()
+{
+    for( auto it1=rmap.begin(); it1!=rmap.end(); ++it1 )
+    {
+        RTUDevice* d(it1->second);
+        for( auto it=d->regmap.begin(); it!=d->regmap.end(); ++it )
+        {
+            for( auto it2=it->second->slst.begin();it2!=it->second->slst.end(); ++it2 )
+            {
+                it2->value = shm->localGetValue(it2->ioit,it2->si.id);
+            }
+            it->second->sm_initOK = true;
+        }
+    }
+
+    for( auto t=thrlist.begin(); t!=thrlist.end(); ++t )
+    {
+         t->value = shm->localGetValue(t->ioit,t->si.id);
+    }
+}
+// -----------------------------------------------------------------------------
 bool MBExchange::checkUpdateSM( bool wrFunc, long mdev )
 {
     if( exchangeMode == emSkipExchange || mdev == emSkipExchange )
@@ -660,7 +684,7 @@ bool MBExchange::preInitRead( InitList::iterator& p )
         // выставляем флаг принудительного обновления
         force_out = true;
         p->ri->mb_initOK = true;
-        p->ri->sm_initOK = false;
+        // p->ri->sm_initOK = false;
         updateRTU(p->ri->rit);
         force_out = f_out;
     }
@@ -854,8 +878,12 @@ bool MBExchange::pollRTU( RTUDevice* dev, RegMap::iterator& it )
         {
             ModbusRTU::ReadInputRetMessage ret = mb->read04(dev->mbaddr,p->mbreg,p->q_count);
             for( unsigned int i=0; i<p->q_count; i++,it++ )
+            {
                 it->second->mbval = ret.data[i];
+                it->second->mb_initOK = true;
+            }
             it--;
+
         }
         break;
 
@@ -863,7 +891,10 @@ bool MBExchange::pollRTU( RTUDevice* dev, RegMap::iterator& it )
         {
             ModbusRTU::ReadOutputRetMessage ret = mb->read03(dev->mbaddr,p->mbreg,p->q_count);
             for( unsigned int i=0; i<p->q_count; i++,it++ )
+            {
                 it->second->mbval = ret.data[i];
+                it->second->mb_initOK = true;
+            }
             it--;
         }
         break;
@@ -876,7 +907,10 @@ bool MBExchange::pollRTU( RTUDevice* dev, RegMap::iterator& it )
             {
                 ModbusRTU::DataBits b(ret.data[i]);
                 for( unsigned int k=0;k<ModbusRTU::BitsPerByte && m<p->q_count; k++,it++,m++ )
+                {
                     it->second->mbval = b[k];
+                    it->second->mb_initOK = true;
+                }
             }
             it--;
         }
@@ -890,7 +924,10 @@ bool MBExchange::pollRTU( RTUDevice* dev, RegMap::iterator& it )
             {
                 ModbusRTU::DataBits b(ret.data[i]);
                 for( unsigned int k=0;k<ModbusRTU::BitsPerByte && m<p->q_count; k++,it++,m++ )
+                {
                     it->second->mbval = b[k] ? 1 : 0;
+                    it->second->mb_initOK = true;
+                }
             }
             it--;
         }
@@ -1104,9 +1141,8 @@ void MBExchange::updateRSProperty( RSProperty* p, bool write_only )
     if( !checkUpdateSM(save,r->dev->mode) )
         return;
 
-    // если требуется инициализация и она ещё не произведена,
-    // то игнорируем
-    if( save && !r->mb_initOK )
+    // если ещё не обменивались ни разу с устройством, то ингнорируем (не обновляем значение в SM)
+    if( !r->mb_initOK )
         return;
 
     dlog3 << myname << "(updateP): sid=" << p->si.id
@@ -1252,7 +1288,7 @@ void MBExchange::updateRSProperty( RSProperty* p, bool write_only )
                     return;
                 }
 
-                if( save && r->sm_initOK )
+                if( save )
                 {
                       if( r->mb_initOK )
                       {
@@ -1329,6 +1365,8 @@ void MBExchange::updateRSProperty( RSProperty* p, bool write_only )
                         VTypes::F4 f4(f);
                         for( int k=0; k<VTypes::F4::wsize(); k++, i++ )
                             i->second->mbval = f4.raw.v[k];
+
+                        r->sm_initOK = true;
                     }
                 }
                 else
@@ -2195,14 +2233,12 @@ bool MBExchange::initItem( UniXML::iterator& it )
         // Раз это регистр для записи, то как минимум надо сперва
         // инициализировать значением из SM
         ri->sm_initOK = IOBase::initIntProp(it,"sm_initOK",prop_prefix,false);
-        ri->mb_initOK = true;  // может быть переопределён если будет указан tcp_preinit="1" (см. ниже)
+        ri->mb_initOK = true;
     }
     else
     {
-        // Если это регистр для чтения, то сразу можно работать
-        // инициализировать не надо
-        ri->mb_initOK = true;
-        ri->sm_initOK = true;
+        ri->mb_initOK = defaultMBinitOK;
+        ri->sm_initOK = false;
     }
 
 
@@ -2224,8 +2260,8 @@ bool MBExchange::initItem( UniXML::iterator& it )
             r->q_num=i+1;
             r->q_count=1;
             r->mbfunc = ri->mbfunc;
-            r->mb_initOK = true;
-            r->sm_initOK = true;
+            r->mb_initOK = defaultMBinitOK;
+            r->sm_initOK = false;
             if( ModbusRTU::isWriteFunction(ri->mbfunc) )
             {
                 // Если занимает несколько регистров, а указана функция записи "одного",
@@ -2534,7 +2570,7 @@ void MBExchange::sysCommand( const UniSetTypes::SystemMessage *sm )
                 initOutput();
             }
 
-
+            initValues();
             updateSM();
             askTimer(tmExchange,polltime);
             break;
@@ -2557,6 +2593,7 @@ void MBExchange::sysCommand( const UniSetTypes::SystemMessage *sm )
 
             askSensors(UniversalIO::UIONotify);
             initOutput();
+            initValues();
 
             if( !force )
             {

extensions/ModbusMaster/MBExchange.h

@@ -110,7 +110,7 @@ class MBExchange:
                 id(0),dev(0),
                 rtuJack(RTUStorage::nUnknown),rtuChan(0),
                 mtrType(MTR::mtUnknown),
-                q_num(0),q_count(1),mb_initOK(true),sm_initOK(true)
+                q_num(0),q_count(1),mb_initOK(false),sm_initOK(false)
             {}
 
             ModbusRTU::ModbusData mbval;
@@ -223,6 +223,7 @@ class MBExchange:
         virtual void sigterm( int signo ) override;
         virtual bool activateObject() override;
         virtual void initIterators();
+        virtual void initValues();
 
         struct InitRegInfo
         {
@@ -344,6 +345,7 @@ class MBExchange:
 
         std::string defaultMBtype;
         std::string defaultMBaddr;
+        bool defaultMBinitOK; // флаг определяющий нужно ли ждать "первого обмена" или при запуске сохранять в SM значение default.
 
      private:
         MBExchange();

extensions/ModbusMaster/tests/run_test_mbtcpmaster.sh

@@ -15,7 +15,9 @@ cd -
 --mbtcp-filter-value 1 \
 --mbtcp-gateway-iaddr localhost \
 --mbtcp-gateway-port 20048 \
---mbtcp-polltime 50 --mbtcp-recv-timeout 500
+--mbtcp-polltime 50 --mbtcp-recv-timeout 500 \
+$*
+#--mbtcp-default-mbinit-ok 1
 #--dlog-add-levels any
 
 #--mbtcp-force-out 1

extensions/ModbusMaster/tests/test_mbtcpmaster.cc

@@ -38,6 +38,7 @@ static void InitTest()
     if( !mbs )
     {
         mbs = make_shared<MBTCPTestServer>(slaveADDR,addr,port,false);
+        //mbs->setVerbose(true);
         CHECK( mbs!= nullptr );
         mbs->runThread();
         for( int i=0; !mbs->isRunning() && i<10; i++ )