Updated bluetooth server: fixed bugs causing random crashes while connected to a client gcs.
Added array bounds check to mavlink packet initialization.