四自由度码垛机器人工作空间合理程度的量化评价方法.pdf

摘要
申请专利号：	CN201410790302.3	申请日：	2014.12.17
公开号：	CN104462838A	公开日：	2015.03.25
当前法律状态：	授权	有效性：	有权
法律详情：	授权\|\|\|实质审查的生效IPC(主分类):G06F19/00申请日:20141217\|\|\|公开
IPC分类号：	G06F19/00(2011.01)I	主分类号：	G06F19/00
申请人：	合肥工业大学
发明人：	卢剑伟; 马树全; 燕培磊; 姜平; 谷先广; 吴勃夫; 胡金芳; 曹兴枫
地址：	230009安徽省合肥市包河区屯溪路193号
优先权：
专利代理机构：	安徽省合肥新安专利代理有限责任公司34101	代理人：	何梅生
PDF下载：	PDF下载

内容摘要

本发明公开了一种四自由度码垛机器人工作空间合理程度的量化评价方法，其特征是首先按D-H法分别建立待评价各四自由度码垛机器人的坐标系，在坐标系中通过四自由度码垛机器人的实际工作空间与矩形任务空间的对比确定其是否能够达到预期基本要求；利用四自由度码垛机器人实际工作空间的空间利用率H、左侧轮廓线斜率绝对值K以及形心偏移率e对四自由度码垛机器人的工作空间合理程度进行量化评价。本发明方法可以在设定的矩形任务空间的条件下直观、快速地判断给定的实际工作空间的合理程度，为四自由度码垛机器人的选型提供参考，对四自由度码垛机器人的结构设计有指导意义。

权利要求书

权利要求书
1.  四自由度码垛机器人工作空间合理程度的量化评价方法，其特征是按如下步骤进行：
按D-H法分别建立待评价各四自由度码垛机器人的坐标系；
取D-H坐标系下各四自由度码垛机器人在XOZ截面中的工作空间为对应四自由度码垛机器人的实际工作空间，所述实际工作空间是由六段弧线围成的处在XOZ截面中的封闭区域，所述六段弧线分别是第1段线、第2段线、第3段线、第4段线、第5段线和第6段线；所述第1段线为实际工作空间的上方轮廓线，第2段线为实际工作空间的右侧轮廓线，第3段线为实际工作空间的下方轮廓线，第4段线、第5段线和第6段线按自上而下依次联接构成实际工作空间的左侧轮廓线；
设定所述四自由度码垛机器人在所述XOZ截面中的任务空间为矩形任务空间，所述矩形任务空间中相邻的两侧边分别平行于Z轴和X轴；
针对设定的矩形任务空间，按如下步骤评价各四自由度码垛机器人的实际工作空间的合理程度：
步骤a、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，将各实际工作空间与所述矩形任务空间逐一进行比较，排除不能完全包含矩形任务空间的实际工作空间，对于能够完全包含矩形任务空间的实际工作空间按步骤b的方法进行比较；
步骤b、记矩形任务空间面积为sr、实际工作空间面积为sw，以实际工作空间的空间利用率H作为四自由度码垛机器人的实际工作空间合理程度的评价指标，所述实际工作空间的空间利用率H越大判断为四自由度码垛机器人的实际工作空间越为合理，

2.  根据权利要求1所述的四自由度码垛机器人工作空间合理程度的量化评价方法，其特征是：
若待评价各四自由度码垛机器人的实际工作空间的空间利用率H均相等，则按以下方式继续进行比较：
记实际工作空间中第4段线和第6段线的X轴方向最大值分别为maxX4、maxX6，所述最大值maxX4和maxX6所在位置对应点的Z轴值分别为Z4和Z6，以实际工作空间的左侧轮廓线斜率绝对值K作为四自由度码垛机器人的实际工作空间合理程度的第二评价指标，所述实际工作空间的左侧轮廓线斜率绝对值K越大，判断为四自由度码垛机器人的实际工作空间越为合理，K=|Z4-Z6maxX4-maxX6|.]]>

3.  根据权利要求2所述的四自由度码垛机器人工作空间合理程度的量化评价方法，其特征是：
若待评价各四自由度码垛机器人的实际工作空间的左侧轮廓线斜率绝对值K均相等，则按如下方式继续进行比较：
将所述矩形任务空间在XOZ截面中按照平行于X轴和Z轴的方向进行移动，使得实际工作空间与矩形任务空间的形心距离为形心距离最小值Dmin，以实际工作空间的形心偏移率e作为四自由度码垛机器人的实际工作空间合理程度的第三评价指标，所述实际工作空间的形心偏移率e越小，判断为四自由度码垛机器人的实际工作空间越为合理，
其中：l为矩形任务空间的宽度，h为矩形任务空间的高度。

说明书

说明书四自由度码垛机器人工作空间合理程度的量化评价方法
技术领域
本发明涉及一种具有四自由度码垛机器人的工作空间合理程度的量化评价方法。
背景技术
工作空间是码垛机器人的一项重要属性，反映了码垛机器人的工作范围。在对码垛机器人进行结构设计时，工程师通常首先根据用户提出的矩形任务空间对码垛机器人进行设计，使码垛机器人的工作空间可以完全包含要求的矩形任务空间。工作空间是否合理直接影响码垛机器人的整体性能和码垛机器人的生产、使用成本。
针对四自由度码垛机器人的工作空间的研究，李金泉等人编著的《码垛机器人机械结构与控制系统设计》中采用数值方法对TH50码垛机器人的工作空间进行了求解分析，并提出了机器人工作空间影响系数的概念。朱素霞的《IRB660型码垛机器人的运动学与动力学分析》中分析了IRB660机器人的结构参数对工作空间的影响并计算了相应的影响系数。张良安的《Layout analysis and path planning of a robot palletizing production line》从生产线布置方面对工作空间进行了分析。
上述关于四自由度码垛机器人工作空间的研究，都是围绕码垛机器人结构参数变化对其工作空间几何特征的影响进行分析。但是迄今为止，尚未见对四自由度码垛机器人工作空间合理程度进行量化分析评价的方法，因此，在以往针对该类型码垛机器人工作空间进行优化设计时只能进行定性的评价和优化，而无法对该类型码垛机器人的工作空间进行量化的优化设计。
发明内容
本发明是为了避免上述现有技术所存在的不足，提供一种四自由度码垛机器人工作空间合理程度的量化评价方法，对于给定的多个四自由度码垛机器人，针对用户提出的矩形任务空间，分析各码垛机器人的实际工作空间的几何特征判断各实际工作空间的合理程度。通过对各四自由度码垛机器人的实际工作空间与矩形任务空间进行对比分析，量化评价各实际工作空间的合理程度，为四自由度码垛机器人的选型和优化设计提供参考。
本发明解决技术问题采用如下技术方案：
本发明四自由度码垛机器人工作空间合理程度的量化评价方法的特点是按如下步骤进行：
按D-H法分别建立待评价各四自由度码垛机器人的坐标系；
取D-H坐标系下各四自由度码垛机器人在XOZ截面中的工作空间为对应四自由度码垛机器人的实际工作空间，所述实际工作空间是由六段弧线围成的处在XOZ截面中的封闭区域，所述六段弧线分别是第1段线、第2段线、第3段线、第4段线、第5段线和第6段线；所述第1段线为实际工作空间的上方轮廓线，第2段线为实际工作空间的右侧轮廓线，第3段线为实际工作空间的下方轮廓线，第4段线、第5段线和第6段线按自上而下依次联接构成实际工作空间的左侧轮廓线；
设定所述四自由度码垛机器人在所述XOZ截面中的任务空间为矩形任务空间，所述矩形任务空间中相邻的两侧边分别平行于Z轴和X轴；
针对设定的矩形任务空间，按如下步骤评价各四自由度码垛机器人的实际工作空间的合理程度：
步骤a、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，将各实际工作空间与所述矩形任务空间逐一进行比较，排除不能完全包含矩形任务空间的实际工作空间，对于能够完全包含矩形任务空间的实际工作空间按步骤b的方法进行比较；
步骤b、记矩形任务空间面积为sr、实际工作空间面积为sw，以实际工作空间的空间利用率H作为四自由度码垛机器人的实际工作空间合理程度的评价指标，所述实际工作空间的空间利用率H越大判断为四自由度码垛机器人的实际工作空间越为合理，
本发明四自由度码垛机器人工作空间合理程度的量化评价方法的特点也在于：
若待评价各四自由度码垛机器人的实际工作空间的空间利用率H均相等，则按以下方式继续进行比较：
记实际工作空间中第4段线和第6段线的X轴方向最大值分别为maxX4、maxX6，所述最大值maxX4和maxX6所在位置对应点的Z轴值分别为Z4和Z6，以实际工作空间的左侧轮廓线斜率绝对值K作为四自由度码垛机器人的实际工作空间合理程度的第二评价指标，所述实际工作空间的左侧轮廓线斜率绝对值K越大，判断为四自由度码垛机器人的实际工作空间越为合理，K=|Z4-Z6maxX4-maxX6|.]]>
本发明四自由度码垛机器人工作空间合理程度的量化评价方法的特点还在于：
若待评价各四自由度码垛机器人的实际工作空间的左侧轮廓线斜率绝对值K均相等，则按如下方式继续进行比较：
将所述矩形任务空间在XOZ截面中按照平行于X轴和Z轴的方向进行移动，使得实际工作空间与矩形任务空间的形心距离为形心距离最小值Dmin，以实际工作空间的形心偏移率e作为四自由度码垛机器人的实际工作空间合理程度的第三评价指标，所述实际工作空间的形心偏移率e越小，判断为四自由度码垛机器人的实际工作空间越为合理，
其中：l为矩形任务空间的宽度，h为矩形任务空间的高度。
与已有技术相比，本发明有益效果体现在：
1、本发明方法对算法要求较低，便于实现程序化。
2、本发明方法可以在设定的矩形任务空间的条件下直观、快速地判断给定的实际工作空间的合理程度，为四自由度码垛机器人的选型提供参考，对四自由度码垛机器人的结构设计有指导意义。
附图说明
图1为本发明中矩形任务空间边界轮廓线示意图；
图2A和图2B分别为本发明中实际工作空间1和实际工作空间2示意图；
图3A和图3B分别为本发明中以空间利用率判断不同的实际工作空间合理程度示意图；
图4A和图4B分别为本发明中实际工作空间3和实际工作空间4示意图；
图5A和图5B分别为本发明中以左侧轮廓线斜率绝对值判断不同实际工作空间合理程度示意图；
图6A和图6B分别为实际工作空间5和实际工作空间6示意图；
图7A和图7B分别为利用形心偏移率判断不同实际工作空间合理程度示意图；
具体实施方式
本发明中四自由度码垛机器人是指具有四个旋转关节的码垛机器人，四个旋转关节分别为绕垂直于水平面的轴线旋转的腰关节和腕关节、绕垂直于腰关节轴线的轴线旋转的肩关节和腕关节。
对于给定的多款同类型不同型号的码垛机器人，它们的对应杆件长度、关节旋转角度范围会有不同，导致不同型号码垛机器人的工作空间几何形状和尺寸不同。因此在针对用户指定的矩形任务空间时，不同型号码垛机器人的工作空间合理程度不同。
本实施例中四自由度码垛机器人工作空间合理程度的量化评价方法是按如下方式进行：
按D-H法分别建立待评价各四自由度码垛机器人的坐标系；具体为：坐标系原点O为四自由度码垛机器人腰关节、肩关节轴线的公垂线与腰关节轴线的交点，Z轴与腰关节轴线重合，方向竖直向上，X轴与腰关节、肩关节轴线的公垂线重合，从腰关节指向肩关节，Y轴按右手螺旋法则确定。
取D-H坐标系下各四自由度码垛机器人在XOZ截面中的工作空间为对应四自由度码垛机器人的实际工作空间，所述实际工作空间是由六段弧线围成的处在XOZ截面中的封闭区域，所述六段弧线分别是第1段线、第2段线、第3段线、第4段线、第5段线和第6段线；所述第1段线为实际工作空间的上方轮廓线，第2段线为实际工作空间的右侧轮廓线，第3段线为实际工作空间的下方轮廓线，第4段线、第5段线和第6段线按自上而下依次联接构成实际工作空间的左侧轮廓线。
设定所述四自由度码垛机器人在所述XOZ截面中的任务空间为矩形任务空间，所述矩形任务空间中相邻的两侧边分别平行于Z轴和X轴。
针对设定的矩形任务空间，按如下步骤评价各四自由度码垛机器人的实际工作空间的合理程度：
步骤a、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，将各实际工作空间与所述矩形任务空间逐一进行比较，排除不能完全包含矩形任务空间的实际工作空间，对于能够完全包含矩形任务空间的实际工作空间按步骤b的方法进行比较。
步骤b、记矩形任务空间面积为sr、实际工作空间面积为sw，以实际工作空间的空间利用率H作为四自由度码垛机器人的实际工作空间合理程度的评价指标，所述实际工作空间的空间利用率H越大判断为四自由度码垛机器人的实际工作空间越为合理，
步骤c、若待评价各四自由度码垛机器人的实际工作空间的空间利用率H均相等，则按以下方式继续进行比较：
记实际工作空间中第4段线和第6段线的X轴方向最大值分别为maxX4、maxX6，所述最大值maxX4和maxX6所在位置对应点的Z轴值分别为Z4和Z6，以实际工作空间的左侧轮廓线斜率绝对值K作为四自由度码垛机器人的实际工作空间合理程度的第二评价指标，所述实际工作空间的左侧轮廓线斜率绝对值K越大，判断为四自由度码垛机器人的实际工作空间越为合理，K=|Z4-Z6maxX4-maxX6|.]]>
步骤d、若待评价各四自由度码垛机器人的实际工作空间的左侧轮廓线斜率绝对值K均相等，则按如下方式继续进行比较：
将所述矩形任务空间在XOZ截面中按照平行于X轴和Z轴的方向进行移动，使得实际工作空间与矩形任务空间的形心距离为形心距离最小值Dmin，以实际工作空间的形心偏移率e作为四自由度码垛机器人的实际工作空间合理程度的第三评价指标，所述实际工作空间的形心偏移率e越小，判断为四自由度码垛机器人的实际工作空间越为合理，
其中：l为矩形任务空间的宽度，h为矩形任务空间的高度。
实施例1：
当用户提出一个如图1中l＝1250mm,h＝1500mm的矩形任务空间要求，分别按D-H法对给定两个型号的四自由度码垛机器人建立坐标系。取该两个四自由度码垛机器人在坐标系中XOZ截面的工作空间为对应四自由度码垛机器人的实际工作空间1(图2A所示)和实际工作空间2(图2B所示)，具体实施中，也可以是取为坐标系中的YOZ截面。评价方法按如下步骤进行：
步骤1、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，分别将矩形任务空间的四个顶点Ⅰ、Ⅱ、Ⅲ、Ⅳ的坐标值与实际工作空间1、实际工作空间2对应的轮廓线上的离散点坐标值进行比较，通过比较可知实际工作空间1和实际工作空间2可以完全包含矩形任务空间。
步骤2、计算得知实际工作空间1的空间利用率为H＝62％，实际工作空间2的空间利用率为H＝51％，如图3A和图3B所示；由此可知，针对用户提出该矩形任务空间，实际工作空间1比实际工作空间2的空间利用率大，判断为实际工作空间1比实际工作空间2更合理。
实施例2：
当用户提出一个如图1中l＝1250mm,h＝1500mm的矩形任务空间要求，分别按D-H法对给定两个型号的四自由度码垛机器人建立坐标系，取该两个四自由度码垛机器人在坐标系中XOZ截面的工作空间为对应四自由度码垛机器人的实际工作空间3(如图4A所示)和实际工作空间4(如图4B所示)；评价方法按如下步骤进行：
步骤1、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，分别将矩形任务空间的四个顶点Ⅰ、Ⅱ、Ⅲ、Ⅳ的坐标值与实际工作空间3、实际工作空间4对应的轮廓线上的离散点坐标值进行比较，通过比较可知实际工作空间3和实际工作空间4可以完全包含矩形任务空间。
步骤2、计算得知实际工作空间3和实际工作空间4的空间利用率相等，均为H＝51％，如图5A和图5B所示。
步骤3、计算实际工作空间3的左侧轮廓线斜率绝对值K＝116.9111，实际工作空间4的左侧轮廓线斜率绝对值K＝4.0676；由此可知，针对用户提出该矩形任务空间，实际工作空间3比实际工作空间4的左侧轮廓线斜率绝对值大，判断为实际工作空间3比实际工作空间4更加合理。
实施例3：
当用户提出一个如图1中l＝1250mm,h＝1500mm的矩形任务空间要求，分别按D-H法对给定两个型号的四自由度码垛机器人建立坐标系。取该两个四自由度码垛机器人在坐标系中XOZ截面的工作空间为对应四自由度码垛机器人的实际工作空间5和实际工作空间6，如图6A和图6B所示；评价方法按如下步骤进行：
步骤1、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，分别将矩形任务空间的四个顶点Ⅰ、Ⅱ、Ⅲ、Ⅳ的坐标值与实际工作空间5、实际工作空间6对应的轮廓线上的离散点坐标值进行比较，通过比较可知实际工作空间5和实际工作空间6可以完全包含矩形任务空间。
步骤2、计算得知实际工作空间5和实际工作空间6的空间利用率相等，均为H＝62％，如图7A和图7B所示。
步骤3、计算得知实际工作空间5和实际工作空间6的左侧轮廓线斜率绝对值相等，均为K＝116.9111。
步骤4、记各实际工作空间的形心为o1，矩形任务空间的形心为o2，在各实际工作空间中将矩形任务空间按照平行于X轴和Z轴的方向进行移动，使得各实际工作空间与矩形任务空间的形心距离最小，计算实际工作空间5的形心偏移率为e＝0.0220，计算实际工作空间6的形心偏移率e＝0.1500；由此可知，针对用户提出该矩形任务空间，实际工作空间5比实际工作空间6的形心偏移率大，判断为实际工作空间5比实际工作空间6更加合理。

资源描述

《四自由度码垛机器人工作空间合理程度的量化评价方法.pdf》由会员分享，可在线阅读，更多相关《四自由度码垛机器人工作空间合理程度的量化评价方法.pdf（12页珍藏版）》请在专利查询网上搜索。

1、(10)申请公布号 (43)申请公布日 (21)申请号 201410790302.3(22)申请日 2014.12.17G06F 19/00(2011.01)(71)申请人合肥工业大学地址 230009 安徽省合肥市包河区屯溪路193号(72)发明人卢剑伟马树全燕培磊姜平谷先广吴勃夫胡金芳曹兴枫(74)专利代理机构安徽省合肥新安专利代理有限责任公司 34101代理人何梅生(54) 发明名称四自由度码垛机器人工作空间合理程度的量化评价方法(57) 摘要本发明公开了一种四自由度码垛机器人工作空间合理程度的量化评价方法，其特征是首先按D-H法分别建立待评价各四自由度码垛机器人的坐标系，在。

2、坐标系中通过四自由度码垛机器人的实际工作空间与矩形任务空间的对比确定其是否能够达到预期基本要求；利用四自由度码垛机器人实际工作空间的空间利用率H、左侧轮廓线斜率绝对值K以及形心偏移率e对四自由度码垛机器人的工作空间合理程度进行量化评价。本发明方法可以在设定的矩形任务空间的条件下直观、快速地判断给定的实际工作空间的合理程度，为四自由度码垛机器人的选型提供参考，对四自由度码垛机器人的结构设计有指导意义。(51)Int.Cl.(19)中华人民共和国国家知识产权局(12)发明专利申请权利要求书2页说明书5页附图4页(10)申请公布号 CN 104462838 A(43)申请公布日 2015.03.。

3、25CN 104462838 A1/2页21.四自由度码垛机器人工作空间合理程度的量化评价方法，其特征是按如下步骤进行：按D-H法分别建立待评价各四自由度码垛机器人的坐标系；取D-H坐标系下各四自由度码垛机器人在XOZ截面中的工作空间为对应四自由度码垛机器人的实际工作空间，所述实际工作空间是由六段弧线围成的处在XOZ截面中的封闭区域，所述六段弧线分别是第1段线、第2段线、第3段线、第4段线、第5段线和第6段线；所述第1段线为实际工作空间的上方轮廓线，第2段线为实际工作空间的右侧轮廓线，第3段线为实际工作空间的下方轮廓线，第4段线、第5段线和第6段线按自上而下依次联接构成实际工作空间的左侧轮廓线。

4、；设定所述四自由度码垛机器人在所述XOZ截面中的任务空间为矩形任务空间，所述矩形任务空间中相邻的两侧边分别平行于Z轴和X轴；针对设定的矩形任务空间，按如下步骤评价各四自由度码垛机器人的实际工作空间的合理程度：步骤a、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，将各实际工作空间与所述矩形任务空间逐一进行比较，排除不能完全包含矩形任务空间的实际工作空间，对于能够完全包含矩形任务空间的实际工作空间按步骤b的方法进行比较；步骤b、记矩形任务空间面积为sr、实际工作空间面积为sw，以实际工作空间的空间利用率H作为四自由度码垛机器人的实际工作空间合理程度的评价指标，所述实际工作空间的空间利用。

5、率H越大判断为四自由度码垛机器人的实际工作空间越为合理，2.根据权利要求1所述的四自由度码垛机器人工作空间合理程度的量化评价方法，其特征是：若待评价各四自由度码垛机器人的实际工作空间的空间利用率H均相等，则按以下方式继续进行比较：记实际工作空间中第4段线和第6段线的X轴方向最大值分别为maxX4、maxX6，所述最大值maxX4和maxX6所在位置对应点的Z轴值分别为Z4和Z6，以实际工作空间的左侧轮廓线斜率绝对值K作为四自由度码垛机器人的实际工作空间合理程度的第二评价指标，所述实际工作空间的左侧轮廓线斜率绝对值K越大，判断为四自由度码垛机器人的实际工作空间越为合理，3.根据权利要求2所述的四。

6、自由度码垛机器人工作空间合理程度的量化评价方法，其特征是：若待评价各四自由度码垛机器人的实际工作空间的左侧轮廓线斜率绝对值K均相等，则按如下方式继续进行比较：将所述矩形任务空间在XOZ截面中按照平行于X轴和Z轴的方向进行移动，使得实际工作空间与矩形任务空间的形心距离为形心距离最小值Dmin，以实际工作空间的形心偏移率e作为四自由度码垛机器人的实际工作空间合理程度的第三评价指标，所述实际权利要求书CN 104462838 A2/2页3工作空间的形心偏移率e越小，判断为四自由度码垛机器人的实际工作空间越为合理，其中：l为矩形任务空间的宽度，h为矩形任务空间的高度。权利要求书CN 1。

7、04462838 A1/5页4四自由度码垛机器人工作空间合理程度的量化评价方法技术领域0001 本发明涉及一种具有四自由度码垛机器人的工作空间合理程度的量化评价方法。背景技术0002 工作空间是码垛机器人的一项重要属性，反映了码垛机器人的工作范围。在对码垛机器人进行结构设计时，工程师通常首先根据用户提出的矩形任务空间对码垛机器人进行设计，使码垛机器人的工作空间可以完全包含要求的矩形任务空间。工作空间是否合理直接影响码垛机器人的整体性能和码垛机器人的生产、使用成本。0003 针对四自由度码垛机器人的工作空间的研究，李金泉等人编著的码垛机器人机械结构与控制系统设计中采用数值方法对TH50码垛机器人。

8、的工作空间进行了求解分析，并提出了机器人工作空间影响系数的概念。朱素霞的IRB660型码垛机器人的运动学与动力学分析中分析了IRB660机器人的结构参数对工作空间的影响并计算了相应的影响系数。张良安的Layout analysis and path planning of a robot palletizing production line从生产线布置方面对工作空间进行了分析。0004 上述关于四自由度码垛机器人工作空间的研究，都是围绕码垛机器人结构参数变化对其工作空间几何特征的影响进行分析。但是迄今为止，尚未见对四自由度码垛机器人工作空间合理程度进行量化分析评价的方法，因此，在以往针对该类。

9、型码垛机器人工作空间进行优化设计时只能进行定性的评价和优化，而无法对该类型码垛机器人的工作空间进行量化的优化设计。发明内容0005 本发明是为了避免上述现有技术所存在的不足，提供一种四自由度码垛机器人工作空间合理程度的量化评价方法，对于给定的多个四自由度码垛机器人，针对用户提出的矩形任务空间，分析各码垛机器人的实际工作空间的几何特征判断各实际工作空间的合理程度。通过对各四自由度码垛机器人的实际工作空间与矩形任务空间进行对比分析，量化评价各实际工作空间的合理程度，为四自由度码垛机器人的选型和优化设计提供参考。0006 本发明解决技术问题采用如下技术方案：0007 本发明四自由度码垛机器人工作空间。

10、合理程度的量化评价方法的特点是按如下步骤进行：0008 按D-H法分别建立待评价各四自由度码垛机器人的坐标系；0009 取D-H坐标系下各四自由度码垛机器人在XOZ截面中的工作空间为对应四自由度码垛机器人的实际工作空间，所述实际工作空间是由六段弧线围成的处在XOZ截面中的封闭区域，所述六段弧线分别是第1段线、第2段线、第3段线、第4段线、第5段线和第6段线；所述第1段线为实际工作空间的上方轮廓线，第2段线为实际工作空间的右侧轮廓线，第3段线为实际工作空间的下方轮廓线，第4段线、第5段线和第6段线按自上而下依次联接构成实际工作空间的左侧轮廓线；说明书CN 104462838 A2/5页500。

11、10 设定所述四自由度码垛机器人在所述XOZ截面中的任务空间为矩形任务空间，所述矩形任务空间中相邻的两侧边分别平行于Z轴和X轴；0011 针对设定的矩形任务空间，按如下步骤评价各四自由度码垛机器人的实际工作空间的合理程度：0012 步骤a、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，将各实际工作空间与所述矩形任务空间逐一进行比较，排除不能完全包含矩形任务空间的实际工作空间，对于能够完全包含矩形任务空间的实际工作空间按步骤b的方法进行比较；0013 步骤b、记矩形任务空间面积为sr、实际工作空间面积为sw，以实际工作空间的空间利用率H作为四自由度码垛机器人的实际工作空间合理程度的评。

12、价指标，所述实际工作空间的空间利用率H越大判断为四自由度码垛机器人的实际工作空间越为合理，0014 本发明四自由度码垛机器人工作空间合理程度的量化评价方法的特点也在于：0015 若待评价各四自由度码垛机器人的实际工作空间的空间利用率H均相等，则按以下方式继续进行比较：0016 记实际工作空间中第4段线和第6段线的X轴方向最大值分别为maxX4、maxX6，所述最大值maxX4和maxX6所在位置对应点的Z轴值分别为Z4和Z6，以实际工作空间的左侧轮廓线斜率绝对值K作为四自由度码垛机器人的实际工作空间合理程度的第二评价指标，所述实际工作空间的左侧轮廓线斜率绝对值K越大，判断为四自由度码垛机器人的。

13、实际工作空间越为合理，0017 本发明四自由度码垛机器人工作空间合理程度的量化评价方法的特点还在于：0018 若待评价各四自由度码垛机器人的实际工作空间的左侧轮廓线斜率绝对值K均相等，则按如下方式继续进行比较：0019 将所述矩形任务空间在XOZ截面中按照平行于X轴和Z轴的方向进行移动，使得实际工作空间与矩形任务空间的形心距离为形心距离最小值Dmin，以实际工作空间的形心偏移率e作为四自由度码垛机器人的实际工作空间合理程度的第三评价指标，所述实际工作空间的形心偏移率e越小，判断为四自由度码垛机器人的实际工作空间越为合理，0020 其中：l为矩形任务空间的宽度，h为矩形任务空间的高度。0021 。

14、与已有技术相比，本发明有益效果体现在：0022 1、本发明方法对算法要求较低，便于实现程序化。0023 2、本发明方法可以在设定的矩形任务空间的条件下直观、快速地判断给定的实际工作空间的合理程度，为四自由度码垛机器人的选型提供参考，对四自由度码垛机器人的结构设计有指导意义。附图说明说明书CN 104462838 A3/5页60024 图1为本发明中矩形任务空间边界轮廓线示意图；0025 图2A和图2B分别为本发明中实际工作空间1和实际工作空间2示意图；0026 图3A和图3B分别为本发明中以空间利用率判断不同的实际工作空间合理程度示意图；0027 图4A和图4B分别为本发明中实际工作空间3。

15、和实际工作空间4示意图；0028 图5A和图5B分别为本发明中以左侧轮廓线斜率绝对值判断不同实际工作空间合理程度示意图；0029 图6A和图6B分别为实际工作空间5和实际工作空间6示意图；0030 图7A和图7B分别为利用形心偏移率判断不同实际工作空间合理程度示意图；具体实施方式0031 本发明中四自由度码垛机器人是指具有四个旋转关节的码垛机器人，四个旋转关节分别为绕垂直于水平面的轴线旋转的腰关节和腕关节、绕垂直于腰关节轴线的轴线旋转的肩关节和腕关节。0032 对于给定的多款同类型不同型号的码垛机器人，它们的对应杆件长度、关节旋转角度范围会有不同，导致不同型号码垛机器人的工作空间几何形状和尺寸。

16、不同。因此在针对用户指定的矩形任务空间时，不同型号码垛机器人的工作空间合理程度不同。0033 本实施例中四自由度码垛机器人工作空间合理程度的量化评价方法是按如下方式进行：0034 按D-H法分别建立待评价各四自由度码垛机器人的坐标系；具体为：坐标系原点O为四自由度码垛机器人腰关节、肩关节轴线的公垂线与腰关节轴线的交点，Z轴与腰关节轴线重合，方向竖直向上，X轴与腰关节、肩关节轴线的公垂线重合，从腰关节指向肩关节，Y轴按右手螺旋法则确定。0035 取D-H坐标系下各四自由度码垛机器人在XOZ截面中的工作空间为对应四自由度码垛机器人的实际工作空间，所述实际工作空间是由六段弧线围成的处在XOZ截面中的。

17、封闭区域，所述六段弧线分别是第1段线、第2段线、第3段线、第4段线、第5段线和第6段线；所述第1段线为实际工作空间的上方轮廓线，第2段线为实际工作空间的右侧轮廓线，第3段线为实际工作空间的下方轮廓线，第4段线、第5段线和第6段线按自上而下依次联接构成实际工作空间的左侧轮廓线。0036 设定所述四自由度码垛机器人在所述XOZ截面中的任务空间为矩形任务空间，所述矩形任务空间中相邻的两侧边分别平行于Z轴和X轴。0037 针对设定的矩形任务空间，按如下步骤评价各四自由度码垛机器人的实际工作空间的合理程度：0038 步骤a、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，将各实际工作空间与所述。

18、矩形任务空间逐一进行比较，排除不能完全包含矩形任务空间的实际工作空间，对于能够完全包含矩形任务空间的实际工作空间按步骤b的方法进行比较。0039 步骤b、记矩形任务空间面积为sr、实际工作空间面积为sw，以实际工作空间的空间利用率H作为四自由度码垛机器人的实际工作空间合理程度的评价指标，所述实际工作空间的空间利用率H越大判断为四自由度码垛机器人的实际工作空间越为合理，说明书CN 104462838 A4/5页70040 步骤c、若待评价各四自由度码垛机器人的实际工作空间的空间利用率H均相等，则按以下方式继续进行比较：0041 记实际工作空间中第4段线和第6段线的X轴方向最大值分别为maxX。

19、4、maxX6，所述最大值maxX4和maxX6所在位置对应点的Z轴值分别为Z4和Z6，以实际工作空间的左侧轮廓线斜率绝对值K作为四自由度码垛机器人的实际工作空间合理程度的第二评价指标，所述实际工作空间的左侧轮廓线斜率绝对值K越大，判断为四自由度码垛机器人的实际工作空间越为合理，0042 步骤d、若待评价各四自由度码垛机器人的实际工作空间的左侧轮廓线斜率绝对值K均相等，则按如下方式继续进行比较：0043 将所述矩形任务空间在XOZ截面中按照平行于X轴和Z轴的方向进行移动，使得实际工作空间与矩形任务空间的形心距离为形心距离最小值Dmin，以实际工作空间的形心偏移率e作为四自由度码垛机器人的实际工。

20、作空间合理程度的第三评价指标，所述实际工作空间的形心偏移率e越小，判断为四自由度码垛机器人的实际工作空间越为合理，0044 其中：l为矩形任务空间的宽度，h为矩形任务空间的高度。0045 实施例1：0046 当用户提出一个如图1中l1250mm,h1500mm的矩形任务空间要求，分别按D-H法对给定两个型号的四自由度码垛机器人建立坐标系。取该两个四自由度码垛机器人在坐标系中XOZ截面的工作空间为对应四自由度码垛机器人的实际工作空间1(图2A所示)和实际工作空间2(图2B所示)，具体实施中，也可以是取为坐标系中的YOZ截面。评价方法按如下步骤进行：0047 步骤1、在XOZ截面中按照平行于X轴和。

21、Z轴的方向移动矩形任务空间，分别将矩形任务空间的四个顶点、的坐标值与实际工作空间1、实际工作空间2对应的轮廓线上的离散点坐标值进行比较，通过比较可知实际工作空间1和实际工作空间2可以完全包含矩形任务空间。0048 步骤2、计算得知实际工作空间1的空间利用率为H62，实际工作空间2的空间利用率为H51，如图3A和图3B所示；由此可知，针对用户提出该矩形任务空间，实际工作空间1比实际工作空间2的空间利用率大，判断为实际工作空间1比实际工作空间2更合理。0049 实施例2：0050 当用户提出一个如图1中l1250mm,h1500mm的矩形任务空间要求，分别按D-H法对给定两个型号的四自由度码垛机器。

22、人建立坐标系，取该两个四自由度码垛机器人在坐标系中XOZ截面的工作空间为对应四自由度码垛机器人的实际工作空间3(如图4A所示)和实际工作空间4(如图4B所示)；评价方法按如下步骤进行：说明书CN 104462838 A5/5页80051 步骤1、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，分别将矩形任务空间的四个顶点、的坐标值与实际工作空间3、实际工作空间4对应的轮廓线上的离散点坐标值进行比较，通过比较可知实际工作空间3和实际工作空间4可以完全包含矩形任务空间。0052 步骤2、计算得知实际工作空间3和实际工作空间4的空间利用率相等，均为H51，如图5A和图5B所示。0053。

23、步骤3、计算实际工作空间3的左侧轮廓线斜率绝对值K116.9111，实际工作空间4的左侧轮廓线斜率绝对值K4.0676；由此可知，针对用户提出该矩形任务空间，实际工作空间3比实际工作空间4的左侧轮廓线斜率绝对值大，判断为实际工作空间3比实际工作空间4更加合理。0054 实施例3：0055 当用户提出一个如图1中l1250mm,h1500mm的矩形任务空间要求，分别按D-H法对给定两个型号的四自由度码垛机器人建立坐标系。取该两个四自由度码垛机器人在坐标系中XOZ截面的工作空间为对应四自由度码垛机器人的实际工作空间5和实际工作空间6，如图6A和图6B所示；评价方法按如下步骤进行：0056 步骤1。

24、、在XOZ截面中按照平行于X轴和Z轴的方向移动矩形任务空间，分别将矩形任务空间的四个顶点、的坐标值与实际工作空间5、实际工作空间6对应的轮廓线上的离散点坐标值进行比较，通过比较可知实际工作空间5和实际工作空间6可以完全包含矩形任务空间。0057 步骤2、计算得知实际工作空间5和实际工作空间6的空间利用率相等，均为H62，如图7A和图7B所示。0058 步骤3、计算得知实际工作空间5和实际工作空间6的左侧轮廓线斜率绝对值相等，均为K116.9111。0059 步骤4、记各实际工作空间的形心为o1，矩形任务空间的形心为o2，在各实际工作空间中将矩形任务空间按照平行于X轴和Z轴的方向进行移动，使得各实际工作空间与矩形任务空间的形心距离最小，计算实际工作空间5的形心偏移率为e0.0220，计算实际工作空间6的形心偏移率e0.1500；由此可知，针对用户提出该矩形任务空间，实际工作空间5比实际工作空间6的形心偏移率大，判断为实际工作空间5比实际工作空间6更加合理。说明书CN 104462838 A1/4页9图1图2A图2B图3A说明书附图CN 104462838 A2/4页10图3B图4A图4B图5A说明书附图CN 104462838 A10。

展开阅读全文