Angle difference between two bearings: Difference between revisions

Content added Content deleted
Line 19: Line 19:
using namespace std;
using namespace std;


double getDifference(float b1, float b2) {
double getDifference(double b1, double b2) {
double val = std::min((b1-b2)<0?b1-b2+360:b1-b2, (b2-b1)<0?b2-b1+360:b2-b1);
double val = std::min((b1-b2)<0?b1-b2+360:b1-b2, (b2-b1)<0?b2-b1+360:b2-b1);
if (val > M_PI) val -= 2*M_PI;
if (val > M_PI) val -= 2*M_PI;