CN111168677A - 一种仿人柔性手臂系统稳定性控制方法 - Google Patents
一种仿人柔性手臂系统稳定性控制方法 Download PDFInfo
- Publication number
- CN111168677A CN111168677A CN202010019152.1A CN202010019152A CN111168677A CN 111168677 A CN111168677 A CN 111168677A CN 202010019152 A CN202010019152 A CN 202010019152A CN 111168677 A CN111168677 A CN 111168677A
- Authority
- CN
- China
- Prior art keywords
- inertia
- damping
- virtual
- stability
- parameters
- 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.)
- Granted
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
- B25J9/1635—Programme controls characterised by the control loop flexible-arm control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供一种仿人柔性手臂系统稳定性控制方法,采用基于虚拟阻尼、惯量参数的控制方法,属于仿人柔性手臂控制领域。所述方法包括:针对柔性关节因柔性元件的引入造成系统阻尼减小从而使系统稳定性降低的问题,采用引入虚拟阻尼、惯量参数的方法,建立了基于虚拟阻尼、惯量的柔性关节模型,构建引入虚拟阻尼、惯量参数的控制方程,为柔性关节系统增加虚拟惯量和阻尼特性,以提高系统阻尼比,提高系统稳定性。本发明方法通过引入虚拟阻尼、惯量参数的方法,在不增加额外硬件结构和复杂算法的前提下,增大了柔性关节系统阻尼比,提高了仿人柔性手臂系统稳定性,提高了仿人柔性手臂的适应性和实用性。
Description
技术领域
本发明涉及仿人柔性手臂控制领域,具体提供一种仿人柔性手臂系统稳定性控制方法。
背景技术
随着机器人在工业现场、服务行业、航空航天等领域的应用不断扩大,对机器人系统的控制要求越来越高。仿人柔性手臂相较于刚性关节机械臂能够更好地模仿人类手臂的“柔顺性”,可以更好的执行无预设环境的接触性任务。然而,低刚度特性的柔性元件的引入,使仿人柔性手臂系统阻尼明显降低,导致系统稳定性变差,难以达到期望的控制要求,严重的可能导致机械臂失控,造成机械臂损坏或破坏应用现场环境等问题。现有的仿人柔性手臂稳定性控制方法分为被动控制和主动控制,被动控制通常采用改变柔性关节硬件结构以加大关节机械阻尼的方式提高关节系统稳定性,主动控制方法通过增加各类复杂的轨迹跟踪算法,使柔性臂工作在平衡位置附近,来近似认为增加了柔性手臂系统稳定性。而这两类传统的控制方法势必会面临关节硬件结构设计复杂、关节结构重量增加等问题,以及控制器算法实现难度增大、系统响应时间延长等问题,均难以较好的实现提高仿人柔性手臂系统稳定性的目的。
发明内容
本发明的目的是提出一种有效应对仿人柔性手臂稳定性较差的问题的方法,主要解决含有柔性元件的仿人柔性手臂系统的稳定性控制问题。本发明基于虚拟阻尼、惯量的仿人柔性手臂稳定性控制方法,在不引入额外硬件结构的基础上,有效增加了柔性关节系统的阻尼比,缩短了关节受扰动后恢复稳定的时间,提高了关节系统稳定性;且虚拟阻尼、惯量参数的取值不受硬件限制,易于调整、实现。其技术内容包括:
一种仿人柔性手臂系统稳定性控制方法,采用调整虚拟阻尼、惯量参数的方法提高仿人柔性手臂系统的稳定性,其特征在于:
采用调整虚拟阻尼、惯量参数的方法提高仿人柔性手臂系统稳定性的控制方程为:
其中,J*、D*分别为引入的虚拟惯量参数与虚拟阻尼参数;Tref为额定输出转矩,实际控制中与负载转矩相等;Te为驱动电机瞬时电磁转矩,nTe为电机经减速器后输出到扭转弹簧的等效电磁转矩,n为减速器减速比;为连杆转速;为驱动电机经减速器后输出的转速;D*为虚拟阻尼参数,J*为惯量其中J*与系统动态响应速度成反比,D*与系统振荡衰减速度成正比,理论上虚拟参数满足全范围取值,可根据系统期望状态调节虚拟参数的取值,实际应用中受直流测电源性能约束;
引入虚拟阻尼、惯量参数后,柔性关节二阶微分模型的一般形式为:
其中,D为柔性关节总阻尼,表示为D=D1+D*,D1为关节固有阻尼;M为柔性关节总转动惯量,表示为M=I1+Ij1+J*,I1为连杆转动惯量,Ij1为关节固有转动惯量;J为电机转子经减速器后的输出惯量;θ为电机经减速器后转动角度;为电机经减速器后角加速度;q为连杆转动角度;为连杆转动角速度;τm为电机输出力矩;k为弹簧缸扭转弹簧钢度系数;
采用虚拟阻尼、惯量控制的系统自然振荡角频率ωn和阻尼比ξ可表示为:
D1、I1、Ij1为硬件设计固有参数,因此虚拟阻尼参数D*、虚拟惯量参数J*的取值决定系统稳定性,虚拟阻尼参数D*影响系统衰减振荡速度,虚拟惯量参数J*影响系统响应时间;
取ξ*=0.707,获得最优系统稳定性,取△=±2%作为允许误差,系统超调量与调节时间表示为:
本发明有益之处体现于:由上述分析可知:当柔性关节系统突然加速运动时,由虚拟阻尼惯量控制方程可知,虚拟惯量参数J*使关节驱动电机输出力矩增量反映到手臂连杆转速上的变化率降低,J*取值越大,手臂连杆对于驱动系统突然加速带来的应激响应越平缓,从而维持系统的稳定性;当柔性关节系统减速运动时,以驱动电机输出零力矩为例,虚拟阻尼参数D*的存在使驱动电机与手臂连杆的转速差具有了阻尼特性,D*取值越大,转速差值衰减速度越快,从而使手臂连杆追踪驱动电机状态的速度加快,有利于系统快速稳定。
本发明所述基于虚拟阻尼、惯量的控制方法,通过控制算法产生虚拟阻尼、惯量,为关节驱动系统增加虚拟的转子惯性和阻尼特性,等效增加连杆转动阻尼与转动惯量,提高系统阻尼比,以改善手臂连杆动态响应特性,缩短了关节系统振荡衰减时间,提高了系统稳定性。
附图说明
图1是基于虚拟阻尼、惯量的仿人柔性手臂系统稳定性控制方法框图;
图2是典型柔性关节结构示意图。
具体实施方式
下面结合附图对本发明作进一步说明:
一种仿人柔性手臂系统稳定性控制方法,采用基于虚拟阻尼、惯量的方法提高仿人柔性手臂系统的稳定性。基于虚拟阻尼、惯量的仿人柔性手臂系统稳定性控制方法框图如图1所示。采集驱动电机输出信号作为控制器输入信号,采用引入虚拟阻尼、惯量参数的控制方法对检测信号进行计算后,信号作为指令值输入到驱动器,以相应调节驱动电机运行状态。
图2为典型柔性关节结构示意图。在不引入虚拟阻尼、惯量的情况下,采用拉格朗日动力学方程法建立柔性关节模型;
针对1自由度柔性关节进行动力学建模,其二阶微分方程一般形式为:
其中,D1为关节固有阻尼;M1为柔性关节固有转动惯量,表示为M1=I1+Ij1,I1为连杆转动惯量,Ij1为关节固有转动惯量;J为电机转子经减速器后的输出惯量;θ为电机经减速器后转动角度;为电机经减速器后角加速度;为连杆转动角速度;τm为电机输出力矩;
将关节动力学模型线性化,整理为传递函数形式,可写为典型二阶振荡系统,其系统固有自然角频率ωn0和系统固有阻尼比ξ0为:
分析可知,柔性关节系统阻尼比仅受关节硬件结构影响,为固定值;且关节阻尼项较小,无法对维持系统稳定性起明显作用;弹性元件的引入进一步减小了系统阻尼比。因此柔性关节会在运动过程中长时间处于低稳定性状态,严重的可能失去控制。
本发明所述基于虚拟阻尼、惯量的控制方法,通过控制算法产生虚拟阻尼、惯量,为关节驱动系统增加虚拟的转子惯性和阻尼特性,等效增加连杆转动阻尼与转动惯量,以改善手臂连杆动态响应特性,提高系统阻尼比,提高系统稳定性;
虚拟阻尼、惯量控制方法符合方程:
其中,J*、D*分别为引入的虚拟惯量参数与虚拟阻尼参数;Tref为额定输出转矩,实际控制中与负载转矩相等;Te为驱动电机瞬时电磁转矩,nTe为驱动电机经减速器后输出到扭转弹簧的等效电磁力矩,n为减速器减速比;为连杆转速;为驱动电机经减速器后输出的转速。虚拟阻尼、惯量参数J*、D*的引入使关节驱动器具有了阻尼系统振荡的能力,其中J*与动态响应速度成反比,D*与系统振荡衰减速度成正比;而且虚拟阻尼、惯量参数不受硬件约束,可以针对不同运行状态灵活取值;
参数D*、J*是模拟阻尼和惯量特性而引入的虚拟阻尼、惯量参数,其对于柔性关节系统模型的影响,与关节固有阻尼D1及固有惯量M1相同。所以对于柔性关节系统来说,虚拟阻尼、惯量与系统硬件固有阻尼、惯量可实现线性叠加。
因此,引入虚拟阻尼、惯量参数后,柔性关节二阶微分模型的一般形式为:
其中,D为柔性关节总阻尼,表示为D=D1+D*;M为柔性关节总转动惯量,表示为M=I1+Ij1+J*;
此时再将关节模型线性化后,其自然振荡角频率ωn和阻尼比ξ可表示为:
因此,引入虚拟阻尼、惯量参数后,系统阻尼比与关节总阻尼系数D成正比,与关节总惯量M成反比。考虑到D1、I1、Ij1为硬件设计固有参数,因此柔性关节阻尼比可由虚拟阻尼参数D*及虚拟惯量参数J*决定,虚拟阻尼参数D*影响系统衰减振荡速度,虚拟惯量参数J*影响系统响应时间,相应改变参数取值,即可调节系统稳定状态。D*、J*理论上可全范围取值,实际应用中受直流测电源性能的限制,可根据手臂驱动系统硬件条件确定虚拟参数的取值范围。
调整D*、J*取值,将系统阻尼比按照“最优二阶系统”理论整定为ξ*=0.707,系统将获得最优响应速度和超调量,并以此获得最优的系统稳定性能。取△=±2%作为允许误差,系统超调量与调节时间表示为:
由上述分析可知:当柔性关节系统突然加速运动时,由虚拟阻尼惯量控制方程可知,虚拟惯量参数J*使关节驱动电机输出力矩增量反映到手臂连杆转速上的变化率降低,J*取值越大,手臂连杆对于驱动系统突然加速带来的应激响应越平缓,从而维持系统的稳定性;当柔性关节系统减速运动时,以驱动电机输出零力矩为例,虚拟阻尼参数D*的存在使驱动电机与手臂连杆的转速差具有了阻尼特性,D*取值越大,转速差值衰减速度越快,从而使手臂连杆追踪驱动电机状态的速度加快,有利于系统快速稳定。
本发明所述基于虚拟阻尼、惯量的控制方法,通过控制算法产生虚拟阻尼、惯量,为关节驱动系统增加虚拟的转子惯性和阻尼特性,等效增加连杆转动阻尼与转动惯量,提高系统阻尼比,以改善手臂连杆动态响应特性,缩短了关节系统振荡衰减时间,提高了系统稳定性。
Claims (1)
1.一种仿人柔性手臂系统稳定性控制方法,采用调整虚拟阻尼、惯量参数的方法提高仿人柔性手臂系统的稳定性,其特征在于:
采用调整虚拟阻尼、惯量参数的方法提高仿人柔性手臂系统稳定性的控制方程为:
其中,J*、D*分别为引入的虚拟惯量参数与虚拟阻尼参数;Tref为额定输出转矩,实际控制中与负载转矩相等;Te为驱动电机瞬时电磁转矩,nTe为电机经减速器后输出到扭转弹簧的等效电磁转矩,n为减速器减速比;为连杆转速;为驱动电机经减速器后输出的转速;D*为虚拟阻尼参数,J*为惯量其中J*与系统动态响应速度成反比,D*与系统振荡衰减速度成正比,理论上虚拟参数满足全范围取值,可根据系统期望状态调节虚拟参数的取值,实际应用中受直流测电源性能约束;
引入虚拟阻尼、惯量参数后,柔性关节二阶微分模型的一般形式为:
其中,D为柔性关节总阻尼,表示为D=D1+D*,D1为关节固有阻尼;M为柔性关节总转动惯量,表示为M=I1+Ij1+J*,I1为连杆转动惯量,Ij1为关节固有转动惯量;J为电机转子经减速器后的输出惯量;θ为电机经减速器后转动角度;为电机经减速器后角加速度;q为连杆转动角度;为连杆转动角速度;τm为电机输出力矩;k为弹簧缸扭转弹簧钢度系数;
采用虚拟阻尼、惯量控制的系统自然振荡角频率ωn和阻尼比ξ可表示为:
D1、I1、Ij1为硬件设计固有参数,因此虚拟阻尼参数D*、虚拟惯量参数J*的取值决定系统稳定性,虚拟阻尼参数D*影响系统衰减振荡速度,虚拟惯量参数J*影响系统响应时间;
取ξ*=0.707,获得最优系统稳定性,取△=±2%作为允许误差,系统超调量与调节时间表示为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010019152.1A CN111168677B (zh) | 2020-01-08 | 2020-01-08 | 一种仿人柔性手臂系统稳定性控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010019152.1A CN111168677B (zh) | 2020-01-08 | 2020-01-08 | 一种仿人柔性手臂系统稳定性控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111168677A true CN111168677A (zh) | 2020-05-19 |
CN111168677B CN111168677B (zh) | 2022-09-16 |
Family
ID=70649322
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010019152.1A Active CN111168677B (zh) | 2020-01-08 | 2020-01-08 | 一种仿人柔性手臂系统稳定性控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111168677B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070073442A1 (en) * | 2005-09-28 | 2007-03-29 | Canadian Space Agency | Robust impedance-matching of manipulators interacting with unknown environments |
US20100286826A1 (en) * | 2008-02-28 | 2010-11-11 | Yuko Tsusaka | Control apparatus and control method for robot arm, robot, control program for robot arm, and integrated electronic circuit for controlling robot arm |
JP2013000856A (ja) * | 2011-06-20 | 2013-01-07 | Seiko Epson Corp | ロボット制御システム、ロボットシステム |
CN103118842A (zh) * | 2011-03-17 | 2013-05-22 | 松下电器产业株式会社 | 机器人、机器人的控制装置、控制方法以及控制程序 |
US20170014997A1 (en) * | 2015-07-13 | 2017-01-19 | Kuka Roboter Gmbh | Controlling A Compliant-Controlled Robot |
CN106737669A (zh) * | 2016-12-12 | 2017-05-31 | 杭州宇芯机器人科技有限公司 | 考虑外力冲击干扰和阻尼的多足机器人能量裕度计算方法 |
CN108393888A (zh) * | 2017-02-06 | 2018-08-14 | 精工爱普生株式会社 | 控制装置、机器人以及机器人系统 |
CN109922931A (zh) * | 2016-11-11 | 2019-06-21 | 精工爱普生株式会社 | 机器人控制装置、机器人、机器人系统及机器人控制方法 |
CN110405761A (zh) * | 2019-07-22 | 2019-11-05 | 北京理工大学 | 一种机器人关节的仿生粘弹性控制方法 |
CN110597072A (zh) * | 2019-10-22 | 2019-12-20 | 上海电气集团股份有限公司 | 机器人导纳柔顺控制方法及系统 |
WO2020001742A1 (en) * | 2018-06-26 | 2020-01-02 | Franka Emika Gmbh | Device for controlling a robot manipulator |
-
2020
- 2020-01-08 CN CN202010019152.1A patent/CN111168677B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070073442A1 (en) * | 2005-09-28 | 2007-03-29 | Canadian Space Agency | Robust impedance-matching of manipulators interacting with unknown environments |
US20100286826A1 (en) * | 2008-02-28 | 2010-11-11 | Yuko Tsusaka | Control apparatus and control method for robot arm, robot, control program for robot arm, and integrated electronic circuit for controlling robot arm |
CN103118842A (zh) * | 2011-03-17 | 2013-05-22 | 松下电器产业株式会社 | 机器人、机器人的控制装置、控制方法以及控制程序 |
JP2013000856A (ja) * | 2011-06-20 | 2013-01-07 | Seiko Epson Corp | ロボット制御システム、ロボットシステム |
US20170014997A1 (en) * | 2015-07-13 | 2017-01-19 | Kuka Roboter Gmbh | Controlling A Compliant-Controlled Robot |
CN109922931A (zh) * | 2016-11-11 | 2019-06-21 | 精工爱普生株式会社 | 机器人控制装置、机器人、机器人系统及机器人控制方法 |
CN106737669A (zh) * | 2016-12-12 | 2017-05-31 | 杭州宇芯机器人科技有限公司 | 考虑外力冲击干扰和阻尼的多足机器人能量裕度计算方法 |
CN108393888A (zh) * | 2017-02-06 | 2018-08-14 | 精工爱普生株式会社 | 控制装置、机器人以及机器人系统 |
WO2020001742A1 (en) * | 2018-06-26 | 2020-01-02 | Franka Emika Gmbh | Device for controlling a robot manipulator |
CN110405761A (zh) * | 2019-07-22 | 2019-11-05 | 北京理工大学 | 一种机器人关节的仿生粘弹性控制方法 |
CN110597072A (zh) * | 2019-10-22 | 2019-12-20 | 上海电气集团股份有限公司 | 机器人导纳柔顺控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN111168677B (zh) | 2022-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Na et al. | Output feedback control of uncertain hydraulic servo systems | |
CN109664297B (zh) | 机器人的振动抑制方法、系统、装置及计算机可读存储器 | |
Li et al. | Aeroelastic dynamic response and control of an airfoil section with control surface nonlinearities | |
CN110034707B (zh) | 一种低速直驱永磁电机伺服系统的转矩脉动抑制方法 | |
CN110027378B (zh) | 汽车主动悬架电磁作动器抗饱和复合控制器及构造方法 | |
CN111037573B (zh) | 一种仿人柔性关节手臂的振动抑制方法 | |
CN112897338A (zh) | 一种欠驱动双摆塔式起重机轨迹跟踪与摆动抑制控制方法 | |
Chang et al. | On the adaptive control of flexible joint robots | |
CN114536334A (zh) | 一种柔性机械臂系统高阶滑模抗干扰控制方法 | |
CN102790580B (zh) | 无轴承异步电机支持向量机逆解耦控制器的构造方法 | |
CN111055285B (zh) | 一种仿人柔性关节手臂变负载工况下的振动抑制方法 | |
CN114939869A (zh) | 一种基于非奇异快速终端滑模的机械臂轨迹跟踪方法 | |
CN114859708A (zh) | 一种单连杆柔性机械臂跟踪控制方法 | |
CN111168677B (zh) | 一种仿人柔性手臂系统稳定性控制方法 | |
KR20000048977A (ko) | 수치 제어되는 탄성 다중 매스 시스템의 모우먼트를 제어하기 위한 방법 및 제어 장치 | |
CN102790578B (zh) | 无轴承异步电机神经网络广义逆解耦控制器的构造方法 | |
CN110802602B (zh) | 一种基于pi控制策略的机械臂柔性关节位姿变换抑振方法 | |
Hutterer et al. | Control of a flexible magnetic levitated rotor using the computed torque method in combination with stabilizing filters | |
Receanu | Modeling and simulation of the nonlinear computed torque control in simulink/MATLAB for an industrial robot | |
CN113341702B (zh) | 一种飞机舵机电动伺服系统复合控制方法 | |
Lu et al. | Mechanical Resonance Suppression based on Self-tuning Notch Filter for Servo System | |
Panza et al. | Hydraulic actuator tuning in the control of a rotating flexible beam mechanism | |
Fu et al. | Vibration Suppression of Electromechanical Actuator Considering Backlash Nonlinearity | |
CN110543096B (zh) | 一种适用于电动模拟加载系统的力反馈复合控制方法 | |
Phakamach et al. | An optimal feedforward integral variable structure controller for the electrohydraulic position servo control systems |
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 |