[master] More error checking
[master] Bug fixes in bluetooth

We werent setting the rest of the packet to 0 which was causing the controller to instantly disconnect