diff --git a/src/drivers/distance_sensor/tfmini/tfmini_parser.cpp b/src/drivers/distance_sensor/tfmini/tfmini_parser.cpp index ab65a0c583..76f754634a 100644 --- a/src/drivers/distance_sensor/tfmini/tfmini_parser.cpp +++ b/src/drivers/distance_sensor/tfmini/tfmini_parser.cpp @@ -159,7 +159,11 @@ int tfmini_parse(char c, char *parserbuf, unsigned *parserbuf_index, TFMINI_PARS unsigned int t2 = parserbuf[3]; t2 <<= 8; t2 += t1; - *dist = ((float)t2) / 100; + + if (t2 < 0xFFFFu) { + *dist = ((float)t2) / 100; + } + *state = TFMINI_PARSE_STATE::STATE6_GOT_CHECKSUM; *parserbuf_index = 0; ret = 0;