Fix bug with wrong TPS indications (uint8_t overflow)