Check yaw_tol against the actual damn error, not

the odom yaw value.
Use minimum distance in costmap_checker
Merge remote-tracking branch 'origin/dumb_planner' into dumb_planner