安装SolidWorks to URDF exporter插件
下载SolidWorks to URDF Exporter插件后按照网站上的步骤进行安装(目前该插件已经在Win 7 64位系统+Solidworks 2017上验证过。So far this add-in has been tested only on Windows 7 64bit with SolidWorks 2017 64bit. It currently does not install on 32bit machines. The add-in makes use of the most up-to-date SW API so I do not expect this tool to work with versions before SolidWorks 2012)。打开Solidworks 2016的插件对话框,可以看到SW2URDF插件已经加载并启动:
导出单个零件到URDF文件
在Solidworks中定义好零件的材质等参数后,在工具→File→Export as URDF中打开导出对话框:
可以打开“工具→评估→质量属性”对话框查看零件质量属性,URDF导出界面中的质量属性参数与Solidworks中的一致,当然也可以在导出时进行手动修改。还可以在Texture栏选择材质贴图文件(You can add a texture to the link by selecting the texture from your computer. This file will be copied into your URDF package),点击Finish后将会在指定的保存目录下生成包含URDF文件、网格文件、材质文件等的一个package.(Click finish to create the package. It will export the meshes, copy the textures and create a URDF that specifies the locations of these files.)
生成的URDF文件(Unified Robot Description Format,是一种特殊的xml 文件格式)如下:
![](https://i-blog.csdnimg.cn/blog_migrate/8f900a89c6347c561fdf2122f13be562.gif)
![](https://i-blog.csdnimg.cn/blog_migrate/961ddebeb323a10fe0623af514929fc1.gif)
<robot name="SarrusLink.SLDPRT"> <link name="SarrusLink"> <inertial> <origin xyz="-7.5253E-05 6.87439999999998E-20 -3.9011E-18" rpy="0 0 0" /> <mass value="1.9715" /> <inertia ixx="0.00294419345246927" ixy="-6.68772298538631E-19" ixz="-5.52225503571719E-19" iyy="0.0245212201140141" iyz="-3.65385697808336E-19" izz="0.0217833254619279" /> </inertial> <visual> <origin xyz="0 0 0" rpy="1.5707963267949 0 0" /> <geometry> <mesh filename="package://SarrusLink/meshes/SarrusLink.STL" /> </geometry> <material name=""> <color rgba="0.52941 0.54902 0.54902 1" /> <texture filename="package://SarrusLink/textures/timg.jpg" /> </material> </visual> <collision> <origin xyz="0 0 0" rpy="1.5707963267949 0 0" /> <geometry> <mesh filename="package://SarrusLink/meshes/SarrusLink.STL" /> </geometry> </collision> </link> </robot>
Solidworks中的零件被当做一个link,link可以指定许多属性:
- <inertial> 定义惯性参数(Kinematic and dynamic description of the robot)
- <visual> 定义外观,大小,颜色和材质纹理贴图(Visual representation of the robot)
- <collision> 定义碰撞检测属性(Collision model of the robot)
V-rep中导入URDF文件
在VREP机器人仿真软件中,可以用URDF import插件导入URDF文件:
选择导入零件的视觉部件(visual part),在Visual properties下的Texture/geometry properties中点击按钮,在弹出的对话框中选择材质贴图导入:
rviz中显示单个零件
将Solidworks中的单个零件导出成urdf文件后,为了在rviz中正确显示,可以使用static_transform_publisher发布base_link和固定坐标系map之间的静态变换,以确定零件的位置和姿态。或者可以自己写程序发布tf变换,实时更改零件的位姿。
在Solidworks中画一个简单的立方体零件,然后使用SW2URDF插件导出。在ROS工作空间中使用catkin_create_pkg创建一个新的slider包,并创建scripts文件夹用于存放Python程序。
scripts文件夹中的slider.py程序(参考joint_state_publisher):
![](https://i-blog.csdnimg.cn/blog_migrate/8f900a89c6347c561fdf2122f13be562.gif)
![](https://i-blog.csdnimg.cn/blog_migrate/961ddebeb323a10fe0623af514929fc1.gif)
#!/usr/bin/env python import rospy import tf import wx from math import pi from threading import Thread class Slider(wx.Frame): def __init__(self, parent, title): super(Slider, self).__init__(parent, title = title,size = (400,300)) self.InitUI() self.roll = 0.0 self.pitch = 0.0 self.yaw = 0.0 def InitUI(self): panel = wx.Panel(self) vbox = wx.BoxSizer(wx.VERTICAL) self.slider1 = wx.Slider(parent = panel,id = 1, value = 0, minValue = -900, maxValue = 900, style= wx.SL_AUTOTICKS | wx.SL_HORIZONTAL) self.slider2 = wx.Slider(parent = panel,id = 2, value = 0, minValue = -900, maxValue = 900, style= wx.SL_AUTOTICKS | wx.SL_HORIZONTAL) self.slider3 = wx.Slider(parent = panel,id = 3, value = 0, minValue = -900, maxValue = 900, style= wx.SL_AUTOTICKS | wx.SL_HORIZONTAL) self.button1 = wx.Button(panel, -1, "Center") vbox.Add(self.slider1,1,flag = wx.EXPAND | wx.ALIGN_CENTER_HORIZONTAL | wx.TOP, border = 20) vbox.Add(self.slider2,1,flag = wx.EXPAND | wx.ALIGN_CENTER_HORIZONTAL | wx.TOP, border = 20) vbox.Add(self.slider3,1,flag = wx.EXPAND | wx.ALIGN_CENTER_HORIZONTAL | wx.TOP, border = 20) vbox.Add(self.button1,1,flag = wx.EXPAND | wx.ALIGN_CENTER_HORIZONTAL | wx.TOP, border = 20) self.slider1.Bind(wx.EVT_SLIDER, self.OnSliderScroll) self.slider2.Bind(wx.EVT_SLIDER, self.OnSliderScroll) self.slider3.Bind(wx.EVT_SLIDER, self.OnSliderScroll) self.button1.Bind(wx.EVT_BUTTON, self.OnClick) panel.SetSizer(vbox) self.Centre() self.Show(True) def OnSliderScroll(self, event): obj = event.GetEventObject() val = obj.GetValue() * pi / 1800.0 id = event.GetId() if id == 1: self.roll = val elif id == 2: self.pitch = val elif id ==3 : self.yaw = val #print self.roll, self.pitch, self.yaw def OnClick(self, event): self.slider1.SetValue(0) self.slider2.SetValue(0) self.slider3.SetValue(0) self.roll = 0.0 self.pitch = 0.0 self.yaw = 0.0 def send_tf(): ex = wx.App() s = Slider(None,'Change Orientation') rospy.init_node('tf_broadcaster') br = tf.TransformBroadcaster() rate = rospy.Rate(10) # 10hz Thread(target=ex.MainLoop).start() while not rospy.is_shutdown(): br.sendTransform((0,0,0), \ tf.transformations.quaternion_from_euler(s.roll,s.pitch,s.yaw), \ rospy.Time.now(), \ "base_link", \ "map") rate.sleep() if __name__ == '__main__': try: send_tf() except rospy.ROSInterruptException: pass
part.urdf文件:
![](https://i-blog.csdnimg.cn/blog_migrate/8f900a89c6347c561fdf2122f13be562.gif)
![](https://i-blog.csdnimg.cn/blog_migrate/961ddebeb323a10fe0623af514929fc1.gif)
<robot name="part"> <link name="base_link"> <inertial> <origin xyz="0 0 -0.025" rpy="0 0 0" /> <mass value="0.125" /> <inertia ixx="5.20833333333333E-05" ixy="0" ixz="0" iyy="5.20833333333333E-05" iyz="0" izz="5.20833333333333E-05" /> </inertial> <visual> <origin xyz="0 0 -0.025" rpy="0 0 0" /> <geometry> <mesh filename="package://slider/meshes/part.STL" /> </geometry> <material name=""> <color rgba="0.45294 0.75294 0.35294 1" /> <texture filename="package://slider/textures/timg.jpg" /> </material> </visual> <collision> <origin xyz="0 0 0" rpy="0 0 0" /> <geometry> <mesh filename="package://slider/meshes/part.STL" /> </geometry> </collision> </link> </robot>
display.launch文件:
<launch>
<param name="robot_description" textfile="$(find slider)/urdf/part.urdf" />
<node name="slider" pkg="slider" type="slider.py" />
<node name="rviz" pkg="rviz" type="rviz" args="-d $(find slider)/part.rviz" required="true" />
</launch>
Python中创建GUI界面用到了wxPython库。由于GUI和ROS分别有自己的事件循环,为了不相互阻塞,可以在主线程中执行ROS循环,然后新开启一个线程执行GUI线程。代码中函数对象ex.MainLoop作为参数传给它的初始化函数,再调用Thread对象的start方法,线程启动后将执行ex.MainLoop函数。ROS程序以10Hz的频率发布base_link相对于map的变换关系,这里只改变其姿态(GUI界面上拖动滑块时可以改变RPY角)。
threading.Thread类的初始化函数原型:
def __init__(self, group=None, target=None, name=None, args=(), kwargs={})
- 参数group是预留的,用于将来扩展;
- 参数target是一个可调用对象,在线程启动后执行;
- 参数name是线程的名字。默认值为“Thread-N”,N是一个数字。
- 参数args和kwargs分别表示调用target时的参数列表和关键字参数。
使用catkin_make编译一下slider包,并注意环境变量的设置。没问题后输入下面命令打开rviz,同时通过GUI界面上的三个滑块调整物体姿态:
$ roslaunch slider display.launch
导出装配体到URDF文件
SW2URDF插件并没有智能到能自动识别Solidworks装配体中的约束,然后正确导出URDF文件,还需要我们自己在装配体中建立参考坐标系、参考轴以及指定轴的类型。如下图所示Joint axis的方向定义在Joint frame中,而Joint frame则相对于其父坐标系Parent frame定义:
下面我们以达芬奇手术机器人的一个臂为例子,将其Solidworks装配体导出成URDF文件并在rviz中显示。首先需要自己建立机器人的关节坐标系和关节参考轴,在装配体界面的参考几何体菜单中我们可以建立基准面、基准轴、坐标系、点等一系列参考几何体:
按照通常习惯我们以Z轴作为关节参考轴的方向,即如果是移动关节那么就沿着Z轴方向移动,如果是转动关节则按照右手定则绕Z轴转动。将参考坐标系frame0建立在第一个零件base_link上,frame1建立在link1上...那么整个运动链为:frame0/base_link→ joint1 →frame1/link1→ joint2 →frame2/link2→ joint3 →frame3/link3→ joint4 →frame4/link4
创建好参考坐标系和参考轴后打开SW2URDF插件,按顺序正确配置参数:
配置好运动链后点击Preview and Export按钮会弹出一个界面,现在需要配置关节的一些参数。需要注意的是Solidworks中建立的参考轴只有方向而没有正负,比如Axis=(0,0,1)则运动的正方向沿着Joint frame Z轴的正方,而如果是Axis=(0,0,-1)则运动的正方向沿着Joint frame Z轴的负方向,因此要注意正负号。
另外还需要注意如果选择prismatic或revolute这种非continuous类型的关节,需要在Limit中设定轴的运动范围,否则后面执行launch文件时会出错。下面就是没有设置关节运动范围的错误提示:
可以先看看生成的URDF文件中对关节1的描述,可以知道joint1是移动关节,父对象为base_link,子对象为link1。移动的正方向沿着joint1坐标系(frame1)的Z轴正方向,关节移动上限为5mm,下限为-415mm。origin标签中xyz表示frame1的原点在frame0中的位置,rpy表示frame1相对于frame0的姿态角。
<joint
name="joint1"
type="prismatic">
<origin
xyz="0.415 0 0.046285"
rpy="1.5708 9.2354E-16 1.5708" />
<parent
link="base_link" />
<child
link="link1" />
<axis
xyz="0 0 1" />
<limit
lower="-0.415"
upper="0.05"
effort="0"
velocity="0" />
</joint>
在Solidworks中测量可知frame1相对于frame0的位置为(0.415, 0, 0.04629),用RPY角表示的姿态为(90°, 0, 90°),可见与URDF文件的描述一致。
关节参数配置好后点击Next进入连杆配置界面,可以在里面设置连杆质量、惯性张量、颜色、材质等属性:
配置好后点击Finish,将生成的文件夹保存到指定的目录下。我们指定的文件夹名为test,里面有一些子文件夹:urdf中包含了机器人的urdf文件,textures里面放着材质贴图,meshes中放着模型的STL文件,launch文件夹中有display.launch文件可以在rviz中查看机器人。
自动生成的文件中还存在一些问题需要修改。package.xml文件中的email是不合法的,只要改成合法的email就可以了
<maintainer email="me2email.com" /> <!-- 可以改为:me@email.com -->
另外display.launch文件里中gui参数要设为True,否则无法打开Joint State Publish工具
<arg name="gui" default="False" /> <!-- 将False改为True -->
还有查找urdf文件时要将路径中的robots改为urdf,或者直接将urdf文件夹重命名为robots
<param name="robot_description" textfile="$(find test)/robots/test.urdf" /> <!-- robots改为urdf -->
改完后将test文件夹移动到ROS工作目录下的源代码目录中(比如catkin_ws/src下),然后使用catkin工具编译一下。下面执行roslaunch test display.launch,在rviz中添加RobotModel,并将Fixed Frame设为base_link,此时机器人就能正确显示出来。这里需要注意Solidworks中建立的frame0坐标系的朝向会影响机器人在rviz中的初始姿态。另外,如果还想观察关节运动时坐标系的变化,可以点击Add按钮添加TF。
拖动Joint State Publisher界面上的滑块可以改变对应关节的位置,最左边是之前设定的lower limit,最右边是upper limit.
参考:
http://wiki.ros.org/sw_urdf_exporter
http://wiki.ros.org/sw_urdf_exporter/Tutorials