Minor bugs fixed and minor changes to adapt lib ROS node wrapper requirements