@@ -1247,24 +1247,22 @@ TEST_P(TrajectoryControllerTestParameterized, invalid_message_nonzero_vel)
12471247 rclcpp::executors::SingleThreadedExecutor executor;
12481248 SetUpAndActivateTrajectoryController (executor, {nonzero_vel_parameters});
12491249
1250- trajectory_msgs::msg::JointTrajectory traj_msg, good_traj_msg;
1251-
1252- good_traj_msg.joint_names = joint_names_;
1253- good_traj_msg.header .stamp = rclcpp::Time (0 );
1254- good_traj_msg.points .resize (1 );
1255- good_traj_msg.points [0 ].time_from_start = rclcpp::Duration::from_seconds (0.25 );
1256- good_traj_msg.points [0 ].positions .resize (1 );
1257- good_traj_msg.points [0 ].positions = {1.0 , 2.0 , 3.0 };
1258- good_traj_msg.points [0 ].velocities .resize (1 );
1259- good_traj_msg.points [0 ].velocities = {-1.0 , -2.0 , -3.0 };
1260- // Nonzero velocity at trajectory end!
1261- EXPECT_FALSE (traj_controller_->validate_trajectory_msg (good_traj_msg));
1250+ trajectory_msgs::msg::JointTrajectory traj_msg;
1251+ traj_msg.joint_names = joint_names_;
1252+ traj_msg.header .stamp = rclcpp::Time (0 );
12621253
12631254 // empty message (no throw!)
1264- traj_msg = good_traj_msg;
1265- traj_msg.points .clear ();
12661255 ASSERT_NO_THROW (traj_controller_->validate_trajectory_msg (traj_msg));
12671256 EXPECT_FALSE (traj_controller_->validate_trajectory_msg (traj_msg));
1257+
1258+ // Nonzero velocity at trajectory end!
1259+ traj_msg.points .resize (1 );
1260+ traj_msg.points [0 ].time_from_start = rclcpp::Duration::from_seconds (0.25 );
1261+ traj_msg.points [0 ].positions .resize (1 );
1262+ traj_msg.points [0 ].positions = {1.0 , 2.0 , 3.0 };
1263+ traj_msg.points [0 ].velocities .resize (1 );
1264+ traj_msg.points [0 ].velocities = {-1.0 , -2.0 , -3.0 };
1265+ EXPECT_FALSE (traj_controller_->validate_trajectory_msg (traj_msg));
12681266}
12691267
12701268/* *
0 commit comments