CN112297007B - 一种机器人外部参考坐标系下的直线运动规划方法 - Google Patents
一种机器人外部参考坐标系下的直线运动规划方法 Download PDFInfo
- Publication number
- CN112297007B CN112297007B CN202011137069.0A CN202011137069A CN112297007B CN 112297007 B CN112297007 B CN 112297007B CN 202011137069 A CN202011137069 A CN 202011137069A CN 112297007 B CN112297007 B CN 112297007B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- external reference
- reference coordinate
- point
- robot
- 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
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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种机器人外部参考坐标系下的直线运动规划方法,基于反转工件的思想以及利用虚拟的外部参考坐标系来规划位姿的方法,将空间中不直观的曲线运动分解为两个简单运动的叠加。分别规划这两个简单的运动,再由两个简单的运动合成为所要实现的目标曲线运动,从而实现工件相对于外部参考坐标系的直线运动。本发明规划方法实现简单,应用本发明方法可以实现外部参考坐标系下的直线运动,扩展机器人的应用领域。
Description
技术领域
本发明涉及一种机器人运动轨迹规划方法,具体说是一种机器人外部参考坐标系下的直线运动规划方法。
背景技术
通常情况下,机器人笛卡尔空间轨迹规划所参考的坐标系为世界坐标系或用户坐标系。机器人笛卡尔空间的轨迹规划一般都是规划机器人TCP(工具中心点)的位姿,机器人TCP在空间中相对于世界坐标系是规则的直线或圆弧轨迹。机器人工作时,工具安装在机器人末端,工件固定在机器人可达工作空间内,机器人在工件上根据不同应用需求进行作业。但对于有些应用,比如涂胶应用需要将工件安装在机器人末端,工件相对于某一个固定胶枪运动。无论工件的姿态如何变化,工件相对于固定胶枪的运动轨迹始终为工件的直线或圆弧轮廓,此时机器人TCP在世界坐标系下是一条不直观的空间曲线轨迹,无法直接对其进行轨迹规划。对于涂胶这类应用,需要相对于外部某一个固定的参考坐标系进行运动规划,工件位置和姿态的运动均相对于外部参考坐标系。
世界坐标系或用户坐标系下姿态规划是相对于世界坐标系的,这种规划方式,当示教起点和示教终点工件姿态发生变化时,若要保证工件的直线轮廓沿着外部参考坐标系(胶枪)运动,需要示教多个中间点去拟合工件轮廓。示教中间点越多,拟合效果越好,但是增加了示教的复杂和难度,且无法保证涂胶速度的均匀变化。而外部参考坐标系下的姿态规划是相对于外部参考坐标系的,在外部参考坐标系下运动规划,无论工件的起终点姿态如何变化,直线运动只需要示教起点和终点,示教作业得以简化。示教轨迹再现时,机器人手持的工件也会相对外部参考坐标系运动,保证了速度的均匀性。如图1所示。
机器人的直线运动是最基本的轨迹运动,在外部固定的参考坐标系下实现直线运动可以拓展机器人的应用领域,比如上述的涂胶应用。文献《一种基于动态外部TCP的工业机器人磨抛方法[J]》(李名水,李霆,欧道江,等.机电产品开发与创新,2018,31(2):20-23),通过提取工件曲面特征信息自动生成动态外部TCP点,再根据轨迹离散点与动态外部TCP的位姿转换关系求得机器人最终的运行轨迹,文中提到的外部TCP,其本质是一个外部参考坐标系,但文献未详细说明如何在外部参考坐标系下规划直线的方法。
发明内容
本发明的发明目的在于,克服现有技术存在的缺陷,提出了一种机器人外部参考坐标系下的直线运动规划方法,基于绕外部参考坐标系原点反转工件的思想以及利用虚拟的外部参考坐标系来规划位姿,将一种复杂的运动分解为平移和旋转运动的叠加,分别规划位置和姿态,再由位置和姿态合成目标运动,在外部固定的参考坐标系下实现直线规划,从而实现工件相对于外部参考坐标系的直线运动。
本发明的基本技术思路是:
将工件的运动分解为直线运动和旋转运动。直线运动指工件保持与示教起点姿态不变,沿外部参考坐标系et1原点平移至示教终点处工件与外部参考坐标系原点接触位置的中间点,此过程外部参考坐标系et1不变,机器人的TCP点由示教起点t1变换至中间点t2'。旋转运动指在中间点处工件绕着外部参考坐标系原点旋转至与示教终点相同姿态的位置,此过程中机器人的TCP点由中间点t2'变换至示教终点t2,外部参考坐标系的原点位置不变但其姿态随着工件的旋转发生变化,当工件旋转至示教终点时,外部参考坐标系由et1变换至et2。et2是一个虚拟的外部参考坐标系,没有实际意义,只为了插补计算的引入。外部参考坐标系下直线运动的起点、终点均由示教获得。已知条件:示教起点机器人的TCP点t1相对于外部参考坐标系et1的位姿描述表示为姿态描述表示为位置描述为 示教终点机器人的TCP点t2相对于外部参考坐标系et1的位姿描述表示为姿态描述表示为外部参考坐标系et1的描述由控制器的坐标系标定获得,外部参考坐标系et1相对于世界坐标系的位姿描述表示为姿态描述表示为位置描述表示为
本发明机器人外部参考坐标系下的直线运动规划方法,其步骤如下:
步骤1.反转变换进行运动分解
在示教终点处将机器人姿态绕着外部参考坐标系et1原点反转至与示教起点相同姿态的中间点,此时机器人TCP点t2反转至t2'点,反转消除了机器人的姿态变化;反转后,机器人在中间点和示教起点只有位置的变化;示教终点处引入虚拟外部参考坐标系et2,et2与外部参考坐标系et1原点重合,当示教终点机器人姿态绕着外部参考坐标系et1原点反转至与示教起点相同姿态的中间点后,et2与et1重合。
步骤2.确定姿态插补起终点
步骤3.确定位置插补起终点
直线位置插补起点为t1在外部参考坐标系et1下的位置描述由示教获得;直线位置插补终点为t2'在外部参考坐标系et1下的位置描述因其中为位置插补终点t2'在外部参考坐标系et1下的位姿描述,为示教终点t2在外部参考坐标系et2下的位姿描述,为虚拟外部参考坐标系et2相对于外部参考坐标系et1位姿描述。由可得出位置插补终点的描述插补终点t2'在外部参考坐标系et1下的姿态描述。
步骤4.计算姿态和位置插补中间点
分别对姿态和位置进行插补,姿态和位置插补均相对于外部参考坐标系et1;对et2相对于et1的变化姿态进行插补得到姿态插补中间点的姿态为一动态变化的姿态矩阵,其区间为单位阵E到姿态的变化;对空间线段进行插补获得位置插补中间点的位置et1P(i);对位置和姿态插补时,可任选速度规划方式,比如常见的梯形、S型等速度规划。
步骤5.运动合成计算TCP位姿
姿态插补中间点外部参考坐标系在世界坐标系下的姿态描述将得到的直线插补点位置叠加到新的插补姿态下,合成姿态与位置的运动,得到机器人TCP点实时输出的位置;插补最终输出TCP点相对于世界坐标系下的位置 为插补中间点外部参考坐标系相对于世界坐标系的位姿描由刚体的运动特性,插补最终输出TCP点相对于世界坐标系下的姿态
本发明根据外部参考坐标下直线运动的几何特性,基于反转工件的思想以及利用虚拟的外部参考坐标系来规划位姿的方法,将空间中不直观的曲线运动分解为两个简单运动的叠加,分别规划这两个简单的运动,再由两个简单的运动合成为所要实现的目标曲线运动,从而实现工件相对于外部参考坐标系的直线运动。本发明规划方法实现简单,应用本发明方法可以实现外部参考坐标系下的直线运动,扩展机器人的应用领域。
附图说明
图1是外部参考坐标系和世界坐标系下直线运动示教与再现的区别。其中,a图是世界坐标系下的示教,图中标记,1为工件,2为胶枪;b图是外部参考坐标系下的示教。
图2是外部参考坐标系下直线运动分解过程。
图3是外部参考坐标系下直线运动插补示意与放大图。
图4是外部参考坐标系下直线插补流程图。
图5位置插补点各方向分量。其中,图a是位置插补X与Y方向位置图,图b是位置插补X与Z方向位置图。
图6 TCP点在世界坐标系下的位置分量。其中,图a是TCP点在世界坐标系X与Y方向分量图,图b是TCP点在世界坐标系X与Z方向分量图
图7 TCP点在世界坐标系下的姿态变化。其中,图a是TCP点在世界坐标系下的姿态α变化图,图b是TCP点在世界坐标系下的姿态β变化图,图c是TCP点在世界坐标系下的姿态γ变化图。
具体实施方式
下面结合具体实施例,对本发明方法作进一步详细说明。
本发明以某通用六关节机器人为控制对象,将需要涂胶的工件固定在机器人末端手爪上,胶枪相对于地面固定在机器人的工作空间内。机器人手持工件在胶枪的作用下进行涂胶作业,如附图1。在胶枪处建立外部参考坐标系,外部参考坐标系下直线运动的示教起点为P1,终点为P2。示教时将需要进行涂胶的工件的直线轮廓紧贴外部参考坐标系的原点。
如附图2所示,外部参考坐标系et1相对于世界坐标系的描述由控制器的坐标系标定获得,已知建立的外部参考坐标系et1相对于世界坐标系的位姿描述表示为 为矩阵表达形式,(xet1,yet1,zet1,αet1,βet1,χet1)为位置欧拉角表示方式,二者等价。其中xet1、yet1、zet1表示外部参考坐标系原点在世界坐标系坐标轴方向的位置分量,单位为mm。αet1、βet1、γet1为ZYX形式欧拉角表示形式,表示外部参考坐标系在世界坐标系下的欧拉角,单位为度。位置描述姿态描述
示教起点P1处机器人TCP点t1相对于外部参考坐标系et1的位姿描述表示为xt1、yt1、zt1、αt1、βt1、γt1为t1在外部参考坐标系et1下的位置及欧拉角表示。姿态描述位置描述 t1点在世界坐标系下的描述示教终点P2处机器人TCP点t2相对于外部参考坐标系et1的位姿描述表示为xt2、yt2、zt2、αt2、βt2、γt2为t2在外部参考坐标系et1下的位置及欧拉角表示。位置描述姿态描述t2点在世界坐标系下的描述
要实现外部参考坐标系下的直线运动,思路是将工件的运动分解为直线运动和旋转运动,如附图2所示。直线运动指工件保持与示教起点姿态不变,沿外部参考坐标系et1原点平移至示教终点处工件与外部参考坐标系原点接触位置的中间点,此过程外部参考坐标系et1不变,机器人的TCP点由示教起点t1变换至中间点t2'。旋转运动指在中间点处工件绕着外部参考坐标系原点旋转至与示教终点相同姿态的位置,此过程中机器人的TCP点由中间点t2'变换至示教终点t2,外部参考坐标系的原点位置不变但其姿态随着工件的旋转发生变化,当工件旋转至示教终点时,外部参考坐标系由et1变换至et2。et2是一个虚拟的外部参考坐标系,没有实际意义,只为了插补计算的引入。
本发明的具体步骤如下,流程图见附图4。
步骤1.反转变换进行运动分解
在示教终点处将机器人姿态绕着外部参考坐标系et1原点反转至与示教起点相同姿态的中间点,此时机器人TCP点t2反转至t2'点,反转消除了机器人的姿态变化;反转后,机器人在中间点和示教起点只有位置的变化;示教终点处引入虚拟外部参考坐标系et2,et2与外部参考坐标系et1原点重合,当示教终点机器人姿态绕着外部参考坐标系et1原点反转至与示教起点相同姿态的中间点后,et2与et1重合。
步骤2.确定姿态插补起终点
由刚体的运动特性得解得其中,为虚拟外部参考坐标系et2相对于外部参考坐标系et1姿态描述;为示教终点机器人的TCP点t2相对于外部参考坐标系et2的姿态描述,姿态插补起点为单位阵E=(0,0,0),姿态插补终点为
步骤3.确定位置插补起终点
直线位置插补起点为t1在外部参考坐标系et1下的位置描述 由示教获得;直线位置插补终点为t2'在外部参考坐标系et1下的位置描述因其中为位置插补终点t2'在外部参考坐标系et1下的位姿描述,为示教终点t2在外部参考坐标系et2下的位姿描述,为虚拟外部参考坐标系et2相对于外部参考坐标系et1位姿描述。由可得出位置插补终点的描述为插补终点t2'在外部参考坐标系et1下的姿态描述。
步骤4.计算姿态和位置插补中间点
如附图3,分别对姿态和位置进行插补,姿态和位置插补均相对于外部参考坐标系et1;对et2相对于et1的变化姿态进行插补得到姿态插补中间点的姿态为一动态变化的姿态矩阵,其区间为单位阵E到姿态的变化;对空间线段进行插补获得位置插补中间点的位置et1P(i);对位置和姿态插补时,可任选速度规划方式,比如常见的梯形、S型等速度规划。位置插补曲线相对于变化的外部参考坐标系为直线,见附图5。
步骤5.运动合成计算TCP位姿
Claims (3)
1.一种机器人外部参考坐标系下的直线运动规划方法,其特征是:步骤如下
示教起点机器人的TCP点t1相对于外部参考坐标系et1的位姿描述表示为姿态描述表示为位置描述为 示教终点机器人的TCP点t2相对于外部参考坐标系et1的位姿描述表示为姿态描述表示为外部参考坐标系et1的描述由控制器的坐标系标定获得,外部参考坐标系et1相对于世界坐标系的位姿描述表示为姿态描述表示为位置描述表示为
步骤1.反转变换进行运动分解
在示教终点处将机器人姿态绕着外部参考坐标系et1原点反转至与示教起点相同姿态的中间点,此时示教终点机器人的TCP点t2反转至t2'点,反转消除了机器人的姿态变化;反转后,机器人在中间点和示教起点只有位置的变化;示教终点处引入虚拟外部参考坐标系et2,et2与外部参考坐标系et1原点重合,当示教终点机器人姿态绕着外部参考坐标系et1原点反转至与示教起点相同姿态的中间点后,et2与et1重合;
步骤2.确定姿态插补起终点
步骤3.确定位置插补起终点
直线位置插补起点为t1在外部参考坐标系et1下的位置描述由示教获得;直线位置插补终点为t2',在外部参考坐标系et1下的位置描述因其中为直线位置插补终点t2'在外部参考坐标系et1下的位姿描述,为示教终点机器人的TCP点t2在虚拟外部参考坐标系et2下的位姿描述,为虚拟外部参考坐标系et2相对于外部参考坐标系et1位姿描述;由可得出位置插补终点的描述 为直线位置插补终点t2'在外部参考坐标系et1下的姿态描述;
步骤4.计算姿态和位置插补中间点
分别对姿态和位置进行插补,姿态和位置插补均相对于外部参考坐标系et1;对et2相对于et1的变化姿态进行插补得到姿态插补中间点的姿态 为一动态变化的姿态矩阵,其区间为单位阵E到姿态的变化;对空间线段进行插补获得位置插补中间点的位置et1P(i);
步骤5.运动合成计算TCP位姿
姿态插补中间点外部参考坐标系在世界坐标系下的姿态描述将得到的直线插补点位置叠加到新的插补姿态下,合成姿态与位置的运动,得到机器人TCP点实时输出的位置;其中,为外部参考坐标系et1相对于世界坐标系的姿态描述;
2.根据权利要求1所述的机器人外部参考坐标系下的直线运动规划方法,其特征是:
所述步骤4中,对姿态和位置进行插补,采用速度规划方式。
3.根据权利要求2所述的机器人外部参考坐标系下的直线运动规划方法,其特征是:
所述速度规划方式,采用梯形速度规划或S型速度规划。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011137069.0A CN112297007B (zh) | 2020-10-22 | 2020-10-22 | 一种机器人外部参考坐标系下的直线运动规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011137069.0A CN112297007B (zh) | 2020-10-22 | 2020-10-22 | 一种机器人外部参考坐标系下的直线运动规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112297007A CN112297007A (zh) | 2021-02-02 |
CN112297007B true CN112297007B (zh) | 2021-10-26 |
Family
ID=74328438
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011137069.0A Active CN112297007B (zh) | 2020-10-22 | 2020-10-22 | 一种机器人外部参考坐标系下的直线运动规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112297007B (zh) |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0811299B2 (ja) * | 1986-05-06 | 1996-02-07 | 株式会社日立製作所 | ロボツトの制御装置 |
CN100480004C (zh) * | 2004-07-15 | 2009-04-22 | 上海交通大学 | 焊接机器人单目视觉传感器的手-眼关系快速标定方法 |
CN106671079B (zh) * | 2015-11-06 | 2019-06-18 | 中国科学院沈阳计算技术研究所有限公司 | 一种实现变位机协同的焊接机器人运动控制方法 |
CN105751452A (zh) * | 2016-04-22 | 2016-07-13 | 苏州超群智能科技有限公司 | 一种具有视觉影像***的机械手 |
KR102418451B1 (ko) * | 2017-12-27 | 2022-07-07 | 주식회사 한화 | 로봇 제어 시스템 |
CN109454642B (zh) * | 2018-12-27 | 2021-08-17 | 南京埃克里得视觉技术有限公司 | 基于三维视觉的机器人涂胶轨迹自动生产方法 |
CN111230880B (zh) * | 2020-02-24 | 2021-06-22 | 西安交通大学 | 一种离线编程中的复杂曲面加工轨迹生成方法 |
-
2020
- 2020-10-22 CN CN202011137069.0A patent/CN112297007B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112297007A (zh) | 2021-02-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113524157A (zh) | 配置临摹功能的机器人***、方法、机械臂和存储介质 | |
CN113601512B (zh) | 一种机械臂奇异点的通用规避方法与*** | |
CN103934528B (zh) | 一种用于电火花加工的六轴联动插补方法 | |
CN106003034B (zh) | 一种主从式机器人控制***及控制方法 | |
JPH09109072A (ja) | 冗長マニピュレータの制御方法 | |
CN112453648B (zh) | 一种基于3d视觉的离线编程激光焊缝跟踪*** | |
JP2006099474A (ja) | ロボットの軌跡制御方法 | |
CN109648230B (zh) | 基于六自由度机器人扩展双旋转协同功能轴的摆焊方法 | |
CN105598975B (zh) | 一种确定工业机器人运动轨迹的方法 | |
CN113545851B (zh) | 重建器械术野中心的控制方法、***、设备和存储介质 | |
CN110227873B (zh) | 一种大尺寸金属工件的电弧增材制造方法 | |
CN109794382A (zh) | 一种3d微涂覆机器人及其涂覆方法 | |
CN109648229B (zh) | 基于六自由度机器人扩展双直线协同功能轴的摆焊方法 | |
CN109773376B (zh) | 一种焊接机器人的正弦摆焊方法 | |
KR20150142796A (ko) | 로봇의 팔꿈치 제어시스템 및 그 제어방법 | |
CN112297007B (zh) | 一种机器人外部参考坐标系下的直线运动规划方法 | |
CN109129469B (zh) | 机械臂运动学逆解方法、装置及机械臂 | |
CN111168680A (zh) | 一种基于神经动力学方法的软体机器人控制方法 | |
JP2020171989A (ja) | ロボット教示システム | |
CN114131617A (zh) | 一种工业机器人的智能柔顺控制方法和装置 | |
CN112684793B (zh) | 一种离散***中的机器人零半径过弯的轨迹跟踪控制方法 | |
CN111761586B (zh) | 一种基于大数据的远程控制机器人 | |
Luo et al. | On-line adaptive control for minimizing slippage error while mobile platform and manipulator operate simultaneously for robotics mobile manipulation | |
CN109773581B (zh) | 一种机器人应用于再现机加工的方法 | |
KR101312003B1 (ko) | R축을 포함한 로봇의 보간 방법 |
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 |