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

Fix zero vector addition

Browse Source
This commit is contained in:
Pascal Serrarens 2023-03-30 17:16:43 +02:00
parent 99e4515358
commit 113f5a14f3
1 changed files with 2 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/Polar.cpp
View File

@ -30,6 +30,8 @@ float Polar::Distance(const Polar& v1, const Polar& v2) {
Polar Polar::operator+(const Polar& v2) const { Polar Polar::operator+(const Polar& v2) const {
if (v2.distance == 0) if (v2.distance == 0)
return Polar(this->angle, this->distance); return Polar(this->angle, this->distance);
if (this->distance == 0)
return v2;
float deltaAngle = Angle::Normalize(v2.angle - this->angle); float deltaAngle = Angle::Normalize(v2.angle - this->angle);
float rotation = deltaAngle < 0 ? 180 + deltaAngle : 180 - deltaAngle; float rotation = deltaAngle < 0 ? 180 + deltaAngle : 180 - deltaAngle;