Added wait for string param function
Added ros_control util header
Added urdf transmission parsing function