new route planning method
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
fixed st
Brackets and parenthese are different things
error set to 100 points
Implemented individual joinnt control of all five joints
Merge branch 'master' of https://github.com/Brooks-Willis/dance_bot into integration
code to run/viz originally recorded paths