CN107186753B - 工业机器人性能测试的工作空间确定方法 - Google Patents
工业机器人性能测试的工作空间确定方法 Download PDFInfo
- Publication number
- CN107186753B CN107186753B CN201710347553.8A CN201710347553A CN107186753B CN 107186753 B CN107186753 B CN 107186753B CN 201710347553 A CN201710347553 A CN 201710347553A CN 107186753 B CN107186753 B CN 107186753B
- Authority
- CN
- China
- Prior art keywords
- connecting rod
- arc
- robot
- joint
- working space
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000011056 performance test Methods 0.000 title claims abstract description 14
- 238000010586 diagram Methods 0.000 claims abstract description 13
- 238000004364 calculation method Methods 0.000 claims abstract description 11
- 238000012360 testing method Methods 0.000 claims abstract description 5
- 238000009795 derivation Methods 0.000 abstract description 2
- 238000010998 test method Methods 0.000 description 2
- 101100234547 Caenorhabditis elegans rod-1 gene Proteins 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Operations Research (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种工业机器人性能测试的工作空间确定方法,属于工业机器人性能测试领域,包括如下步骤:在六连杆机器人的各连杆上分别固接一个坐标系,确定机器人的连杆几何参数及各关节运动范围;获取机器人连杆4末端的运动空间剖面图;将连杆4末端的运动空间剖面图沿着机器人基坐标系轴线偏移设定的距离,获得机器人工作空间剖面图,由此确定机器人的工作空间。本发明创新性的提出通过理论推导结合数学计算来确定机器人的工作空间的方法,该方法操作过程不需要手动示教机器人,简单方便,适用范围广,有效提高了机器人性能测试效率和准确度,从而使机器人的应用更为广泛。
Description
技术领域
本发明属于工业机器人技术领域,尤其涉及一种工业机器人性能测试的工作空间确定方法。
背景技术
工业机器人是高端智能装备的代表,被喻为“制造业皇冠顶端的明珠”。根据国家相关法规规定,工业机器人在出厂前或者长时间使用后需要对其进行性能方面的测试,《GB/T 12642-2013工业机器人性能规范及其试验方法》对工业机器人的各项性能指标及试验方法进行了明确详细的阐述,其中,机器人工作空间的确定是测试多项重要性能指标的必要条件。
目前,关于机器人工作空间的确定尚无通用化、***化、实用化的方法。传统的方法一般采用机器人示教的方法,该方法需要专业人员对机器人进行手动调试,需尝试将机器人运动至极限位置,存在潜在的危险;同时,操作过程繁琐,耗费时间长,还难以保证该工作空间的准确性,影响机器人性能测试结果的有效性。
发明内容
本发明要解决的技术问题是提供一种工业机器人性能测试的,方便、快捷、准确的工作空间确定方法。
为了解决上述技术问题,本发明的技术方案是提供一种工业机器人性能测试的工作空间确定方法,机器人由连杆零、连杆一、连杆二、连杆三、连杆四、连杆五、连杆六依次串联而成,连杆零与连杆一通过关节一连接,连杆一与连杆二通过关节二连接,连杆二与连杆三通过关节三连接,连杆三与连杆四通过关节四连接,连杆四与连杆五通过关节五连接,连杆五与连杆六通过关节六连接,其特征在于:该方法由以下三个步骤组成:
步骤一:在所述连杆零、连杆一、连杆二、连杆三、连杆四、连杆五、连杆六上各固接一个坐标系,分别为O0-X0-Y0-Z0、O1-X1-Y1-Z1、O2-X2-Y2-Z2、O3-X3-Y3-Z3、O4-X4-Y4-Z4、O5-X5-Y5-Z5,O6-X6-Y6-Z6,确定连杆一坐标系原点在机器人基坐标系下的位置信息、各连杆几何参数及各关节的运动范围;
步骤二:根据各关节的运动范围,构造出连杆四末端的四个圆弧——圆弧一、圆弧二、圆弧三、圆弧四的轨迹方程,机器人连杆四末端的运动空间剖面图由圆弧一、圆弧二、圆弧三、圆弧四首尾连接而成;
步骤三:将所述连杆四末端的运动空间剖面图偏移设定的距离,获得机器人工作空间剖面图,由此确定机器人的工作空间。
优选地,所述步骤一中,各连杆几何参数包括:连杆一坐标系原点在机器人基坐标系下的位置矢量连杆一坐标系原点与连杆二坐标系原点之间的距离连杆二坐标系原点与连杆四坐标系原点之间的距离连杆五坐标系原点与机器人末端之间的距离
优选地,所述步骤二中,圆弧一的轨迹生成及计算方法为:
B、锁定其他关节,单独操纵关节二运动,获得连杆四末端的圆弧一运动轨迹,圆弧一半径记作r1;
优选地,所述步骤二中,圆弧二的轨迹生成及计算方法为:
A、操纵机器人运动至延伸位置奇点;
B、锁定其它关节,单独操纵关节二运动,获得连杆四末端的圆弧二运动轨迹,圆弧二半径记作r2,则r2=l2+l3;
优选地,所述步骤二中,圆弧三的轨迹生成及计算方法为:
A、操纵机器人关节二,将其运动至转角上限位置;
B、锁定其它关节,单独操纵关节三运动,获得连杆四末端的圆弧三运动轨迹;
优选地,所述步骤二中,圆弧四的轨迹生成及计算方法为:
A、操纵机器人关节二,将其运动至转角下限位置;
B、锁定其它关节,单独操纵关节三运动,获得连杆四末端的圆弧四运动轨迹;
优选地,所述步骤三中,机器人工作空间的求取原理为:对于六关节串联式工业机器人,前三个关节决定了机器人末端的位置,而后三个关节决定了机器人末端的姿态;因此,机器人连杆四末端的位置和机器人末端的位置具有一致性,仅需将连杆四末端的运动空间剖面图沿着矢量偏移,便可得到机器人的工作空间剖面图。
优选地,所述步骤三中,将圆弧一运动轨迹沿着矢量偏移得到圆弧五轨迹,将圆弧二运动轨迹沿着矢量偏移得到圆弧六轨迹,将圆弧三运动轨迹沿着矢量偏移得到圆弧七轨迹,将圆弧四运动轨迹沿着矢量偏移得到圆弧八轨迹,机器人的工作空间剖面图由圆弧五、圆弧六、圆弧七、圆弧八首尾连接而成。
本发明创新性的提出了通过理论推导结合数学计算来确定机器人工作空间的方法,该方法操作过程不需要手动示教机器人,简单方便,适用范围广,有效提高了机器人性能测试效率和准确度,从而使机器人的应用更为广泛。
附图说明
图1为工业机器人及连杆坐标系示意图;
图2为工业机器人连杆四末端的运动空间剖面图;
图3为工业机器人工作空间剖面图;
图中,sp表示延伸位置奇点。
具体实施方式
下面结合具体实施例,进一步阐述本发明。应理解,这些实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解,在阅读了本发明讲授的内容之后,本领域技术人员可以对本发明作各种改动或修改,这些等价形式同样落于本申请所附权利要求书所限定的范围。
典型的六关节串联式工业机器人如图1所示,由连杆零0、连杆一1、连杆二2、连杆三3、连杆四4、连杆五5依次串联而成,图1中,0~5分别表示连杆零~连杆五。连杆零与连杆一通过关节一连接,连杆一与连杆二通过关节二连接,连杆二与连杆三通过关节三连接,连杆三与连杆四通过关节四连接,连杆四与连杆五通过关节五连接,机器人末端即连杆五5末端设有关节六。
本发明的工业机器人性能测试的工作空间确定方法,步骤如下:
步骤一:在机器人的依次串联的连杆零、连杆一、连杆二、连杆三、连杆四、连杆五上各固接一个坐标系,分别为O0-X0-Y0-Z0、O1-X1-Y1-Z1、O2-X2-Y2-Z2、O3-X3-Y3-Z3、O4-X4-Y4-Z4、O5-X5-Y5-Z5,在机器人末端固接一个坐标系O6-X6-Y6-Z6,确定连杆一1坐标系原点在机器人基坐标系下的位置信息、各连杆几何参数及各关节的运动范围。
各连杆几何参数包括:连杆一1坐标系原点在机器人基坐标系下的位置矢量连杆一1坐标系原点与连杆二2坐标系原点之间的距离l1=O1O2,连杆二2坐标系原点与连杆四4坐标系原点之间的距离l2=O2O4,连杆五5坐标系原点与机器人末端之间的距离l3=O5O6。
步骤二:根据各关节运动范围,构造出连杆四4末端的四个圆弧轨迹方程,确定机器人连杆四4末端的运动空间剖面图。
如图2、图3所示,圆弧一21的轨迹生成及计算方法:
2.锁定其他关节,单独操纵关节二运动,获得连杆四4末端的圆弧一21运动轨迹。圆弧一21半径记作r1。
圆弧二22的轨迹生成及计算方法:
1.操纵机器人运动至延伸位置奇点。
2.锁定其它关节,单独操纵关节二运动,获得连杆四4末端的圆弧二22运动轨迹。圆弧二22半径记作r2,其中r2=l2+l3。
圆弧三23的轨迹生成及计算方法:
1.操纵机器人关节二,将其运动至转角上限位置。
2.锁定其它关节,单独操纵关节三运动,获得连杆四4末端的圆弧三23运动轨迹。
圆弧四24的轨迹生成及计算方法:
1.操纵机器人关节二,将其运动至转角下限位置。
2.锁定其它关节,单独操纵关节三运动,获得连杆四4末端的圆弧四24运动轨迹。
机器人连杆四4末端的运动空间剖面图由圆弧一21、圆弧二22、圆弧三23、圆弧四24首尾连接而成。
步骤三:将所述连杆四4末端的运动空间剖面图沿着机器人基坐标系轴线偏移一段设定的距离,获得机器人工作空间剖面图。
机器人工作空间的求取原理为:对于六关节串联式工业机器人,其前三个关节决定了机器人末端的位置,而后三个关节决定了机器人末端的姿态。因此,机器人连杆四4末端的位置和机器人末端的位置具有一致性,仅需将连杆4末端的运动空间剖面图沿着矢量偏移,便可得到机器人的工作空间剖面图。
Claims (7)
1.一种工业机器人性能测试的工作空间确定方法,机器人由连杆零、连杆一、连杆二、连杆三、连杆四、连杆五依次串联而成,连杆零与连杆一通过关节一连接,连杆一与连杆二通过关节二连接,连杆二与连杆三通过关节三连接,连杆三与连杆四通过关节四连接,连杆四与连杆五通过关节五连接,机器人末端设有关节六,其特征在于:该方法由以下三个步骤组成:
步骤一:在所述连杆零、连杆一、连杆二、连杆三、连杆四、连杆五上各固接一个坐标系,分别为O0-X0-Y0-Z0、O1-X1-Y1-Z1、O2-X2-Y2-Z2、O3-X3-Y3-Z3、O4-X4-Y4-Z4、O5-X5-Y5-Z5,在所述机器人末端固接一个坐标系O6-X6-Y6-Z6,确定连杆一坐标系原点在机器人基坐标系下的位置矢量连杆一坐标系原点与连杆二坐标系原点之间的距离l1=O1O2,连杆二坐标系原点与连杆四坐标系原点之间的距离l2=O2O4,连杆五坐标系原点与机器人末端之间的距离l3=O5O6。
步骤二:根据各关节的运动范围,构造出连杆四末端的四个圆弧——圆弧一的轨迹方程为圆弧二的轨迹方程为圆弧三的轨迹方程为圆弧四的轨迹方程为机器人连杆四末端的运动空间剖面图由圆弧一、圆弧二、圆弧三、圆弧四首尾连接而成,其中,θ2为关节二的转角,为关节三的转角上限,为关节二的转角下限,θ3为关节三的转角,为关节二的转角上限;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710347553.8A CN107186753B (zh) | 2017-05-17 | 2017-05-17 | 工业机器人性能测试的工作空间确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710347553.8A CN107186753B (zh) | 2017-05-17 | 2017-05-17 | 工业机器人性能测试的工作空间确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107186753A CN107186753A (zh) | 2017-09-22 |
CN107186753B true CN107186753B (zh) | 2020-10-09 |
Family
ID=59872983
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710347553.8A Active CN107186753B (zh) | 2017-05-17 | 2017-05-17 | 工业机器人性能测试的工作空间确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107186753B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107972070B (zh) * | 2017-11-29 | 2021-03-30 | 上海新时达机器人有限公司 | 机器人性能的测试方法、测试***及计算机可读存储介质 |
CN108032334B (zh) * | 2017-11-29 | 2021-01-05 | 东华大学 | 六轴工业机器人防护服“弯-弯”关节运动补偿设计方法 |
CN112338918B (zh) * | 2020-10-29 | 2022-05-27 | 珠海格力智能装备有限公司 | 六轴机器人工作范围的确定方法及装置 |
CN112428266B (zh) * | 2020-11-09 | 2022-06-10 | 珠海格力智能装备有限公司 | 机器人工作空间的优化方法 |
CN112356071A (zh) * | 2020-11-11 | 2021-02-12 | 上海机器人产业技术研究院有限公司 | 一种工业机器人的自动化性能测试方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007094451A1 (ja) * | 2006-02-16 | 2007-08-23 | Japan Science And Technology Agency | 運動解析方法、運動解析装置、コンピュータプログラム、及び記録媒体 |
CN101751008A (zh) * | 2008-12-18 | 2010-06-23 | 陈学恭 | 一种插补方法 |
CN102096062A (zh) * | 2009-12-09 | 2011-06-15 | 天宝导航有限公司 | 用于确定工作空间中的位置的*** |
CN102152308A (zh) * | 2010-02-10 | 2011-08-17 | 库卡实验仪器有限公司 | 用于工业机器人的无碰撞轨迹规划的方法 |
CN105415372A (zh) * | 2015-12-09 | 2016-03-23 | 常州汉迪机器人科技有限公司 | 一种安全空间约束下的多关节机器人轨迹规划方法 |
-
2017
- 2017-05-17 CN CN201710347553.8A patent/CN107186753B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007094451A1 (ja) * | 2006-02-16 | 2007-08-23 | Japan Science And Technology Agency | 運動解析方法、運動解析装置、コンピュータプログラム、及び記録媒体 |
CN101751008A (zh) * | 2008-12-18 | 2010-06-23 | 陈学恭 | 一种插补方法 |
CN102096062A (zh) * | 2009-12-09 | 2011-06-15 | 天宝导航有限公司 | 用于确定工作空间中的位置的*** |
CN102152308A (zh) * | 2010-02-10 | 2011-08-17 | 库卡实验仪器有限公司 | 用于工业机器人的无碰撞轨迹规划的方法 |
CN105415372A (zh) * | 2015-12-09 | 2016-03-23 | 常州汉迪机器人科技有限公司 | 一种安全空间约束下的多关节机器人轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107186753A (zh) | 2017-09-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107186753B (zh) | 工业机器人性能测试的工作空间确定方法 | |
CN110815180B (zh) | 六自由度并联机器人运动分析建模及快速求解方法 | |
CN105382835A (zh) | 一种可穿越腕部奇异点的机器人路径规划方法 | |
CN110757454B (zh) | 一种双机器人协同旋转的路径规划方法和装置 | |
CN107443382A (zh) | 工业机器人结构参数误差辨识与补偿方法 | |
CN113001535B (zh) | 机器人工件坐标系自动校正***与方法 | |
CN102566577B (zh) | 一种工业机器人简易标定方法 | |
CN106064379B (zh) | 一种机器人自动计算实际臂长的方法 | |
CN104827479A (zh) | 一种面向激光加工机器人的管道插接相贯线轨迹规划方法 | |
CN103692433B (zh) | 可模型解耦的三臂杆五自由度平移焊接机器人及其解耦方法 | |
CN107116542B (zh) | 一种六关节工业机器人通过姿态奇点的控制方法及*** | |
CN106338990A (zh) | 基于激光跟踪仪的工业机器人dh参数标定与零位标定方法 | |
CN112025772B (zh) | 一种基于视觉测量的机械臂自主标定方法 | |
CN103481288B (zh) | 一种5关节机器人末端工具位姿控制方法 | |
CN107791248B (zh) | 基于不满足Pieper准则的六自由度串联机器人的控制方法 | |
CN106844951B (zh) | 基于分段几何法求解超冗余机器人逆运动学的方法及*** | |
CN104890013A (zh) | 一种基于拉线编码器的工业机器人标定算法 | |
CN105522577B (zh) | 一种用于五轴折弯机器人笛卡尔轨迹规划的方法及其装置 | |
CN102554407B (zh) | 机器人焊接v型工件焊接起点的控制方法 | |
CN110722562B (zh) | 一种用于机器人参数辨识的空间雅克比矩阵构造方法 | |
Melo et al. | Modular snake robot gaits on horizontal pipes | |
CN111844005A (zh) | 一种应用于隧道湿喷的2r-p-2r-p-2r机械臂运动规划方法 | |
CN104385283A (zh) | 一种六自由度机械臂奇异位形的快速判断方法 | |
CN106272429A (zh) | 一种龙门式吊装机器人工作单元中附加轴运动规划方法 | |
CN103529856B (zh) | 5旋转关节机器人末端工具位姿控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |