10轨迹规划仿真————用moveit的c++API控制UR10机械臂做gazebo圆弧轨迹规划的物理仿真

1.编写c++API代码

//实现关节空间轨迹规划
#include<moveit/move_group_interface/move_group_interface.h>
#include <moveit/planning_scene_interface/planning_scene_interface.h>
#include <moveit_msgs/DisplayRobotState.h>
#include <moveit_msgs/DisplayTrajectory.h>
#include <moveit_msgs/AttachedCollisionObject.h>
#include <moveit_msgs/CollisionObject.h>
#include <vector>
 
int main(int argc, char **argv)
{
   
    //初始化，其中ur_test02为节点名
    ros::init(argc, argv, "ur_test01");
    //多线程
    ros::AsyncSpinner spinner(1);
    //开启新的线程
    spinner.start(); 
    //初始化需要使用move group控制的机械臂中的arm group
    moveit::planning_interface::MoveGroupInterface arm("manipulator");    
    //允许误差
    arm.setGoalJointTolerance(0.001);
    //允许的最大速度和加速度
    arm.setMaxAccelerationScalingFactor(0.2);
    arm.setMaxVelocityScalingFactor(0.2);
 
    // 控制机械臂先回到水平位置，这个位置下载的文件中已经设置好了
    arm.</