mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-26 18:53:33 +08:00
Extra runtime check in CanIOManager queue
This commit is contained in:
@@ -136,6 +136,11 @@ void CanTxQueue::push(const CanFrame& frame, MonotonicTime tx_deadline, Qos qos,
|
|||||||
|
|
||||||
// Find a frame with lowest QoS
|
// Find a frame with lowest QoS
|
||||||
Entry* p = queue_.get();
|
Entry* p = queue_.get();
|
||||||
|
if (p == NULL)
|
||||||
|
{
|
||||||
|
UAVCAN_TRACE("CanTxQueue", "Push rejected: Nothing to replace");
|
||||||
|
return;
|
||||||
|
}
|
||||||
Entry* lowestqos = p;
|
Entry* lowestqos = p;
|
||||||
while (p)
|
while (p)
|
||||||
{
|
{
|
||||||
|
|||||||
Reference in New Issue
Block a user