bug fixes and tweaks to new heuristics. i also added some new motion primitives for tucking and untucking the arm. seems to solve almost all of the hard cases. dts does on average 5x better than round robin (up to 10x).
Merge branch 'meta' of https://github.com/sid24ss/monolithic_pr2_planner into meta