Keep 3 minutes of trajectory points (#3706)

2e9d1120 · Don Gagne · GitHub · 196153aa · 2e9d1120
Commit 2e9d1120 authored Jun 30, 2016 by Don Gagne Committed by GitHub Jun 30, 2016
Hide whitespace changes
Inline Side-by-side

Showing with 4 additions and 0 deletions

Vehicle.cc src/Vehicle/Vehicle.cc +4 -0

No files found.
--- a/src/Vehicle/Vehicle.cc
+++ b/src/Vehicle/Vehicle.cc
@@ -1279,6 +1279,10 @@ void Vehicle::_missionManagerError(int errorCode, const QString& errorMsg)
 void Vehicle::_addNewMapTrajectoryPoint(void)
 {
    if (_mapTrajectoryHaveFirstCoordinate) {
+        // Keep three minutes of trajectory
+        if (_mapTrajectoryList.count() * _mapTrajectoryMsecsBetweenPoints > 3 * 1000 * 60) {
+            _mapTrajectoryList.removeAt(0)->deleteLater();
+        }
        _mapTrajectoryList.append(new CoordinateVector(_mapTrajectoryLastCoordinate, _coordinate, this));
    }
    _mapTrajectoryHaveFirstCoordinate = true;