Normalizes angle to be within 0-360 degrees
double normalizeAngle(double angle) { while (angle < 0) { angle += 360; } while (angle >= 360) { angle -= 360; } return angle; }