Path now cuts off when near error and snaps to goal position to avoid small steps at end of path behavior
Merge branch 'master' of https://github.com/Brooks-Willis/dance_bot