Added debug information to USBLManager. Tweaked the USBL nodelet data sending.
Merge branch 'usbl_comms' into pladypos_bts2013