Added queue extensions to the USBL simulator and validated the functionality.
Updates to the USBLManager and USBL simulation communication.
Merge branch 'usbl_comms' of http://github.com/labust/labust-ros-pkg into usbl_comms