mirror of
https://github.com/moveit/moveit_task_constructor.git
synced 2025-11-04 14:49:57 +08:00
add missing model_id to published cartesian trajectory
This commit is contained in:
parent
f8b1b3c204
commit
af67324224
@ -267,6 +267,7 @@ void
|
|||||||
moveit::task_constructor::subtasks::CartesianPositionMotion::_publishTrajectory(const robot_trajectory::RobotTrajectory& trajectory, const moveit::core::RobotState& start){
|
moveit::task_constructor::subtasks::CartesianPositionMotion::_publishTrajectory(const robot_trajectory::RobotTrajectory& trajectory, const moveit::core::RobotState& start){
|
||||||
moveit_msgs::DisplayTrajectory dt;
|
moveit_msgs::DisplayTrajectory dt;
|
||||||
robot_state::robotStateToRobotStateMsg(start, dt.trajectory_start);
|
robot_state::robotStateToRobotStateMsg(start, dt.trajectory_start);
|
||||||
|
dt.model_id= scene_->getRobotModel()->getName();
|
||||||
dt.trajectory.resize(1);
|
dt.trajectory.resize(1);
|
||||||
trajectory.getRobotTrajectoryMsg(dt.trajectory[0]);
|
trajectory.getRobotTrajectoryMsg(dt.trajectory[0]);
|
||||||
dt.model_id= start.getRobotModel()->getName();
|
dt.model_id= start.getRobotModel()->getName();
|
||||||
|
|||||||
Loading…
Reference in New Issue
Block a user