/** * 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; }