Controller is now ready for PID tuning and other parameter testing. rosparam support integrated.