ubuntu16.04安装UR3/UR5/UR10机械臂的ROS驱动并实现gazebo下Moveit运动规划仿真以及真实UR3机械臂的运动控制(2)

最新推荐文章于 2024-07-06 19:03:08 发布

原创

最新推荐文章于 2024-07-06 19:03:08 发布 · 2k 阅读

21 ·

CC 4.0 BY-SA版权

文章标签：

#UR3机械臂运动规划 #Moveit运动规划

本篇博客继续上一节内容，讲解如何在Ubuntu16.04上为UR3机械臂安装ROS驱动，并在gazebo环境中使用Moveit进行运动规划仿真。通过编写python文件`ur3_moveit.py`并修改相关配置，实现了程序控制机械臂的运动。需要注意的是，目标点设置需确保与机械臂初始状态差异不大，以保证规划成功。

在上一节已经搭建了UR3机械臂的仿真环境，并且在rviz界面中通过拖拽机械臂实现了Moveit的运动规划。这一节就通过程序实现简单的UR3机械臂的运动规划。

首先，在 ur3工作空间中的 ~/ur_ws/src/universal_robot/ur_driver 目录下新建一个python文件，我这边命名为 ur3_moveit.py，并且编写如下代码，如下。

#!/usr/bin/env python

import sys
import time
import math
import rospy
import moveit_commander
from geometry_msgs.msg import Pose
from trajectory_msgs.msg import *



if __name__ == '__main__': 
    rospy.init_node('ur3_moveit')
    moveit_commander.roscpp_initialize(sys.argv)
    arm = moveit_commander.MoveGroupCommander('manipulator')
    
    goal = Pose()
    goal.position.x = 0.3
    goal.position.y = -0.1
    goal.position.z = 0.2
    while goal.position.y < 0.2:
        arm.set_pose_target(goal)
        arm.go(True)
        goal.position.y += 0.04
    moveit_commander.roscpp_shutdown()

注意，这边需要修改