INIT_FCS
*fcs = gsm_fcs_add_block(INIT_FCS, dp , msg->data - dp);
gsm->fcs = INIT_FCS;
*dp = 0xFF - gsm_fcs_add_block(INIT_FCS, msg->data, dp - msg->data);