Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-24 09:38:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_UAVCAN: reduce whitespace indentation

Browse Source
This commit is contained in:
Tom Pittenger 2018-03-02 15:37:20 -08:00 committed by Tom Pittenger
parent c49d4aef50
commit 1add05d9a1
1 changed files with 161 additions and 165 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

18
libraries/AP_UAVCAN/AP_UAVCAN.cpp
View File

@ -108,10 +108,8 @@ static uavcan::equipment::ahrs::Solution _att_state;
void AP_UAVCAN::UAVCAN_AHRS_update(const AP_AHRS_NavEKF &ahrs)
{
bool sem_ret = _fix_out_sem->take(1);
if (sem_ret) {
if (fix_out_array[_uavcan_i] != nullptr || fix2_out_array[_uavcan_i] != nullptr) {
if (_fix_out_sem->take(1) &&
(fix_out_array[_uavcan_i] != nullptr || fix2_out_array[_uavcan_i] != nullptr)) {
const AP_GPS &cgps = AP::gps();
Location loc;
Vector3f vel_NED;
@ -252,9 +250,11 @@ void AP_UAVCAN::UAVCAN_AHRS_update(const AP_AHRS_NavEKF &ahrs)
ts.usec = 0;
_fix_state.timestamp = ts;
_fix2_state.timestamp = ts;
_fix_out_sem->give();
}
if (attitude_out_array[_uavcan_i] != nullptr) {
if (_att_out_sem->take(1) && (attitude_out_array[_uavcan_i] != nullptr)) {
uavcan::Timestamp ts;
ts.usec = AP_HAL::micros64();
_att_state.timestamp = ts;
@ -285,14 +285,10 @@ void AP_UAVCAN::UAVCAN_AHRS_update(const AP_AHRS_NavEKF &ahrs)
// TODO: extract from EKF
//_att_state.linear_acceleration_covariance
_att_out_sem->give();
}
_fix_out_sem->give();
} else {
if (sem_ret) {
_fix_out_sem->give();
}
}
}
static void gnss_fix_cb(const uavcan::ReceivedDataStructure<uavcan::equipment::gnss::Fix>& msg, uint8_t mgr)