Changed message structure from char[256] to uint8_t[4]. Added error
checking.