change method calculateAngleToTurn to lidarCalculateAngleToTurn