[jog_arm] fix access past end of array bug (moveit#2155)

* [jog_arm] fix access past end of array bug
PickNikRobotics · Jun 24, 2020 · a036c42 · a036c42
1 parent 805b6b3
commit a036c42
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/moveit_experimental/moveit_jog_arm/src/jog_calcs.cpp b/moveit_experimental/moveit_jog_arm/src/jog_calcs.cpp
@@ -298,9 +298,9 @@ void JogCalcs::run(const ros::TimerEvent& timer_event)
     else if (parameters_.command_out_type == "std_msgs/Float64MultiArray")
     {
       auto joints = moveit::util::make_shared_from_pool<std_msgs::Float64MultiArray>();
-      if (parameters_.publish_joint_positions)
+      if (parameters_.publish_joint_positions && !joint_trajectory->points.empty())
         joints->data = joint_trajectory->points[0].positions;
-      else if (parameters_.publish_joint_velocities)
+      else if (parameters_.publish_joint_velocities && !joint_trajectory->points.empty())
         joints->data = joint_trajectory->points[0].velocities;
       outgoing_cmd_pub_.publish(joints);
     }