Update fuse_models/include/fuse_models/unicycle_2d_state_cost_function.h

Co-authored-by: Enrique Fernandez Perdomo <[email protected]>

fuse_models/include/fuse_models/unicycle_2d_state_cost_function.h

@@ -143,7 +143,7 @@ class Unicycle2DStateCostFunction : public ceres::SizedCostFunction<8, 2, 1, 2,
     const double delta_yaw_est = parameters[6][0] - parameters[1][0];
     const fuse_core::Vector2d position1(parameters[0][0], parameters[0][1]);
     const fuse_core::Vector2d position2(parameters[5][0], parameters[5][1]);
-    const fuse_core::Vector2d position_diff = (position2 - position1);
+    const fuse_core::Vector2d position_diff = position2 - position1;
     const fuse_core::Matrix2d R_yaw_inv = fuse_core::rotationMatrix2D(-parameters[1][0]);
 
     Eigen::Map<fuse_core::Vector8d> residuals_map(residuals);