diff --git a/fixposition_driver_lib/src/messages/fpa/tf.cpp b/fixposition_driver_lib/src/messages/fpa/tf.cpp index 7e0d46c..d0bb1e2 100644 --- a/fixposition_driver_lib/src/messages/fpa/tf.cpp +++ b/fixposition_driver_lib/src/messages/fpa/tf.cpp @@ -68,7 +68,7 @@ void FP_TF::ConvertFromTokens(const std::vector& tokens) { tokens.at(orientation_y_idx), tokens.at(orientation_z_idx)); // Check if TF is valid - if (!tf.rotation.vec().isZero() && !(tf.rotation.w() == 0)) valid_tf = true; + valid_tf = !(tf.rotation.w() == 0 && tf.rotation.vec().isZero()); } } // namespace fixposition