|
|
|
@ -8,7 +8,7 @@ static void read_inertia()
@@ -8,7 +8,7 @@ static void read_inertia()
|
|
|
|
|
// inertial altitude estimates |
|
|
|
|
inertial_nav.update(G_Dt); |
|
|
|
|
|
|
|
|
|
if( motors.armed() && g.log_bitmask & MASK_LOG_INAV ) { |
|
|
|
|
if( motors.armed() && (g.log_bitmask & MASK_LOG_INAV) ) { |
|
|
|
|
log_counter_inav++; |
|
|
|
|
if( log_counter_inav >= 10 ) { |
|
|
|
|
log_counter_inav = 0; |
|
|
|
@ -23,4 +23,4 @@ static void read_inertial_altitude()
@@ -23,4 +23,4 @@ static void read_inertial_altitude()
|
|
|
|
|
// with inertial nav we can update the altitude and climb rate at 50hz |
|
|
|
|
current_loc.alt = inertial_nav.get_altitude(); |
|
|
|
|
climb_rate = inertial_nav.get_velocity_z(); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|