fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

Fixed linked list traversing in Dispatcher

Browse Source
This commit is contained in:
Pavel Kirienko 2014-04-01 13:46:10 +04:00
parent d8a976df00
commit f451015d3b
1 changed files with 7 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
libuavcan/src/transport/dispatcher.cpp
View File

@ -62,7 +62,7 @@ void LoopbackFrameListenerRegistry::invokeListeners(RxFrame& frame)
while (p)
{
LoopbackFrameListenerBase* const next = p->getNextListNode();
p->handleLoopbackFrame(frame);
p->handleLoopbackFrame(frame); // p may be modified
p = next;
}
}
@ -113,8 +113,9 @@ void Dispatcher::ListenerRegistry::cleanup(MonotonicTime ts)
TransferListenerBase* p = list_.get();
while (p)
{
p->cleanup(ts);
p = p->getNextListNode();
TransferListenerBase* const next = p->getNextListNode();
p->cleanup(ts); // p may be modified
p = next;
}
}
@ -123,15 +124,16 @@ void Dispatcher::ListenerRegistry::handleFrame(const RxFrame& frame)
TransferListenerBase* p = list_.get();
while (p)
{
TransferListenerBase* const next = p->getNextListNode();
if (p->getDataTypeDescriptor().getID() == frame.getDataTypeID())
{
p->handleFrame(frame);
p->handleFrame(frame); // p may be modified
}
else if (p->getDataTypeDescriptor().getID() < frame.getDataTypeID()) // Listeners are ordered by data type id!
{
break;
}
p = p->getNextListNode();
p = next;
}
}