CN113370213A - 一种机器人末端执行器的姿态计算方法 - Google Patents
一种机器人末端执行器的姿态计算方法 Download PDFInfo
- Publication number
- CN113370213A CN113370213A CN202110714595.7A CN202110714595A CN113370213A CN 113370213 A CN113370213 A CN 113370213A CN 202110714595 A CN202110714595 A CN 202110714595A CN 113370213 A CN113370213 A CN 113370213A
- Authority
- CN
- China
- Prior art keywords
- end effector
- axis
- tcp
- robot
- calculation method
- 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.)
- Pending
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
Abstract
Description
技术领域
本发明涉及控制方法领域,特别涉及一种机器人末端执行器的姿态计算方法。
背景技术
随着工业机器人技术的发展,机器人自动制孔系统在飞机零部件自动化装配领域的应用已经越来越广泛。由于飞机零部件产品大多曲率较大,且形状不规则,为避免末端执行器与产品出现碰撞干涉的情况,机器人制孔系统在加工某些点位时,末端执行器需要按照某种特定姿态进行加工,但在仅给定制孔法向的情况下,末端执行器的加工姿态并不能完全确定。因此,本文提出了一种工业机器人末端执行器加工姿态的初步控制算法,控制末端执行器制孔加工时的大致朝向,优化机器人加工姿态,同时降低出现干涉碰撞情况的风险。
发明内容
本发明的目的在于:提供了一种机器人末端执行器的姿态计算方法,可以粗略地、初步地计算末端执行器的朝向和姿态,便于优化实际的机器人加工姿态,降低出现干涉碰撞情况的风险,解决了上述问题。
本发明采用的技术方案如下:
一种机器人末端执行器的姿态计算方法,包括以下步骤:
步骤S1:在当前参考坐标系中,根据加工点位P(x0,y0,z0)的法向确定末端执行器TCP的主要控制轴在法向轴的单位向量;
为了更好地实现本方案,进一步地,所述步骤S2中确定末端执行器TCP主要控制轴的单位向量的方法具体为:末端执行器TCP的主要控制轴为末端执行器TCP当前需要姿态的主要控制轴,计算末端执行器TCP姿态主要控制轴的单位向量根据当前参考坐标系与末端执行器TCP间的位姿关系。
为了更好地实现本方案,进一步地,所述步骤S4中的旋转矩阵R具体为
其中,α、β、γ为姿态角。
为了更好地实现本方案,进一步地,所述测量点的姿态角的余弦cosβ不等于0。
为了更好地实现本方案,进一步地,所述步骤S4中加工点位P的旋转矩阵R的表达式为:其中nx、ny、nz分别是向量的x、y、z轴坐标,ox、oy、oz分别是向量的x、y、z轴坐标,ax、ay、az分别是向量的x、y、z轴坐标。
本方案所述的机器人自动制孔系统为某型飞机部件自动制孔系统,主要由工业机器人、AGV、末端执行器TCP、保型工装及产品样件构成,根据该自动制孔系统的现场布局,可以在软件上搭建机器人自动制孔系统仿真平台。而由于加工产品曲率较大,为便于加工,提升机器人制孔系统的灵活度,系统将末端执行器TCP的主轴进给方向设计为与机器人法向轴线方向垂直。在末端执行器TCP以不同的姿态对同一孔位进行加工时,机器人的加工姿态也会随之变化。因此在机器人编程时,特别是离线编程时,对于特定的点位,控制末端执行器TCP的加工姿态,能优化机器人的加工姿态,进而提升制孔效果。
本方案中,首先第一步需要确定末端执行器TCP的主要控制轴在法向轴的单位向量。由于将末端执行器TCP的主轴进给方向设计为与机器人法向轴线方向垂直,故而末端执行器TCP的Z轴和法线方向重合,即末端执行器TCP在z轴的单位向量的坐标和末端执行器TCP法向轴的单位向量的坐标相同。由此我们可以确定末端执行器TCP在z轴的单位向量的坐标(ax,ay,az)。
第二步我们会确定末端执行器TCP的主要控制轴在x轴的单位向量的坐标。一般来说,在加工点时末端执行器TCP近似水平,即末端执行器TCP的x轴与参考坐标系的XOY平面尽可能平行,而又因为TCP旋转矩阵R的三个法向向量两两正交,则满足且满足我们令ny=ax,nz=0,则得到nx=-ay,再对进行单位化,得到向量的坐标(nx,ny,nz)为
第三步我们计算末端执行器TCP在y轴的单位向量将向量的坐标(nx,ny,nz)和向量的坐标(ax,ay,az)的关系代入到中,得到我们再令ox=ax·az,得到oy=ay·az,oz=-(ax2+ay2),再对进行单位化,得到的坐标为:
综上所述,由于采用了上述技术方案,本发明的有益效果是:
1.本发明所述的一种机器人末端执行器的姿态计算方法,可以粗略地计算末端执行器的朝向和姿态,便于优化实际的机器人加工姿态;
2.本发明所述的一种机器人末端执行器的姿态计算方法,可以粗略地计算末端执行器的朝向和姿态,便于优化实际的机器人加工姿态,降低出现干涉碰撞情况的风险。
附图说明
为了更清楚地说明本技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图,其中:
图1是本发明的流程框图;
图2是本发明所述的一种机器人自动制孔系统布局图;
图3是本发明所述的机器人自动制孔系统各坐标系相关关系图。
具体实施方式
为了更清楚地说明本发明实施例的技术方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,应当理解,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例,因此不应被看作是对保护范围的限定。基于本发明中的实施例,本领域普通技术工作人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“设置”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;也可以是直接相连,也可以是通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
下面结合图1至图3对本发明作详细说明。
实施例1:
一种机器人末端执行器的姿态计算方法,如图1,包括以下步骤:
步骤S1:在当前参考坐标系中,根据加工点位P(x0,y0,z0)的法向确定末端执行器TCP的主要控制轴在法向轴的单位向量;
工作原理:本方案所述的机器人自动制孔系统为如图2所示的某型飞机部件自动制孔系统,主要由工业机器人、AGV、末端执行器TCP、保型工装及产品样件构成,根据该自动制孔系统的现场布局,可以在软件上搭建机器人自动制孔系统仿真平台。而由于加工产品曲率较大,为便于加工,提升机器人制孔系统的灵活度,系统将末端执行器TCP的主轴进给方向设计为与机器人法向轴线方向垂直。在末端执行器TCP以不同的姿态对同一孔位进行加工时,机器人的加工姿态也会随之变化。因此在机器人编程时,特别是离线编程时,对于特定的点位,控制末端执行器TCP的加工姿态,能优化机器人的加工姿态,进而提升制孔效果。
实施例2:
步骤S1:在当前参考坐标系中,根据加工点位P(x0,y0,z0)的法向确定末端执行器TCP的主要控制轴在法向轴的单位向量;
步骤S2:确定末端执行器TCP的主要控制轴在x轴的单位向量和在z轴的单位向量其中,末端执行器TCP在z轴的单位向量的坐标和末端执行器TCP法向轴的单位向量的坐标相同。然后求解主要控制轴在x轴的单位向量的方法具体为:末端执行器TCP的主要控制轴为末端执行器TCP当前需要姿态的主要控制轴,计算末端执行器TCP姿态主要控制轴的单位向量根据当前参考坐标系与末端执行器TCP间的位姿关系。求末端执行器TCP在y轴的单位向量时,将末端执行器TCP的x轴对应的向量满足
其中,所述测量点的姿态角的余弦cosβ不等于0。
工作原理:本方案所述的机器人自动制孔系统为如图2所示的某型飞机部件自动制孔系统,主要由工业机器人、AGV、末端执行器TCP、保型工装及产品样件构成,根据该自动制孔系统的现场布局,可以在软件上搭建机器人自动制孔系统仿真平台。而由于加工产品曲率较大,为便于加工,提升机器人制孔系统的灵活度,系统将末端执行器TCP的主轴进给方向设计为与机器人法向轴线方向垂直。在末端执行器TCP以不同的姿态对同一孔位进行加工时,机器人的加工姿态也会随之变化。因此在机器人编程时,特别是离线编程时,对于特定的点位,控制末端执行器TCP的加工姿态,能优化机器人的加工姿态,进而提升制孔效果。
本方案中,首先第一步需要确定末端执行器TCP的主要控制轴在法向轴的单位向量。由于将末端执行器TCP的主轴进给方向设计为与机器人法向轴线方向垂直,故而末端执行器TCP的Z轴和法线方向重合,即末端执行器TCP在z轴的单位向量的坐标和末端执行器TCP法向轴的单位向量的坐标相同。由此我们可以确定末端执行器TCP在z轴的单位向量的坐标(ax,ay,az)。
第二步我们会确定末端执行器TCP的主要控制轴在x轴的单位向量的坐标。一般来说,在加工点时末端执行器TCP近似水平,即末端执行器TCP的x轴与参考坐标系的XOY平面尽可能平行,而又因为TCP旋转矩阵R的三个法向向量两两正交,则满足且满足我们令ny=ax,nz=0,则得到nx=-ay,再对进行单位化,得到向量的坐标(nx,ny,nz)为
第三步我们计算末端执行器TCP在y轴的单位向量将向量的坐标(nx,ny,nz)和向量的坐标(ax,ay,az)的关系代入到中,得到我们再令ox=ax·az,得到oy=ay·az,oz=-(ax2+ay2),再对进行单位化,得到的坐标为:
本实施例的其他部分与上述实施例1相同,故不再赘述。
以上所述,仅是本发明的较佳实施例,并非对本发明做任何形式上的限制,凡是依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化,均落入本发明的保护范围之内。
Claims (9)
2.根据权利要求1所述的一种机器人末端执行器的姿态计算方法,其特征在于,所述步骤S2中确定末端执行器TCP主要控制轴的单位向量的方法具体为:末端执行器TCP的主要控制轴为末端执行器TCP当前需要姿态的主要控制轴,计算末端执行器TCP姿态主要控制轴的单位向量根据当前参考坐标系与末端执行器TCP间的位姿关系。
5.根据权利要求4所述的一种机器人末端执行器的姿态计算方法,其特征在于:所述测量点的姿态角的余弦cosβ不等于0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110714595.7A CN113370213A (zh) | 2021-06-25 | 2021-06-25 | 一种机器人末端执行器的姿态计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110714595.7A CN113370213A (zh) | 2021-06-25 | 2021-06-25 | 一种机器人末端执行器的姿态计算方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113370213A true CN113370213A (zh) | 2021-09-10 |
Family
ID=77579326
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110714595.7A Pending CN113370213A (zh) | 2021-06-25 | 2021-06-25 | 一种机器人末端执行器的姿态计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113370213A (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105678023A (zh) * | 2016-02-24 | 2016-06-15 | 浙江大学 | 一种飞机壁板卧式自动钻铆机的运动参数辨识方法 |
CN106896778A (zh) * | 2017-04-07 | 2017-06-27 | 湘潭大学 | 一种基于数控刀位文件的机器人末端轨迹规划方法 |
CN107462154A (zh) * | 2017-07-28 | 2017-12-12 | 深圳市圆梦精密技术研究院 | 机器人末端工具的位姿测量方法 |
CN107570983A (zh) * | 2017-09-05 | 2018-01-12 | 西北工业大学 | 一种曲面零件自动装配的方法及系统 |
CN109702751A (zh) * | 2019-03-01 | 2019-05-03 | 中国科学院电子学研究所 | 一种七自由度串联机械臂的位置级逆解方法 |
CN110420867A (zh) * | 2019-07-26 | 2019-11-08 | 华南理工大学 | 一种使用平面检测的自动分拣的方法 |
CN111299761A (zh) * | 2020-02-28 | 2020-06-19 | 华南理工大学 | 一种焊缝跟踪系统的实时姿态估计方法 |
CN112388633A (zh) * | 2020-10-27 | 2021-02-23 | 北京配天技术有限公司 | 生成机器人加工运动轨迹的方法、存储装置及机器人 |
-
2021
- 2021-06-25 CN CN202110714595.7A patent/CN113370213A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105678023A (zh) * | 2016-02-24 | 2016-06-15 | 浙江大学 | 一种飞机壁板卧式自动钻铆机的运动参数辨识方法 |
CN106896778A (zh) * | 2017-04-07 | 2017-06-27 | 湘潭大学 | 一种基于数控刀位文件的机器人末端轨迹规划方法 |
CN107462154A (zh) * | 2017-07-28 | 2017-12-12 | 深圳市圆梦精密技术研究院 | 机器人末端工具的位姿测量方法 |
CN107570983A (zh) * | 2017-09-05 | 2018-01-12 | 西北工业大学 | 一种曲面零件自动装配的方法及系统 |
CN109702751A (zh) * | 2019-03-01 | 2019-05-03 | 中国科学院电子学研究所 | 一种七自由度串联机械臂的位置级逆解方法 |
CN110420867A (zh) * | 2019-07-26 | 2019-11-08 | 华南理工大学 | 一种使用平面检测的自动分拣的方法 |
CN111299761A (zh) * | 2020-02-28 | 2020-06-19 | 华南理工大学 | 一种焊缝跟踪系统的实时姿态估计方法 |
CN112388633A (zh) * | 2020-10-27 | 2021-02-23 | 北京配天技术有限公司 | 生成机器人加工运动轨迹的方法、存储装置及机器人 |
Non-Patent Citations (3)
Title |
---|
《机器人手册》编委会译: "《机器人手册》", 31 January 2013, 机械工业出版 * |
作者已注销: "双向量表示法", 《CSDN》 * |
高帅、杜姗姗: "工业机器人轨迹规划研究", 《计算机仿真》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhu et al. | An off-line programming system for robotic drilling in aerospace manufacturing | |
Liao et al. | Region-based toolpath generation for robotic milling of freeform surfaces with stiffness optimization | |
CN111702762B (zh) | 一种工业机器人作业姿态优化方法 | |
CN109454281B (zh) | 一种机器人铣削加工中的螺旋桨工件坐标系标定方法 | |
US8010235B2 (en) | Approaching and compensating for machine kinematic singularities | |
WO2022170841A1 (zh) | 一种面向大部件群孔加工孔位误差最小的基准选取方法 | |
US10919149B2 (en) | Controller for robot and inverse transforming method for robot | |
CN112123341A (zh) | 机器人双臂协调运动控制方法、装置和电子设备 | |
CN110989490B (zh) | 一种基于轮廓误差的工件最优安装位置的获取方法 | |
CN111673739A (zh) | 一种基于rbf神经网络的机器人位姿可达性判断的方法 | |
CN114012724B (zh) | 一种基于探针的工业机器人坐标系自动标定方法 | |
US8532825B1 (en) | Software compensation for kinematically singular machines | |
CN113370213A (zh) | 一种机器人末端执行器的姿态计算方法 | |
JP3639873B2 (ja) | ロボット制御方法およびロボット制御システム | |
CN113378349A (zh) | S-r-s结构七自由度机械臂逆运动学解析解的数值稳定算法 | |
CN112476435A (zh) | 重力加速度方向的标定方法、标定装置及存储介质 | |
Park et al. | Tracking on lie group for robot manipulators | |
JP6897520B2 (ja) | ロボットの制御装置及びロボットの逆変換処理方法 | |
Nemer et al. | Off-line nominal path generation of 6-DoF robotic manipulator for edge finishing and inspection processes | |
US20230321832A1 (en) | Self-interference determination device | |
CN116449772B (zh) | 一种多轴协同运动控制方法、装置、设备及介质 | |
CN113867260B (zh) | 一种采用数值积分的机器人曲面加工关节轨迹生成方法 | |
Wu et al. | Volumetric error modeling and accuracy improvement by parameter identification of a compound machine tool | |
Dening et al. | An adaptive singularity avoidance method for five-axis toolpath generation with invariant cutter-contact points and bounded tool orientation variation based on the reduction of Jacobian condition number | |
Yang et al. | Verification of NC machining processes using swept volumes |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210910 |
|
RJ01 | Rejection of invention patent application after publication |