uint8 calc_checksum(uint8 *p_data, int32 data_len) { uint8 sum = 0;
while (data_len--) { sum += *p_data++; } return sum;
}