add speeding violation reporting

1 files changed, 12 insertions, 0 deletions

diff --git a/src/drone.cc b/src/drone.cc
index 2c0fad8..50bc5e7 100644
--- a/src/drone.cc
+++ b/src/drone.cc
@@ -31,6 +31,10 @@ Drone::Drone(const QJsonObject &json)
 	for (const QJsonValue &o : ja) {
 		waypoints.append(Waypoint(o.toObject()));
 	}
+	for (int i = 0; i < waypoints.size() - 1; i++) {
+		waypoints[i].computed_speed = (waypoints[i + 1].pos - waypoints[i].pos).length()
+			/ (waypoints[i + 1].frame - waypoints[i].frame);
+	}
 	setTo(0);
 }
 
@@ -55,10 +59,13 @@ void Drone::setTo(int frame) {
 	}
 	if (next > -1 && prev == -1) {
 		pos = next_wp->pos;
+		speed = next_wp->computed_speed;
 	} else if (prev > -1 && next == -1) {
 		pos = prev_wp->pos;
+		speed = prev_wp->computed_speed;
 	} else {
 		pos = lerp(prev_wp->pos, next_wp->pos, (double) (frame-prev) / (next-prev));
+		speed = prev_wp->computed_speed;
 	}
 }
 
@@ -73,6 +80,11 @@ int Drone::getId() const {
 }
 
 
+double Drone::getSpeed() const {
+	return speed;
+}
+
+
 const OpenGLMesh *Drone::getMesh() const {
 	return mesh;
 }