BusLoop::analyseCycData: check of input data for validity implemented.
This commit is contained in:
+24
-6
@@ -307,11 +307,31 @@ void BusLoop::collectCycData(const int numRecv)
|
|||||||
|
|
||||||
void BusLoop::analyseCycData()
|
void BusLoop::analyseCycData()
|
||||||
{
|
{
|
||||||
//TODO check the input data for validity
|
int lenMaster = m_sstr[4];
|
||||||
|
SymbolString master;
|
||||||
|
|
||||||
|
for (int i = 0; i < 5+lenMaster; i++)
|
||||||
|
master.push_back(m_sstr[i], true , true);
|
||||||
|
|
||||||
|
if (m_sstr[5+lenMaster] != master.getCRC()) {
|
||||||
|
L.log(cyc, trace, "ERR_CYC_CRC_M %s - %02x %02x", master.getDataStr().c_str(), m_sstr[5+lenMaster], master.getCRC());
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (m_sstr[1] != BROADCAST || isMaster(m_sstr[1]) == false) {
|
||||||
|
int lenSlave = m_sstr[5+lenMaster+2];
|
||||||
|
SymbolString slave;
|
||||||
|
|
||||||
|
for (int i = 5+lenMaster+2; i < 5+lenMaster+3+lenSlave; i++)
|
||||||
|
slave.push_back(m_sstr[i], true , true);
|
||||||
|
|
||||||
|
if (m_sstr[5+lenMaster+3+lenSlave] != slave.getCRC()) {
|
||||||
|
L.log(cyc, trace, "ERR_CYC_CRC_S %s - %02x %02x", slave.getDataStr().c_str(), m_sstr[5+lenMaster+3+lenSlave], slave.getCRC());
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
static bool skipfirst = false;
|
|
||||||
|
|
||||||
if (skipfirst == true) {
|
|
||||||
L.log(cyc, trace, "%s", m_sstr.getDataStr().c_str());
|
L.log(cyc, trace, "%s", m_sstr.getDataStr().c_str());
|
||||||
|
|
||||||
int index = m_commands->storeCycData(m_sstr.getDataStr());
|
int index = m_commands->storeCycData(m_sstr.getDataStr());
|
||||||
@@ -336,9 +356,7 @@ void BusLoop::analyseCycData()
|
|||||||
// collect Slave address
|
// collect Slave address
|
||||||
if (index != -3)
|
if (index != -3)
|
||||||
collectSlave();
|
collectSlave();
|
||||||
}
|
|
||||||
else
|
|
||||||
skipfirst = true;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void BusLoop::collectSlave()
|
void BusLoop::collectSlave()
|
||||||
|
|||||||
Reference in New Issue
Block a user