CN113400313B - 基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法 - Google Patents
基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法 Download PDFInfo
- Publication number
- CN113400313B CN113400313B CN202110750200.9A CN202110750200A CN113400313B CN 113400313 B CN113400313 B CN 113400313B CN 202110750200 A CN202110750200 A CN 202110750200A CN 113400313 B CN113400313 B CN 113400313B
- Authority
- CN
- China
- Prior art keywords
- model
- robot
- force
- environment
- impedance control
- 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/1628—Programme controls characterised by the control loop
-
- 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)
- Manipulator (AREA)
Abstract
本发明涉及一种基于Zener模型的机器人‑环境柔顺接触过程的阻抗控制方法,属于机器人与环境交互领域。基于位置控制的力跟踪阻抗控制器在位置控制内环的基础上加入力控制外环,将实际接触力和期望接触力的误差信号通过阻抗控制器转换为位置调整量,再通过位置调整量和参考轨迹叠加来调整机器人末端的理想运动轨迹,最后通过位置控制器使机器人末端按计算出的理想运动轨迹运动,进而实现力跟踪。与传统使机器人末端表现为弹簧或弹簧与阻尼器并联的模型相比,该模型可以通过调节参数使机械臂表现出更合适的特性,而不需要频繁切换模型。
Description
技术领域
本发明属于机器人与环境交互领域,具体涉及一种基于Zener模型的笛卡尔空间力跟踪阻抗控制方法设计。
背景技术
随着机器人技术的快速发展,机器人的应用范围不断扩大,机器人面临的环境越来越复杂,与人进行的交互越来越多,因此对机器人的安全性和适应性要求也越来越高。由于机器人与环境接触时仅进行位置控制有可能导致接触力过大,因此需要引入柔顺控制,以顺应外力,使机器人与环境的相互作用力保持在合理的范围内,提升机器人的安全性。目前使用较多的是柔顺控制中的阻抗控制方法。
目前使用的阻抗控制模型Voigt模型和Maxwell模型均从流变学领域推广而来,具有不同的性质,如果需要变换性质则需要更换模型。而Zener模型可以将Voigt模型和Maxwell模型合二为一,同时具有两者的性质,只需要调整参数即可。
发明内容
要解决的技术问题
为了弥补现有笛卡尔空间力跟踪阻抗控制方法的不足,本发明提出一种基于Zener模型的笛卡尔空间力跟踪阻抗控制方法,可以使机器人末端在不同的性质当中平稳切换。
技术方案
一种基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法,其特征在于步骤如下:
步骤1:建立机器人动力学模型和环境模型
所述的机器人动力学模型为:
所述的环境模型为:
其中,Fe为环境作用力,Ke为环境模型的刚度系数,Be为环境模型的阻尼系数,X为机械臂末端位置,Xe为环境位置;
步骤2:建立基于Zener模型的阻抗控制模型
步骤3:建立基于位置的力跟踪阻抗控制模型
所述的基于位置的力跟踪阻抗控制模型包括阻抗控制器、位置控制器、环境模型和机器人,其中位置控制器对机器人进行控制,即控制力F,机器人输出位置X给环境模型,环境模型输出环境作用力Fe,将期望作用力Fd减去环境作用力Fe得到Ef输入到阻抗控制器,阻抗控制器输出Ex,将期望位置Xd减去Ex得到参考轨迹Xr去控制位置控制器。
优选地:所述的位置控制器为PID控制器。
有益效果
本发明提出的一种基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法,其中阻抗控制器表现出的效果可以等效为将机器人末端等效为Zener模型(即阻尼器与弹簧串联之后再与一个弹簧并联),此时只有末端等效,而与机器人本身的自由度无关。与传统使机器人末端表现为弹簧或弹簧与阻尼器并联的模型相比,该模型可以通过调节参数使机械臂表现出更合适的特性,而不需要频繁切换模型。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1三种阻抗模型对比图;
图2基于位置控制的力跟踪阻抗控制框图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图和实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。此外,下面描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明采用Zener模型,提出一种性能范围较广的笛卡尔空间力跟踪阻抗控制方法。包括如下:
1、建立机器人动力学模型和环境模型;
2、建立基于Zener模型的阻抗控制模型;
3、建立基于位置的力跟踪阻抗控制模型。
步骤一、建立机器人动力学模型和环境模型
为了对机器人进行力控制,需要使用机器人动力学研究运动和受力之间的关系。目前有很多种动力学方法,如拉格朗日法等。将推导出的动力学方程转化到笛卡尔空间可以方便之后的控制器设计。
机器人与环境接触之后,就受到环境的作用力,机器人不再是一个独立的控制对象,而是与环境融合为一个新的系统。通常把环境模拟为弹簧系统或弹簧-阻尼系统。
步骤二、建立基于Zener模型的阻抗控制模型
Voigt阻抗控制模型表达式为
Maxwell阻抗控制模型的表达式为
其中,Xe仍是末端执行器的位移,同时也可理解为弹簧与阻尼器位移之和。Md、Bd和Kd分别为惯性矩阵、阻尼矩阵和刚度矩阵,Fe为机器人末端与环境的接触力。阻尼器的位移Pe=P-P0,P和P0分别是阻尼器的实际位置和中性位置。如果将这两个方程组合起来以消除变量pe,则Maxwell阻抗控制模型表达式可以化为如下形式
上面两个阻抗控制模型中,Voigt模型主要表现为弹性变形,Maxwell模型主要表现为塑性变形,而Zener模型可以将这两个模型结合起来。
Zener阻抗控制模型的表达式为
其中,Xe仍是末端执行器的位移,Md、Bd、Kd和分别为惯性矩阵、阻尼矩阵、刚度矩阵和另一个刚度矩阵,Fe为机器人末端与环境的接触力。阻尼器的位移Pe=P-P0,P和P0分别是阻尼器的实际位置和中性位置。如消除变量pe,则Zener阻抗控制模型表达式可以化为如下形式
步骤三、建立基于位置的力跟踪阻抗控制模型
基于位置控制的力跟踪阻抗控制器在位置控制内环的基础上加入力控制外环,将实际接触力和期望接触力的误差信号通过阻抗控制器转换为位置调整量,再通过位置调整量和参考轨迹叠加来调整机器人末端的理想运动轨迹,最后通过位置控制器使机器人末端按计算出的理想运动轨迹运动,进而实现力跟踪。
上述步骤具体如下:
步骤一、建立机器人动力学模型和环境模型
上式即为关节空间的动力学方程。其中τ为n维广义关节力矩,q,和分别为n维关节变量,速度和加速度。D(q)为机械臂的惯性矩阵,是q的函数,并且为n×n的正定对称矩阵。是n×1的哥氏力和离心力矢量,P(q)是n×1的重力矢量。
运动学方程也可化到笛卡尔空间。
机器人与环境接触之后,就受到环境的作用力,机器人不再是一个独立的控制对象,而是与环境融合为一个新的系统。通常把环境模拟为弹簧-阻尼系统。此时环境作用力表达式为
其中,Fe为环境作用力,Ke为环境模型的刚度系数,Be为环境模型的阻尼系数,X为机械臂末端位置,Xe为环境位置。
步骤二、建立基于Zener模型的阻抗控制模型
Voigt阻抗控制模型表达式为
Maxwell阻抗控制模型的表达式为
其中,Xe仍是末端执行器的位移,同时也可理解为弹簧与阻尼器位移之和。Md、Bd和Kd分别为惯性矩阵、阻尼矩阵和刚度矩阵,Fe为机器人末端与环境的接触力。阻尼器的位移Pe=P-P0,P和P0分别是阻尼器的实际位置和中性位置。如果将这两个方程组合起来以消除变量pe,则Maxwell阻抗控制模型表达式可以化为如下形式
上面两个阻抗控制模型中,Voigt模型主要表现为弹性变形,Maxwell模型主要表现为塑性变形,而Zener模型可以将这两个模型结合起来。
Zener阻抗控制模型的表达式为
其中,Xe仍是末端执行器的位移,Md、Bd、Kd和分别为惯性矩阵、阻尼矩阵、刚度矩阵和另一个刚度矩阵,Fe为机器人末端与环境的接触力。阻尼器的位移Pe=P-P0,P和P0分别是阻尼器的实际位置和中性位置。如消除变量pe,则Zener阻抗控制模型表达式可以化为如下形式
步骤三、建立基于位置的力跟踪阻抗控制模型
图2为基于位置的力跟踪阻抗控制框图。基于位置控制的力跟踪阻抗控制器在位置控制内环的基础上加入力控制外环,将实际接触力和期望接触力的误差信号通过阻抗控制器转换为位置调整量,再通过位置调整量和参考轨迹叠加来调整机器人末端的理想运动轨迹,最后通过位置控制器使机器人末端按计算出的理想运动轨迹运动,进而实现力跟踪。
其中位置控制器可以是现有的任何位置控制器,可以实现对机器人的精确位置控制,即位置控制内环,位置内环输出为机器人位置,机器人位置通过环境模型形成环境实际接触力,期望接触力减去环境实际作用力为力误差信号,力误差信号通过阻抗控制器可以形成位置误差信号,期望位置减去位置误差信号可以获得参考轨迹,将参考轨迹输出位置控制器即可实现对机器人的力跟踪阻抗控制,完成控制闭环。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明公开的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。
Claims (2)
1.一种基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法,其特征在于步骤如下:
步骤1:建立机器人动力学模型和环境模型
所述的机器人动力学模型为:
所述的环境模型为:
其中,Fe为环境作用力,Ke为环境模型的刚度系数,Be为环境模型的阻尼系数,X为机械臂末端位置,Xe为环境位置;
步骤2:建立基于Zener模型的阻抗控制模型
步骤3:建立基于位置的力跟踪阻抗控制模型
所述的基于位置的力跟踪阻抗控制模型包括阻抗控制器、位置控制器、环境模型和机器人,其中位置控制器对机器人进行控制,即控制力F,机器人输出位置X给环境模型,环境模型输出环境作用力Fe,将期望作用力Fd减去环境作用力Fe得到Ef输入到阻抗控制器,阻抗控制器输出Ex,将期望位置Xd减去Ex得到参考轨迹Xr去控制位置控制器。
2.根据权利要求1所述的一种基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法,其特征在于所述的位置控制器为PID控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110750200.9A CN113400313B (zh) | 2021-07-02 | 2021-07-02 | 基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110750200.9A CN113400313B (zh) | 2021-07-02 | 2021-07-02 | 基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113400313A CN113400313A (zh) | 2021-09-17 |
CN113400313B true CN113400313B (zh) | 2022-07-26 |
Family
ID=77680940
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110750200.9A Active CN113400313B (zh) | 2021-07-02 | 2021-07-02 | 基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113400313B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114161402B (zh) * | 2021-12-17 | 2023-11-10 | 深圳市优必选科技股份有限公司 | 机器人稳定控制方法、模型构建方法、装置和机器人 |
CN114789432B (zh) * | 2022-03-31 | 2023-08-29 | 西安交通大学 | 一种面向建筑板材安装的双臂机器人力位混合控制方法 |
CN115674188B (zh) * | 2022-09-20 | 2024-01-12 | 南方电网电力科技股份有限公司 | 基于双路滤波器的串联机械臂精确柔顺开环跟踪控制系统 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5023808A (en) * | 1987-04-06 | 1991-06-11 | California Institute Of Technology | Dual-arm manipulators with adaptive control |
WO2003079138A2 (en) * | 2002-03-04 | 2003-09-25 | The Trustees For Princeton University | Closed-loop apparatuses for non linear system identification via optimal control |
JP2005349555A (ja) * | 2004-06-14 | 2005-12-22 | Toyota Motor Corp | 柔軟関節ロボットアームの制御装置 |
CN1796822A (zh) * | 2004-12-20 | 2006-07-05 | 单明军 | 一种基于可控阻尼的半主动冲击隔离技术 |
CN103201512A (zh) * | 2010-08-11 | 2013-07-10 | 动态能源技术有限责任公司 | 动能控制系统 |
CN106383996A (zh) * | 2016-09-05 | 2017-02-08 | 四川大学 | 肝脏组织弹粘性力学新模型的建立以及基于新模型的应力应变关系和剪切波速度的获得方法 |
CN108527372A (zh) * | 2018-06-22 | 2018-09-14 | 中国科学技术大学 | 一种变刚度串联弹性驱动器的机器人关节自适应控制方法 |
CN110187723A (zh) * | 2019-06-04 | 2019-08-30 | 南京航空航天大学 | 一种刚-柔耦合机电伺服系统的振动控制方法 |
CN111037571A (zh) * | 2019-12-31 | 2020-04-21 | 广东工业大学 | 一种机器人自适应变阻尼阻抗控制方法 |
CN111319036A (zh) * | 2018-12-15 | 2020-06-23 | 天津大学青岛海洋技术研究院 | 基于自适应算法的移动机械臂位置/力自抗扰控制方法 |
-
2021
- 2021-07-02 CN CN202110750200.9A patent/CN113400313B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5023808A (en) * | 1987-04-06 | 1991-06-11 | California Institute Of Technology | Dual-arm manipulators with adaptive control |
WO2003079138A2 (en) * | 2002-03-04 | 2003-09-25 | The Trustees For Princeton University | Closed-loop apparatuses for non linear system identification via optimal control |
JP2005349555A (ja) * | 2004-06-14 | 2005-12-22 | Toyota Motor Corp | 柔軟関節ロボットアームの制御装置 |
CN1796822A (zh) * | 2004-12-20 | 2006-07-05 | 单明军 | 一种基于可控阻尼的半主动冲击隔离技术 |
CN103201512A (zh) * | 2010-08-11 | 2013-07-10 | 动态能源技术有限责任公司 | 动能控制系统 |
CN106383996A (zh) * | 2016-09-05 | 2017-02-08 | 四川大学 | 肝脏组织弹粘性力学新模型的建立以及基于新模型的应力应变关系和剪切波速度的获得方法 |
CN108527372A (zh) * | 2018-06-22 | 2018-09-14 | 中国科学技术大学 | 一种变刚度串联弹性驱动器的机器人关节自适应控制方法 |
CN111319036A (zh) * | 2018-12-15 | 2020-06-23 | 天津大学青岛海洋技术研究院 | 基于自适应算法的移动机械臂位置/力自抗扰控制方法 |
CN110187723A (zh) * | 2019-06-04 | 2019-08-30 | 南京航空航天大学 | 一种刚-柔耦合机电伺服系统的振动控制方法 |
CN111037571A (zh) * | 2019-12-31 | 2020-04-21 | 广东工业大学 | 一种机器人自适应变阻尼阻抗控制方法 |
Non-Patent Citations (1)
Title |
---|
航天结构的约束阻尼振动抑制优选方案研究;杜华军等;《航天控制》;20041030(第05期);第8-11页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113400313A (zh) | 2021-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113400313B (zh) | 基于Zener模型的机器人-环境柔顺接触过程的阻抗控制方法 | |
JP6080643B2 (ja) | ロボット装置、ロボット制御方法、プログラム及び記録媒体 | |
CN110202574A (zh) | 基于环境刚度估计的机器人自适应混合阻抗/导纳控制方法 | |
JP6153372B2 (ja) | ロボット装置、ロボット制御方法、プログラム及び記録媒体 | |
CN111268182B (zh) | 空间双臂机器人约束柔顺稳定控制方法 | |
Cheah et al. | Feedback control for robotic manipulator with uncertain kinematics and dynamics | |
CN108406765B (zh) | 一种开链式多臂机器人阻抗控制方法 | |
Tödtheide et al. | Antagonistic impedance control for pneumatically actuated robot joints | |
CN112936291B (zh) | 一种基于阻抗控制的力控末端执行器振动抑制方法 | |
CN111319042B (zh) | 一种基于遗忘因子动态参数的机器人柔顺装配控制方法 | |
CN110244714A (zh) | 基于滑模控制的机器人单腿摆动相双闭环控制方法 | |
Nguyen et al. | Fingertip force control based on max torque adjustment for dexterous manipulation of an anthropomorphic hand | |
CN112809666A (zh) | 一种基于神经网络的5-dof机械臂力位跟踪算法 | |
Rhee et al. | Hybrid impedance and admittance control of robot manipulator with unknown environment | |
Lee et al. | Model-free force tracking control of piezoelectric actuators: application to variable damping actuator | |
Jäntsch et al. | Adaptive neural network dynamic surface control: An evaluation on the musculoskeletal robot anthrob | |
CN117182929A (zh) | 一种双臂机器人在轨装配的柔顺控制方法及装置 | |
Sekimoto et al. | Experimental study on reaching movements of robot arms with redundant DOFs based upon virtual spring-damper hypothesis | |
Yang et al. | Tip-trajectory tracking control of single-link flexible robots via output redefinition | |
Bei et al. | Adaptive neural network control of flexible robotic with unmodeled dynamics and time-varying output constraints | |
İder et al. | On the stability of inverse dynamics control of flexible-joint parallel manipulators in the presence of modeling error and disturbances | |
Zhang et al. | A multi-priority control of asymmetric coordination for redundant dual-arm robot | |
Ott et al. | A cartesian compliance controller for a manipulator mounted on a flexible structure | |
Lee et al. | Hybrid control scheme for robust tracking of two-link flexible manipulator | |
Kivila et al. | Modeling spatial multi-link flexible manipulator arms based on system modes |
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 |