Rover: removed unused variables
thanks to Mike McCauley
This commit is contained in:
parent
7a6f671659
commit
11028c665d
@ -402,10 +402,6 @@ static const float t7 = 10000000.0;
|
|||||||
// A counter used to count down valid gps fixes to allow the gps estimate to settle
|
// A counter used to count down valid gps fixes to allow the gps estimate to settle
|
||||||
// before recording our home position (and executing a ground start if we booted with an air start)
|
// before recording our home position (and executing a ground start if we booted with an air start)
|
||||||
static uint8_t ground_start_count = 5;
|
static uint8_t ground_start_count = 5;
|
||||||
// Used to compute a speed estimate from the first valid gps fixes to decide if we are
|
|
||||||
// on the ground or in the air. Used to decide if a ground start is appropriate if we
|
|
||||||
// booted with an air start.
|
|
||||||
static int16_t ground_start_avg;
|
|
||||||
|
|
||||||
////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
||||||
// Location & Navigation
|
// Location & Navigation
|
||||||
@ -538,8 +534,6 @@ static float G_Dt = 0.02;
|
|||||||
static int32_t perf_mon_timer;
|
static int32_t perf_mon_timer;
|
||||||
// The maximum main loop execution time recorded in the current performance monitoring interval
|
// The maximum main loop execution time recorded in the current performance monitoring interval
|
||||||
static uint32_t G_Dt_max;
|
static uint32_t G_Dt_max;
|
||||||
// The number of gps fixes recorded in the current performance monitoring interval
|
|
||||||
static uint8_t gps_fix_count = 0;
|
|
||||||
|
|
||||||
////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
||||||
// System Timers
|
// System Timers
|
||||||
@ -840,11 +834,9 @@ static void update_GPS_10Hz(void)
|
|||||||
have_position = ahrs.get_position(current_loc);
|
have_position = ahrs.get_position(current_loc);
|
||||||
|
|
||||||
if (g_gps->new_data && g_gps->status() >= GPS::GPS_OK_FIX_3D) {
|
if (g_gps->new_data && g_gps->status() >= GPS::GPS_OK_FIX_3D) {
|
||||||
gps_fix_count++;
|
|
||||||
|
|
||||||
if(ground_start_count > 1){
|
if(ground_start_count > 1){
|
||||||
ground_start_count--;
|
ground_start_count--;
|
||||||
ground_start_avg += g_gps->ground_speed_cm;
|
|
||||||
|
|
||||||
} else if (ground_start_count == 1) {
|
} else if (ground_start_count == 1) {
|
||||||
// We countdown N number of good GPS fixes
|
// We countdown N number of good GPS fixes
|
||||||
|
@ -403,7 +403,6 @@ static void update_notify()
|
|||||||
static void resetPerfData(void) {
|
static void resetPerfData(void) {
|
||||||
mainLoop_count = 0;
|
mainLoop_count = 0;
|
||||||
G_Dt_max = 0;
|
G_Dt_max = 0;
|
||||||
gps_fix_count = 0;
|
|
||||||
perf_mon_timer = millis();
|
perf_mon_timer = millis();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user