fixed mutex in hardpoint_controler_set()

This commit is contained in:
blah 2016-01-27 08:22:06 -08:00 committed by Lorenz Meier
parent 39fc9c7761
commit 5e596df859
2 changed files with 3 additions and 3 deletions

View File

@ -65,8 +65,6 @@ int UavcanHardpointController::init()
void UavcanHardpointController::set_command(uint8_t hardpoint_id, uint16_t command)
{
(void)pthread_mutex_lock(&_node_mutex);
_cmd.command = command;
_cmd.hardpoint_id = hardpoint_id;
@ -81,7 +79,7 @@ void UavcanHardpointController::set_command(uint8_t hardpoint_id, uint16_t comma
if (!_timer.isRunning()) {
_timer.startPeriodic(uavcan::MonotonicDuration::fromMSec(1000 / MAX_RATE_HZ));
}
(void)pthread_mutex_lock(&_node_mutex);
}
void UavcanHardpointController::periodic_update(const uavcan::TimerEvent &)
{

View File

@ -1224,7 +1224,9 @@ void UavcanNode::shrink()
void UavcanNode::hardpoint_controller_set(uint8_t hardpoint_id, uint16_t command)
{
(void)pthread_mutex_lock(&_node_mutex);
_hardpoint_controller.set_command(hardpoint_id, command);
(void)pthread_mutex_lock(&_node_mutex);
}
/*
* App entry point