RoboidControl/RoboidControl-cpp
RoboidControl/RoboidControl-cpp
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Fix unit test

Browse Source
This commit is contained in:
Pascal Serrarens 2024-08-29 12:39:53 +02:00
parent 7d3fcba55d
commit 86a795dd81
1 changed files with 6 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
Perception.cpp
View File

@ -479,9 +479,12 @@ void Perception::Update(unsigned long currentTimeMs) {
float distance = distanceSensor->GetDistance(); float distance = distanceSensor->GetDistance();
if (distance >= 0) { if (distance >= 0) {
Angle16 angle = sensor->position.horizontal; // Angle16 angle = sensor->position.horizontal;
// Polar position = Polar(angle, distance); // Polar position = Polar(angle, distance);
Polar position = Polar(distance, angle.ToFloat()); // Polar position = Polar(distance, angle.ToFloat());
// AddTrackedObject(distanceSensor, position);
Spherical16 position = Spherical16(
distance, sensor->position.horizontal, sensor->position.vertical);
AddTrackedObject(distanceSensor, position); AddTrackedObject(distanceSensor, position);
} }