From 86a795dd81047f3b8ad03a8e761e900149f1ebd3 Mon Sep 17 00:00:00 2001 From: Pascal Serrarens Date: Thu, 29 Aug 2024 12:39:53 +0200 Subject: [PATCH] Fix unit test --- Perception.cpp | 9 ++++++--- 1 file changed, 6 insertions(+), 3 deletions(-) diff --git a/Perception.cpp b/Perception.cpp index be44a3b..461de59 100644 --- a/Perception.cpp +++ b/Perception.cpp @@ -479,9 +479,12 @@ void Perception::Update(unsigned long currentTimeMs) { float distance = distanceSensor->GetDistance(); if (distance >= 0) { - Angle16 angle = sensor->position.horizontal; - // Polar position = Polar(angle, distance); - Polar position = Polar(distance, angle.ToFloat()); + // Angle16 angle = sensor->position.horizontal; + // Polar position = Polar(angle, distance); + // Polar position = Polar(distance, angle.ToFloat()); + // AddTrackedObject(distanceSensor, position); + Spherical16 position = Spherical16( + distance, sensor->position.horizontal, sensor->position.vertical); AddTrackedObject(distanceSensor, position); }