added speed-based accept radius. not tested yet. will be adding speed to waypoint in next stash.
code works very well at slow speeds. very consistent
this code works with the Mr T chassis. changed clicks to 2 for minuteman and changed interrupt back to change. I haven't tested this code with minuteman. It may be better to use previous commit.