Reflexxes will now return a rotate->drive->rotate style of trajectory.
The robot will still not fully reach the goal, however. Also, the source still needs to be cleaned up.