Fix unit test

This commit is contained in:
Pascal Serrarens 2024-08-29 12:39:53 +02:00
parent 7d3fcba55d
commit 86a795dd81

View File

@ -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);
}