added endRoute and getPreviousPoint

lib/Navigation/route.cpp

@@ -105,16 +105,34 @@ Point Route::startRoute() {
     return *this->it;
 }
 
+Point Route::endRoute() {
+    if (this->points.size() < 1)
+        return Point(0, 0);
+    this->it = this->points.end();
+    this->currentPoint = this->points.size();
+    return *this->it;
+}
+
 Point Route::getNextPoint() {
     if (this->it != this->points.end()) {
         this->it++;
         this->currentPoint++;
         return *this->it;
-    } else if (this->it == this->points.end() && this->currentPoint != this->points.size()) {
-        this->currentPoint++;
-        return *this->it;
+    // } else if (this->it == this->points.end() && this->currentPoint != this->points.size()) {
+    //     this->currentPoint++;
+    //     return *this->it;
     } else
-        return Point(0, 0);
+        return Point();
+}
+
+Point Route::getPreviousPoint() {
+    if (this->it != this->points.begin()) {
+        this->it--;
+        this->currentPoint--;
+        return *this->it;
+    } else {
+        return Point();
+    }
 }
 
 RouteInfo Route::getRouteInfo() {

lib/Navigation/route.h

@@ -138,6 +138,7 @@ class Route {
          * @return Point 
          */
         Point startRoute();
+        Point endRoute();
 
         /**
          * @brief Get the next point and set it as target
@@ -145,6 +146,7 @@ class Route {
          * @return Point is zero if there are no more Points
          */
         Point getNextPoint();
+        Point getPreviousPoint();
 
         /**
          * @brief Get the Route Info object