From c0c6e5c2bdb3078eb04a52908ddf41b0b5033207 Mon Sep 17 00:00:00 2001
From: frederic wagner <frederic.wagner@imag.fr>
Date: Tue, 13 Sep 2022 17:19:42 +0200
Subject: [PATCH] new instant speed

---
 apps/gipy/ChangeLog |  1 +
 apps/gipy/app.js    | 10 +++++++---
 2 files changed, 8 insertions(+), 3 deletions(-)

diff --git a/apps/gipy/ChangeLog b/apps/gipy/ChangeLog
index 71ed3dc2e..8684daf17 100644
--- a/apps/gipy/ChangeLog
+++ b/apps/gipy/ChangeLog
@@ -51,3 +51,4 @@
 	* Buzzing 100m ahead instead of 50m.
 	* Detect sharp turns.
 	* Display instant speed.
+	* New instant speed algorithm.
diff --git a/apps/gipy/app.js b/apps/gipy/app.js
index f1064d7a3..4acb9f284 100644
--- a/apps/gipy/app.js
+++ b/apps/gipy/app.js
@@ -62,12 +62,16 @@ class Status {
 
     let last_point = this.old_points[this.old_points.length - 1];
     let oldest_point = this.old_points[0];
-    this.instant_speed =
-      oldest_point.distance(last_point) / (now - this.old_times[0]);
 
-    if (this.old_points.length == 8) {
+    if (this.old_points.length == 6) {
+      let p1 = this.old_points[0].plus(this.old_points[1]).plus(this.old_points[2]).times(1/3);
+      let p2 = this.old_points[3].plus(this.old_points[4]).plus(this.old_points[5]).times(1/3);
+      this.instant_speed = p1.distance(p2) / (this.old_times[4] - this.old_times[1]);
       this.old_points.shift();
       this.old_times.shift();
+    } else {
+      this.instant_speed =
+        oldest_point.distance(last_point) / (now - this.old_times[0]);
     }
     // let's just take angle of segment between newest point and a point a bit before
     let previous_index = this.old_points.length - 3;