publish to JointGroup controllers
temporarily revert to non-feedforward pid_controllers
fix twist_controller to be usable without base again
restructure test_twist publisher scripts