Expanded protocol to 6 bytes

Expanded protocol to 6 bytes to allow for 4 motors. Added logging to the
protocol. Greatly improved bad packet handling for the T-REX. Added
logging to the T-REX.