CN109773781B - 一种无传感器的工业机器人直线软浮动控制方法 - Google Patents
一种无传感器的工业机器人直线软浮动控制方法 Download PDFInfo
- Publication number
- CN109773781B CN109773781B CN201811601803.7A CN201811601803A CN109773781B CN 109773781 B CN109773781 B CN 109773781B CN 201811601803 A CN201811601803 A CN 201811601803A CN 109773781 B CN109773781 B CN 109773781B
- Authority
- CN
- China
- Prior art keywords
- industrial robot
- end flange
- joint
- deviation
- soft floating
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明公开一种无传感器的工业机器人直线软浮动控制方法,包括如下步骤:1)、准备工作;2)计算工业机器人末端法兰中心实际坐标位置;3)计算工业机器人末端法兰中心位置偏差;4)由限制方向约束工业机器人末端法兰中心位置偏差;5)通过比例系数k1、k2调节工业机器人末端法兰中心位置偏差;6)计算直线软浮动所需要控制的工业机器人的各个关节角度。优点,本发明方法,不使用浮动机构或传感器实现直线软浮动功能,降低了机器人系统的成本。
Description
技术领域
本发明涉及一种无传感器的工业机器人直线软浮动控制方法。
背景技术
目前,工业现场越来越多的使用工业机器人替换人进行作业,特别是压铸、机床上下料行业。在从压铸机内取出工件的应用场合,压铸机的顶杆推出加工工件后,要求工业机器人抓取工件并顺应推力方向直线运动。但是,传统工业机器人的控制方式要求机器人具有足够的刚性,当机器人受到外力时,伺服系统视外力为干扰信号并进行补偿,使机器人保持在目标位置上,机器人不能够随外力而运动。
为解决上述问题,有两种解决办法:一种为被动控制,另一种为主动控制。被动控制是在机器人末端增加浮动机构,通过浮动的机构来实现软浮动的功能。主动控制则通过检测或估计外力的方式来主动控制机器人达到柔顺的效果,其中主动控制又分为带传感器和不带传感器控制,带传感器的控制是通过末端传感检测到接触外力进行控制。被动控制和主动控制中的带传感器控制均要加入外部设备,使得机器人成本提高。
为此,文献《面向直接示教的机器人零力控制[J]》(游有鹏,机械工程学报,2014)将伺服工作模式切换到力矩模式下,通过加入动力学补偿实现机器人无传感器的柔顺控制,但是伺服工作在力矩模式下,会降低系统的稳定性,同时不能够控制机器人精准地沿直线运动。欧洲专利EP0766161A1公开了一种机器人末端直线软浮动的控制方法,该方法通过修改伺服环路,由力产生的位置偏差估计外力,再根据动力学推导出对应的关节力矩,然后再计算出力对应的关节位置偏差,该方法虽然能实现末端的直线软浮动控制,但是对动力学模型精度要求较高,易受外界干扰造成系统不稳定,可能会出现上下串动的现象,同时该方法需要知道伺服内部控制环路各项系数的值,这些参数伺服厂商一般不会提供。
发明内容
本发明的目的是针对上述问题提出一种无传感器的工业机器人末端直线软浮动的控制方法,当外力作用于机器人末端执行器上时,在各个关节处会产生实际位置和目标位置的位置偏差,通过调节位置偏差控制工业机器人运动,达到柔顺的效果,不根据动力学模型计算、无需修改伺服环路,实现方法简单、可靠,通用性更强。
为解决上述技术问题,本发明采用的技术方案是:
一种无传感器的工业机器人直线软浮动控制方法,包括如下步骤:
1)、准备工作,将工业机器人内的伺服电机调节到位置控制模式下,通过伺服驱动器将伺服控制环路中的比例项值和积分项值调小;
2)计算工业机器人末端法兰中心实际坐标位置;
2.1)将外力作用在步骤1中的工业机器人末端执行器上,使工业机器人内的各关节实际位置发生变化;
2.2)分别读取步骤2.1中工业机器人内各关节处的关节电机编码器值;
2.3)通过关节处的关节电机编码器值、减速机减速比以及编码器分辨率计算当前工业机器人的关节的实际关节角度;
2.4)重复步骤2.3,计算得出各个关节的实际关节角度;
3)计算工业机器人末端法兰中心位置偏差;
3.1)对工业机器人预先设定各个关节的关节位置;
4)由限制方向约束工业机器人末端法兰中心位置偏差;
根据预先指定的直线软浮动方向进行工业机器人末端法兰中心位置偏差的限制,
设指定相对于世界坐标系的 Y方向运动,则将X与Z方向上的位置偏差值清零,令、,只保持在Y方向上的位置偏差值;若指定X方向,令、;若指定Z
方向,令、;
5)通过比例系数k1、k2调节工业机器人末端法兰中心位置偏差;
5.1)设定比例系数k1、k2;
5.2)对指定的直线软浮动方向上的工业机器人末端法兰中心位置偏差值乘以k1以及偏差的变化量乘以系数k2;
设指定方向为Y方向,则指定的直线软浮动方向上的工业机器人末端法兰中心位
置偏差值乘以k1以及偏差的变化量乘以系数k2,得到新的工业机器人末端法兰中
心位置偏差值,通过k1、k2值的大小进行末端偏差值的放大与缩小,从而
对直线软浮动的位置偏差进行二次调节,其中k1、k2的设定由实验针对不同机器人类型、不
同工况调节获得;
6)计算直线软浮动所需要控制的工业机器人的各个关节角度;
6.1)设指定方向为Y方向,将步骤5.2中得到的工业机器人末端法兰中心位置偏差
值叠加到步骤3.2中的工业机器人末端法兰中心目标位置上,得到由外力作用产生的工
业机器人末端法兰中心位置在限制方向为Y方向下的新的位置坐标;
6.2)将步骤6.1中新的工业机器人末端法兰位置坐标经过运动学逆解得到直线软浮动所需要控制的各个关节角度;
6.3)将步骤6.2中得到的控制所需的各个关节角度通过减速机减速比以及编码器分辨率转化为控制伺服电机的脉冲值控制伺服电机运动,实现直线软浮动的功能。
本发明方法中,步骤2.3通过关节处的关节电机编码器值、减速机减速比以及编码器分辨率计算当前工业机器人的关节的实际关节角度,这是现有技术中的常规计算。
本发明方法中,提及运动学正解和运动学逆解均为现有技术中的常规计算方法。
本发明的有益效果是:
1、本发明方法,不使用浮动机构或传感器实现直线软浮动功能,降低了机器人系统的成本。
2、目前机器人厂商采取的控制方式多为位置模式控制,本方法可在位置模式下实现直线软浮动,不用修改伺服环路,通用性更强。
3、本发明方法,不需要基于高精度动力学模型进行计算,系统稳定、可靠性强。
附图说明
图1是本方法的控制流程图。
具体实施方式
下面对本发明技术方案进行详细说明,但是本发明的保护范围不局限于所述实施例。
为使本发明的内容更加明显易懂,以下结合附图1和具体实施方式做进一步的描述。
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
一种无传感器的工业机器人直线软浮动控制方法,包括如下步骤:
1)、准备工作,将工业机器人内的伺服电机调节到位置控制模式下,通过伺服驱动器将伺服控制环路中的比例项值和积分项值调小;
2)计算工业机器人末端法兰中心实际坐标位置;
2.1)将外力作用在步骤1中的工业机器人末端执行器上,使工业机器人内的各关节实际位置发生变化;
2.2)分别读取步骤2.1中工业机器人内各关节处的关节电机编码器值;
2.3)通过关节处的关节电机编码器值、减速机减速比以及编码器分辨率计算当前工业机器人的关节的实际关节角度; 2.4)重复步骤2.3,计算得出各个关节的实际关节角度;
3)计算工业机器人末端法兰中心位置偏差;
3.1)对工业机器人预先设定各个关节的关节位置;
4)由限制方向约束工业机器人末端法兰中心位置偏差;
根据预先指定的直线软浮动方向进行工业机器人末端法兰中心位置偏差的限制,
设指定相对于世界坐标系的 Y方向运动,则将X与Z方向上的位置偏差值清零,令、,只保持在Y方向上的位置偏差值;若指定X方向,令、;若指定Z
方向,令、;
5)通过比例系数k1、k2调节工业机器人末端法兰中心位置偏差;
5.1)设定比例系数k1、k2;
5.2)对指定的直线软浮动方向上的工业机器人末端法兰中心位置偏差值乘以k1以及偏差的变化量乘以系数k2;
设指定方向为Y方向,则指定的直线软浮动方向上的工业机器人末端法兰中心位
置偏差值乘以k1以及偏差的变化量乘以系数k2,得到新的工业机器人末端法兰中
心位置偏差值,通过k1、k2值的大小进行末端偏差值的放大与缩小,从而
对直线软浮动的位置偏差进行二次调节,其中k1、k2的设定由实验针对不同机器人类型、不
同工况调节获得;
6)计算直线软浮动所需要控制的工业机器人的各个关节角度;
6.1)设指定方向为Y方向,将步骤5.2中得到的工业机器人末端法兰中心位置偏差
值叠加到步骤3.2中的工业机器人末端法兰中心目标位置上,得到由外力作用产生的工
业机器人末端法兰中心位置在限制方向为Y方向下的新的位置坐标;
6.2)将步骤6.1中新的工业机器人末端法兰位置坐标经过运动学逆解得到直线软浮动所需要控制的各个关节角度;
6.3)将步骤6.2中得到的控制所需的各个关节角度通过减速机减速比以及编码器分辨率转化为控制伺服电机的脉冲值控制伺服电机运动,实现直线软浮动的功能。
本具体实施方式中的无传感器的工业机器人直线软浮动控制方法,通过关节位置的偏差计算到末端位置偏差,再由末端方向限制并且通过偏差系数调节重新计算关节位置偏差来实现指定方向上的直线浮动功能。
实施例1
本实施例以某通用六关节工业机器人为控制对象,直线软浮动功能具体的实现如下:
1、将伺服比例项和积分项参数调小,外力推机器人末端执行器,采集此时各轴绝对式编码器的脉冲值为(292928,418865,296628,292080,278469,186613),根据各轴的关节减速比(80.0548,114.4723,81.066,79.8088,76.10328,51)及编码器分辨率131072计算出当前实际的关节位置值为(10.05,10.05,10.05,10.05,10.05,10.05);运动学正解得到实际的工业机器人末端法兰中心位置为X=467.804,Y=-49.9743,Z=517.14 。
2、设当前目标位置(10,10,10,10,10,10);由目标位置计算出当前末端法兰中心
目标位置X=468.108,Y=-49.397,Z=517.886。将前述得到实际的工业机器人末端法兰中心
位置(为X=467.804,Y=-49.9743,Z=517.14)与当前末端法兰中心目标位置(X=468.108,Y=-
49.397,Z=517.886)做差,得到=-0.304、= -0.5773、=-0.746。
5、由给定末端位置(10,10,10,10,10,10)与计算出控制用末端法兰中心位置X
=468.108,Y=-50.18565, Z=517.886。运动学逆解得到控制用各关节位置(10.0995,
10.0233,9.97266,9.50747,9.9881,10.5347),由关节位置计算得到最终控制电机运动的
脉冲值为(294422,417745,294346,276313,276754, 195613)。
如上所述,尽管参照特定的优选实施例已经表示和表述了本发明,但其不得解释为对本发明自身的限制。在不脱离所附权利要求定义的本发明的精神和范围前提下,可对其在形式上和细节上作出各种变化。
Claims (1)
1.一种无传感器的工业机器人直线软浮动控制方法,其特征在于,包括如下步骤:
1)、准备工作,将工业机器人内的伺服电机调节到位置控制模式下,通过伺服驱动器将伺服控制环路中的比例项值和积分项值调小;
2)计算工业机器人末端法兰中心实际坐标位置;
2.1)将外力作用在步骤1中的工业机器人末端执行器上,使工业机器人内的各关节实际位置发生变化;
2.2)分别读取步骤2.1中工业机器人内各关节处的关节电机编码器值;
2.3)通过关节处的关节电机编码器值、减速机减速比以及编码器分辨率计算当前工业机器人的关节的实际关节角度;
2.4)重复步骤2.3,计算得出各个关节的实际关节角度;
3)计算工业机器人末端法兰中心位置偏差;
3.1)对工业机器人预先设定各个关节的关节位置;
4)由限制方向约束工业机器人末端法兰中心位置偏差;
根据预先指定的直线软浮动方向进行工业机器人末端法兰中心位置偏差的限制,设指定相对于世界坐标系的 Y方向运动,则将X与Z方向上的位置偏差值清零,令、,只保持在Y方向上的位置偏差值;若指定X方向,令、;若指定Z方向,令、;
5)通过比例系数k1、k2调节工业机器人末端法兰中心位置偏差;
5.1)设定比例系数k1、k2;
5.2)对指定的直线软浮动方向上的工业机器人末端法兰中心位置偏差值乘以k1以及偏差的变化量乘以系数k2;
设指定方向为Y方向,则指定的直线软浮动方向上的工业机器人末端法兰中心位置偏差值乘以k1以及偏差的变化量乘以系数k2,得到新的工业机器人末端法兰中心位置偏差值,通过k1、k2值的大小进行末端偏差值的放大与缩小,从而对直线软浮动的位置偏差进行二次调节,其中k1、k2的设定由实验针对不同机器人类型、不同工况调节获得;
6)计算直线软浮动所需要控制的工业机器人的各个关节角度;
6.1)设指定方向为Y方向,将步骤5.2中得到的工业机器人末端法兰中心位置偏差值叠加到步骤3.2中的工业机器人末端法兰中心目标位置上,得到由外力作用产生的工业机器人末端法兰中心位置在限制方向为Y方向下的新的位置坐标;
6.2)将步骤6.1中新的工业机器人末端法兰位置坐标经过运动学逆解得到直线软浮动所需要控制的各个关节角度;
6.3)将步骤6.2中得到的控制所需的各个关节角度通过减速机减速比以及编码器分辨率转化为控制伺服电机的脉冲值控制伺服电机运动,实现直线软浮动的功能。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811601803.7A CN109773781B (zh) | 2018-12-26 | 2018-12-26 | 一种无传感器的工业机器人直线软浮动控制方法 |
PCT/CN2019/086701 WO2020133877A1 (zh) | 2018-12-26 | 2019-05-13 | 一种无传感器的工业机器人直线软浮动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811601803.7A CN109773781B (zh) | 2018-12-26 | 2018-12-26 | 一种无传感器的工业机器人直线软浮动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109773781A CN109773781A (zh) | 2019-05-21 |
CN109773781B true CN109773781B (zh) | 2021-05-25 |
Family
ID=66498562
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811601803.7A Active CN109773781B (zh) | 2018-12-26 | 2018-12-26 | 一种无传感器的工业机器人直线软浮动控制方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109773781B (zh) |
WO (1) | WO2020133877A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112743541B (zh) * | 2020-12-21 | 2022-03-04 | 南京埃斯顿自动化股份有限公司 | 一种无力/力矩传感器机械臂软浮动控制方法 |
WO2023077415A1 (en) * | 2021-11-05 | 2023-05-11 | Foshan Flexiv Robotics Technology Co, . Ltd. | Kinematics calibration method and calibration system for robot with multiple degrees of freedom |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06198445A (ja) * | 1993-01-07 | 1994-07-19 | Hitachi Ltd | Tig溶接用ロボット制御装置 |
EP0766161A1 (en) * | 1995-02-21 | 1997-04-02 | Fanuc Ltd. | Control method of servo system capable of adjusting flexibility on orthogonal coordinate system |
US5646493A (en) * | 1994-05-20 | 1997-07-08 | Fanuc Ltd. | Robot profile control method |
CN1200692A (zh) * | 1995-09-11 | 1998-12-02 | 株式会社安川电机 | 机器人控制设备 |
CN101180789A (zh) * | 2005-05-31 | 2008-05-14 | 三菱电机株式会社 | 电动机控制装置 |
CN101859096A (zh) * | 2009-04-10 | 2010-10-13 | 鸿富锦精密工业(深圳)有限公司 | 采用pid控制器的控制方法及控制装置与机器人 |
CN104267598A (zh) * | 2014-09-19 | 2015-01-07 | 江南大学 | 一种Delta机器人运动机构的模糊PI控制器设计方法 |
CN104385279A (zh) * | 2014-09-26 | 2015-03-04 | 京东方科技集团股份有限公司 | 一种机械手示教方法及系统 |
CN106003033A (zh) * | 2016-06-16 | 2016-10-12 | 哈尔滨工程大学 | 一种具有力控制的六自由度机械臂标准汉字书写方法 |
CN107081787A (zh) * | 2017-04-01 | 2017-08-22 | 西安交通大学 | 基于工业机器人内置传感器信号的运动特性检测方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3421442B2 (ja) * | 1994-09-02 | 2003-06-30 | ファナック株式会社 | ロボットの位置教示方法及びロボット制御装置 |
JP3483675B2 (ja) * | 1995-08-30 | 2004-01-06 | ファナック株式会社 | ソフトフローティング機能を用いた位置教示方法 |
US9616573B2 (en) * | 2012-05-25 | 2017-04-11 | The Ritsumeikan Trust | Robot control apparatus, robot control method, program, recording medium and robot system |
WO2016162066A1 (en) * | 2015-04-09 | 2016-10-13 | Abb Technology Ltd | An industrial robot and a method for lead-through programming of an industrial robot |
CN108115669B (zh) * | 2016-11-26 | 2021-03-26 | 沈阳新松机器人自动化股份有限公司 | 一种机器人浮动控制方法、装置及系统 |
CN108638069B (zh) * | 2018-05-18 | 2021-07-20 | 南昌大学 | 一种机械臂末端精确运动控制方法 |
-
2018
- 2018-12-26 CN CN201811601803.7A patent/CN109773781B/zh active Active
-
2019
- 2019-05-13 WO PCT/CN2019/086701 patent/WO2020133877A1/zh active Application Filing
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06198445A (ja) * | 1993-01-07 | 1994-07-19 | Hitachi Ltd | Tig溶接用ロボット制御装置 |
US5646493A (en) * | 1994-05-20 | 1997-07-08 | Fanuc Ltd. | Robot profile control method |
EP0766161A1 (en) * | 1995-02-21 | 1997-04-02 | Fanuc Ltd. | Control method of servo system capable of adjusting flexibility on orthogonal coordinate system |
US5742138A (en) * | 1995-02-21 | 1998-04-21 | Fanuc Ltd. | Control method for servo system with adjustable softness in rectangular coordinate system |
CN1200692A (zh) * | 1995-09-11 | 1998-12-02 | 株式会社安川电机 | 机器人控制设备 |
CN101180789A (zh) * | 2005-05-31 | 2008-05-14 | 三菱电机株式会社 | 电动机控制装置 |
CN101859096A (zh) * | 2009-04-10 | 2010-10-13 | 鸿富锦精密工业(深圳)有限公司 | 采用pid控制器的控制方法及控制装置与机器人 |
CN104267598A (zh) * | 2014-09-19 | 2015-01-07 | 江南大学 | 一种Delta机器人运动机构的模糊PI控制器设计方法 |
CN104385279A (zh) * | 2014-09-26 | 2015-03-04 | 京东方科技集团股份有限公司 | 一种机械手示教方法及系统 |
CN106003033A (zh) * | 2016-06-16 | 2016-10-12 | 哈尔滨工程大学 | 一种具有力控制的六自由度机械臂标准汉字书写方法 |
CN107081787A (zh) * | 2017-04-01 | 2017-08-22 | 西安交通大学 | 基于工业机器人内置传感器信号的运动特性检测方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2020133877A1 (zh) | 2020-07-02 |
CN109773781A (zh) | 2019-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3473834B2 (ja) | ロボットの制御装置 | |
JP7363098B2 (ja) | ロボットの制御方法 | |
CN110948504B (zh) | 机器人加工作业法向恒力跟踪方法和装置 | |
CN107704660B (zh) | 一种用于工业机器人的误差补偿方法 | |
CN109773781B (zh) | 一种无传感器的工业机器人直线软浮动控制方法 | |
JP2524931B2 (ja) | ロボットの直線補間方法 | |
CN105717869B (zh) | 工业机器人操作空间路径复合限制求解方法 | |
WO2018212305A1 (ja) | モータ制御システム、モータ制御システムの制御方法、及びロボットシステム | |
CN108453741A (zh) | 一种工业机器人柔性伺服控制方法 | |
Luo et al. | Predictive seam tracking with iteratively learned feedforward compensation for high-precision robotic laser welding | |
CN110900613A (zh) | 一种面向移动机器人的不停车控制方法及系统 | |
Singh et al. | Control of closed-loop differential drive mobile robot using forward and reverse kinematics | |
JP7450744B2 (ja) | ロボットデバイスを制御する方法、コントローラ、機械読取可能な命令のセット、機械読取可能な媒体及びロボットデバイス | |
CN110026986B (zh) | 多臂协同作业柔顺控制方法 | |
CN107645979B (zh) | 用于使机器人手臂的运动同步的机器人系统 | |
Winkler et al. | Explicit and implicit force control of an industrial manipulator—An experimental summary | |
Luo et al. | On-line adaptive control for minimizing slippage error while mobile platform and manipulator operate simultaneously for robotics mobile manipulation | |
US10926411B2 (en) | Control system | |
JPH11231940A (ja) | ロボットの制御装置 | |
JP3937078B2 (ja) | ロボットの制御装置及び制御方法 | |
JP7182952B2 (ja) | 制御方法、制御プログラム、記録媒体、制御装置、ロボットシステム、および物品の製造方法 | |
CN113093549B (zh) | 一种多轴数控装备的复合控制方法 | |
JP2019214105A (ja) | ロボット制御装置およびロボット制御方法 | |
JP2713702B2 (ja) | ロボットの制御方法および装置 | |
CN116852397B (zh) | 负压理疗机器人理疗力度及理疗路径的自适应调节方法 |
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 |