[bn_debug_console] Adds benchmark mode
[XBee] Fixes some unreported errors
[comm;loco] Adds debug tools