直接向控制器发送轨迹位置，不经过plan接口

import rospy import actionlib from control_msgs.msg import FollowJointTrajectoryAction, FollowJointTrajectoryGoal from trajectory_msgs.msg import JointTrajectory, JointTrajectoryPoint class TrajectoryDemo(): def __init__(self): rospy.init_node('trajectory_demo') # 是否需要回到初始化的位置 reset = rospy.get_param('~reset', False) # 机械臂中joint的命名 arm_joints = ['joint1', 'joint2', 'joint3',