MoveToPose now has code to move to a joint goal (might want to rename module).