fixed bug in interactFullBodyPlanner where the goal orientation was sent wrong.
The problem was with the quaternion API; upgraded from a deprecated one.
Merge branch 'meta' of ssh://github.com/sid24ss/monolithic_pr2_planner into meta