- if (npad <= NUM_PAD_SAMPLES) {
- pad_pres = pad_pres_total / npad;
- pad_accel = pad_accel_total / npad;
- if (npad_gps) {
- pad_lat = pad_lat_total / npad_gps;
- pad_lon = pad_lon_total / npad_gps;
- pad_alt = pad_alt_total / npad_gps;
- }
- }
- if (npad == NUM_PAD_SAMPLES) {
- npad++;
- min_pres = pad_pres;
- min_accel = pad_accel;
+ if (state->locked && npad_gps <= NUM_PAD_SAMPLES) {
+ pad_lat = pad_lat_total / npad_gps;
+ pad_lon = pad_lon_total / npad_gps;
+ pad_alt = pad_alt_total / npad_gps;