mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-31 02:51:36 +08:00
UAVCAN: Correct use of unsubscribe
This commit is contained in:
committed by
Lorenz Meier
parent
1d98c8f202
commit
313ff2a6f2
@@ -149,9 +149,9 @@ UavcanNode::~UavcanNode()
|
|||||||
} while (_task != -1);
|
} while (_task != -1);
|
||||||
}
|
}
|
||||||
|
|
||||||
(void)::close(_armed_sub);
|
(void)orb_unsubscribe(_armed_sub);
|
||||||
(void)::close(_test_motor_sub);
|
(void)orb_unsubscribe(_test_motor_sub);
|
||||||
(void)::close(_actuator_direct_sub);
|
(void)orb_unsubscribe(_actuator_direct_sub);
|
||||||
|
|
||||||
// Removing the sensor bridges
|
// Removing the sensor bridges
|
||||||
auto br = _sensor_bridges.getHead();
|
auto br = _sensor_bridges.getHead();
|
||||||
@@ -1022,12 +1022,12 @@ UavcanNode::teardown()
|
|||||||
|
|
||||||
for (unsigned i = 0; i < actuator_controls_s::NUM_ACTUATOR_CONTROL_GROUPS; i++) {
|
for (unsigned i = 0; i < actuator_controls_s::NUM_ACTUATOR_CONTROL_GROUPS; i++) {
|
||||||
if (_control_subs[i] > 0) {
|
if (_control_subs[i] > 0) {
|
||||||
::close(_control_subs[i]);
|
orb_unsubscribe(_control_subs[i]);
|
||||||
_control_subs[i] = -1;
|
_control_subs[i] = -1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
return (_armed_sub >= 0) ? ::close(_armed_sub) : 0;
|
return (_armed_sub >= 0) ? orb_unsubscribe(_armed_sub) : 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int
|
int
|
||||||
@@ -1054,7 +1054,7 @@ UavcanNode::subscribe()
|
|||||||
|
|
||||||
if (unsub_groups & (1 << i)) {
|
if (unsub_groups & (1 << i)) {
|
||||||
warnx("unsubscribe from actuator_controls_%d", i);
|
warnx("unsubscribe from actuator_controls_%d", i);
|
||||||
::close(_control_subs[i]);
|
orb_unsubscribe(_control_subs[i]);
|
||||||
_control_subs[i] = -1;
|
_control_subs[i] = -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user