ubx.c: Add some more error checking code

This commit is contained in:
Dieter Spaar 2012-07-18 22:15:36 +02:00 committed by Harald Welte
parent fa32567711
commit 4db6eb8841
1 changed files with 15 additions and 0 deletions

15
ubx.c
View File

@ -60,11 +60,26 @@ ubx_msg_dispatch(struct ubx_dispatch_entry *dt,
uint8_t cksum[2], *cksum_ptr;
ubx_msg_handler_t h;
if (len < 2) {
fprintf(stderr, "[!] Length too small (%d)\n", len);
return -1;
}
if ((hdr->sync[0] != UBX_SYNC0) || (hdr->sync[1] != UBX_SYNC1)) {
fprintf(stderr, "[!] Invalid sync bytes\n");
return -1;
}
if (len < sizeof(struct ubx_hdr)) {
fprintf(stderr, "[!] Length too small for UBX header (%d)\n", len);
return -1;
}
if (len < sizeof(struct ubx_hdr) + hdr->payload_len - 2) {
fprintf(stderr, "[!] Length too small for UBX header and payload (%d)\n", len);
return -1;
}
ubx_checksum(msg + 2, sizeof(struct ubx_hdr) + hdr->payload_len - 2, cksum);
cksum_ptr = msg + (sizeof(struct ubx_hdr) + hdr->payload_len);
if ((cksum_ptr[0] != cksum[0]) || (cksum_ptr[1] != cksum[1])) {