Fixed invalid TF check (#66)

* Fixed invalid TF check * Improved syntaxis --------- Co-authored-by: Facundo Garcia <[email protected]>
fixposition · Aug 28, 2024 · 407fbc8 · 407fbc8
1 parent 3122287
commit 407fbc8
Showing 1 changed file with 1 addition and 1 deletion.
diff --git 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<std::string>& 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