Added some doxygen to bluetooth sending
Added some better logging
Merge branch 'testing'