More cleanup, removed old constructor
Refactored multi_joint_controller, added explicit fetching of velocity and position limits.