/**
* Extract the robot bearing from the response
*
* @param lr
* @return angle in degrees
*/
double getBearingAngle(LocalizationResponse lr) {
double e[] = lr.getOrientation();
double angle = 2 * Math.atan2(e[3], e[0]);
return angle * 180 / Math.PI;
}
