compute bearing in TrackingAmongObstacles