diff --git a/AutonomousMode/Processing/processing.cpp b/AutonomousMode/Processing/processing.cpp index 630bd72..d041ead 100644 --- a/AutonomousMode/Processing/processing.cpp +++ b/AutonomousMode/Processing/processing.cpp @@ -144,6 +144,10 @@ void Processing::calcAngles(FrameData &data, int imageColums, int imageRows, boo LFRVector b(contourCenter-focusPoint); double angle = a.angle(b); + if (b.x < 0.0) + { + angle *= -1.0; + } //Write to Data data.angle = angle;