forked from upstream-mirrors/OpenTracks
Jimmy Shih
348 lines
10 KiB
Java
348 lines
10 KiB
Java
/*
|
|
* Copyright 2009 Google Inc.
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License"); you may not
|
|
* use this file except in compliance with the License. You may obtain a copy of
|
|
* the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
* License for the specific language governing permissions and limitations under
|
|
* the License.
|
|
*/
|
|
|
|
package com.google.android.apps.mytracks.stats;
|
|
|
|
import static com.google.android.apps.mytracks.Constants.TAG;
|
|
import static com.google.android.apps.mytracks.services.TrackRecordingService.MAX_NO_MOVEMENT_SPEED;
|
|
import static com.google.android.apps.mytracks.services.TrackRecordingService.PAUSE_LATITUDE;
|
|
|
|
import com.google.android.apps.mytracks.util.LocationUtils;
|
|
import com.google.common.annotations.VisibleForTesting;
|
|
|
|
import android.location.Location;
|
|
import android.util.Log;
|
|
|
|
/**
|
|
* Updater for {@link TripStatistics}. For updating track trip statistics as new
|
|
* locations are added. Note that some of the locations represent pause/resume
|
|
* separator.
|
|
*
|
|
* @author Sandor Dornbush
|
|
* @author Rodrigo Damazio
|
|
*/
|
|
public class TripStatisticsUpdater {
|
|
|
|
/**
|
|
* The number of elevation readings to smooth to get a somewhat accurate
|
|
* signal.
|
|
*/
|
|
@VisibleForTesting
|
|
static final int ELEVATION_SMOOTHING_FACTOR = 25;
|
|
|
|
/**
|
|
* The number of run readings to smooth for calculating grade.
|
|
*/
|
|
@VisibleForTesting
|
|
static final int RUN_SMOOTHING_FACTOR = 25;
|
|
|
|
/**
|
|
* The number of rise readings to smooth for calculating grade.
|
|
*/
|
|
@VisibleForTesting
|
|
static final int RISE_SMOOTHING_FACTOR = 25;
|
|
|
|
/**
|
|
* The number of grade readings to smooth to get a somewhat accurate signal.
|
|
*/
|
|
@VisibleForTesting
|
|
static final int GRADE_SMOOTHING_FACTOR = 5;
|
|
|
|
/**
|
|
* The number of speed reading to smooth to get a somewhat accurate signal.
|
|
*/
|
|
@VisibleForTesting
|
|
static final int SPEED_SMOOTHING_FACTOR = 25;
|
|
|
|
/**
|
|
* Ignore any acceleration faster than this. Will ignore any speeds that imply
|
|
* acceleration greater than 2g's 2g = 19.6 m/s^2 = 0.0002 m/ms^2 = 0.02
|
|
* m/(m*ms)
|
|
*/
|
|
private static final double MAX_ACCELERATION = 0.02;
|
|
|
|
// The track's trip statistics
|
|
private final TripStatistics tripStatistics;
|
|
|
|
// The current segment's trip statistics
|
|
private TripStatistics currentSegment;
|
|
|
|
// Current segment's last location.
|
|
private Location lastLocation;
|
|
|
|
// Current segment's last moving location
|
|
private Location lastMovingLocation;
|
|
|
|
// A buffer of the recent elevation readings (m)
|
|
private final DoubleBuffer elevationBuffer = new DoubleBuffer(ELEVATION_SMOOTHING_FACTOR);
|
|
|
|
// A buffer of the recent run readings (m) for calculating grade
|
|
private final DoubleBuffer runBuffer = new DoubleBuffer(RUN_SMOOTHING_FACTOR);
|
|
|
|
// A buffer of the recent rise readings (m) for calculating grade
|
|
private final DoubleBuffer riseBuffer = new DoubleBuffer(RISE_SMOOTHING_FACTOR);
|
|
|
|
// A buffer of the recent grade calculations (%)
|
|
private final DoubleBuffer gradeBuffer = new DoubleBuffer(GRADE_SMOOTHING_FACTOR);
|
|
|
|
// A buffer of the recent speed readings (m/s) for calculating max speed
|
|
private final DoubleBuffer speedBuffer = new DoubleBuffer(SPEED_SMOOTHING_FACTOR);
|
|
|
|
/**
|
|
* Creates a new trip statistics updater.
|
|
*
|
|
* @param startTime the start time
|
|
*/
|
|
public TripStatisticsUpdater(long startTime) {
|
|
tripStatistics = init(startTime);
|
|
currentSegment = init(startTime);
|
|
}
|
|
|
|
public void updateTime(long time) {
|
|
currentSegment.setStopTime(time);
|
|
currentSegment.setTotalTime(time - currentSegment.getStartTime());
|
|
}
|
|
|
|
/**
|
|
* Gets the track's trip statistics.
|
|
*/
|
|
public TripStatistics getTripStatistics() {
|
|
// Take a snapshot - we don't want anyone messing with our tripStatistics
|
|
TripStatistics stats = new TripStatistics(tripStatistics);
|
|
stats.merge(currentSegment);
|
|
return stats;
|
|
}
|
|
|
|
/**
|
|
* Adds a location. TODO: This assume location has a valid time.
|
|
*
|
|
* @param location the location
|
|
* @param minRecordingDistance the min recording distance
|
|
*/
|
|
public void addLocation(Location location, int minRecordingDistance) {
|
|
// Always update time
|
|
updateTime(location.getTime());
|
|
|
|
if (!LocationUtils.isValidLocation(location)) {
|
|
// Either pause or resume marker
|
|
if (location.getLatitude() == PAUSE_LATITUDE) {
|
|
if (lastLocation != null && lastMovingLocation != null
|
|
&& lastLocation != lastMovingLocation) {
|
|
currentSegment.addTotalDistance(lastMovingLocation.distanceTo(lastLocation));
|
|
}
|
|
tripStatistics.merge(currentSegment);
|
|
}
|
|
currentSegment = init(location.getTime());
|
|
lastLocation = null;
|
|
lastMovingLocation = null;
|
|
elevationBuffer.reset();
|
|
runBuffer.reset();
|
|
riseBuffer.reset();
|
|
gradeBuffer.reset();
|
|
speedBuffer.reset();
|
|
return;
|
|
}
|
|
currentSegment.updateLatitudeExtremities(location.getLatitude());
|
|
currentSegment.updateLongitudeExtremities(location.getLongitude());
|
|
|
|
if (location.hasAltitude()) {
|
|
updateElevation(location.getAltitude());
|
|
}
|
|
|
|
if (lastLocation == null || lastMovingLocation == null) {
|
|
lastLocation = location;
|
|
lastMovingLocation = location;
|
|
return;
|
|
}
|
|
|
|
double movingDistance = lastMovingLocation.distanceTo(location);
|
|
if (movingDistance < minRecordingDistance
|
|
&& (!location.hasSpeed() || location.getSpeed() < MAX_NO_MOVEMENT_SPEED)) {
|
|
speedBuffer.reset();
|
|
lastLocation = location;
|
|
return;
|
|
}
|
|
long movingTime = location.getTime() - lastLocation.getTime();
|
|
if (movingTime < 0) {
|
|
lastLocation = location;
|
|
return;
|
|
}
|
|
|
|
// Update total distance
|
|
currentSegment.addTotalDistance(movingDistance);
|
|
|
|
// Update moving time
|
|
currentSegment.addMovingTime(movingTime);
|
|
|
|
// Update grade
|
|
if (location.hasAltitude() && lastLocation.hasAltitude()) {
|
|
float run = lastLocation.distanceTo(location);
|
|
double rise = location.getAltitude() - lastLocation.getAltitude();
|
|
updateGrade(run, rise);
|
|
}
|
|
|
|
// Update max speed
|
|
if (location.hasSpeed() && lastLocation.hasSpeed()) {
|
|
updateSpeed(
|
|
location.getTime(), location.getSpeed(), lastLocation.getTime(), lastLocation.getSpeed());
|
|
}
|
|
|
|
lastLocation = location;
|
|
lastMovingLocation = location;
|
|
}
|
|
|
|
/**
|
|
* Gets the smoothed elevation over several readings. The elevation readings
|
|
* is noisy so the smoothed elevation is better than the raw elevation for
|
|
* many tasks.
|
|
*/
|
|
public double getSmoothedElevation() {
|
|
return elevationBuffer.getAverage();
|
|
}
|
|
|
|
public double getSmoothedSpeed() {
|
|
return speedBuffer.getAverage();
|
|
}
|
|
|
|
/**
|
|
* Updates a speed reading. Assumes the user is moving.
|
|
*
|
|
* @param time the time
|
|
* @param speed the speed
|
|
* @param lastLocationTime the last location time
|
|
* @param lastLocationSpeed the last location speed
|
|
*/
|
|
@VisibleForTesting
|
|
void updateSpeed(long time, double speed, long lastLocationTime, double lastLocationSpeed) {
|
|
if (speed < MAX_NO_MOVEMENT_SPEED) {
|
|
speedBuffer.reset();
|
|
} else if (isValidSpeed(time, speed, lastLocationTime, lastLocationSpeed)) {
|
|
speedBuffer.setNext(speed);
|
|
if (speedBuffer.isFull() && speed > currentSegment.getMaxSpeed()) {
|
|
currentSegment.setMaxSpeed(speed);
|
|
}
|
|
} else {
|
|
Log.d(TAG, "Invalid speed. speed: " + speed + " lastLocationSpeed: " + lastLocationSpeed);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Updates an elevation reading.
|
|
*
|
|
* @param elevation the elevation
|
|
*/
|
|
@VisibleForTesting
|
|
void updateElevation(double elevation) {
|
|
// Update elevation using the smoothed average after the buffer is full
|
|
double oldAverage = elevationBuffer.getAverage();
|
|
elevationBuffer.setNext(elevation);
|
|
double newAverage = elevationBuffer.getAverage();
|
|
if (elevationBuffer.isFull()) {
|
|
currentSegment.updateElevationExtremities(newAverage);
|
|
double difference = newAverage - oldAverage;
|
|
if (difference > 0) {
|
|
currentSegment.addTotalElevationGain(difference);
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Updates a grade reading.
|
|
*
|
|
* @param run the run
|
|
* @param rise the rise
|
|
*/
|
|
@VisibleForTesting
|
|
void updateGrade(double run, double rise) {
|
|
runBuffer.setNext(run);
|
|
riseBuffer.setNext(rise);
|
|
|
|
if (!runBuffer.isFull() || !riseBuffer.isFull()) {
|
|
return;
|
|
}
|
|
|
|
double smoothedRun = runBuffer.getAverage();
|
|
|
|
/*
|
|
* With the error in the altitude measurement it is dangerous to divide by
|
|
* anything less than 5.
|
|
*/
|
|
if (smoothedRun < 5.0) {
|
|
return;
|
|
}
|
|
gradeBuffer.setNext(riseBuffer.getAverage() / smoothedRun);
|
|
currentSegment.updateGradeExtremities(gradeBuffer.getAverage());
|
|
}
|
|
|
|
private TripStatistics init(long time) {
|
|
TripStatistics stats = new TripStatistics();
|
|
stats.setStartTime(time);
|
|
stats.setStopTime(time);
|
|
return stats;
|
|
}
|
|
|
|
/**
|
|
* Returns true if the speed is valid.
|
|
*
|
|
* @param time the time
|
|
* @param speed the speed
|
|
* @param lastLocationTime the last location time
|
|
* @param lastLocationSpeed the last location speed
|
|
*/
|
|
private boolean isValidSpeed(
|
|
long time, double speed, long lastLocationTime, double lastLocationSpeed) {
|
|
|
|
/*
|
|
* There are a lot of noisy speed readings. Do the cheapest checks first,
|
|
* most expensive last.
|
|
*/
|
|
if (speed == 0) {
|
|
return false;
|
|
}
|
|
|
|
/*
|
|
* The following code will ignore unlikely readings. 128 m/s seems to be an
|
|
* internal android error code.
|
|
*/
|
|
if (Math.abs(speed - 128) < 1) {
|
|
return false;
|
|
}
|
|
|
|
/*
|
|
* See if the speed seems physically likely. Ignore any speeds that imply
|
|
* acceleration greater than 2g.
|
|
*/
|
|
long timeDifference = time - lastLocationTime;
|
|
double speedDifference = Math.abs(lastLocationSpeed - speed);
|
|
if (speedDifference > MAX_ACCELERATION * timeDifference) {
|
|
return false;
|
|
}
|
|
|
|
/*
|
|
* Only check if the speed buffer is full. Check that the speed is less than
|
|
* 10X the smoothed average and the speed difference doesn't imply 2g
|
|
* acceleration.
|
|
*/
|
|
if (speedBuffer.isFull()) {
|
|
double average = speedBuffer.getAverage();
|
|
double diff = Math.abs(average - speed);
|
|
return (speed < average * 10) && (diff < MAX_ACCELERATION * timeDifference);
|
|
} else {
|
|
return true;
|
|
}
|
|
}
|
|
}
|