diff --git a/crane_robot_receiver/src/robot_receiver_node.cpp b/crane_robot_receiver/src/robot_receiver_node.cpp index 877aae007..4cc1d5573 100644 --- a/crane_robot_receiver/src/robot_receiver_node.cpp +++ b/crane_robot_receiver/src/robot_receiver_node.cpp @@ -54,6 +54,11 @@ class RobotFeedbackReceiver ++invalid_packet_count_; return; } + if (protocol::readRawByte(buf, protocol::offset::CHECKSUM) != protocol::computeChecksum(buf)) { + ++checksum_error_count_; + ++invalid_packet_count_; + return; + } RobotFeedback new_packet = parseBuffer(buf, stamp); updateCounterStatsLocked(new_packet.counter);