CN110273876B - 针对阀控缸力阻抗控制***的外环阻抗补偿方法及*** - Google Patents

针对阀控缸力阻抗控制***的外环阻抗补偿方法及*** Download PDF

Info

Publication number
CN110273876B
CN110273876B CN201910588647.3A CN201910588647A CN110273876B CN 110273876 B CN110273876 B CN 110273876B CN 201910588647 A CN201910588647 A CN 201910588647A CN 110273876 B CN110273876 B CN 110273876B
Authority
CN
China
Prior art keywords
impedance
force
valve
cylinder
control system
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
Application number
CN201910588647.3A
Other languages
English (en)
Other versions
CN110273876A (zh
Inventor
巴凯先
俞滨
金正国
马国梁
娄文韬
李化顺
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yanshan University
Original Assignee
Yanshan University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yanshan University filed Critical Yanshan University
Priority to CN201910588647.3A priority Critical patent/CN110273876B/zh
Publication of CN110273876A publication Critical patent/CN110273876A/zh
Application granted granted Critical
Publication of CN110273876B publication Critical patent/CN110273876B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B13/00—Details of servomotor systems ; Valves for servomotor systems
    • F15B13/02—Fluid distribution or supply devices characterised by their adaptation to the control of servomotors
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B13/00—Details of servomotor systems ; Valves for servomotor systems
    • F15B13/16—Special measures for feedback, e.g. by a follow-up device
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B19/00—Testing; Calibrating; Fault detection or monitoring; Simulation or modelling of fluid-pressure systems or apparatus not otherwise provided for
    • F15B19/007—Simulation or modelling

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Fluid Mechanics (AREA)
  • Mechanical Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Servomotors (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种针对阀控缸力阻抗控制***的外环阻抗补偿方法及***。所述补偿方法包括获取阀控缸力阻抗控制***的外环阻抗、阀控缸力阻抗控制***数学模型以及阀控缸伺服缸参数；根据所述外环阻抗确定补偿控制策略；根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数；根据所述补偿控制策略以及多个所述传递函数确定补偿控制器；根据所述补偿控制器对所述阀控缸力阻抗控制***的外环阻抗进行补偿，确定补偿后的外环阻抗；采用本发明所提供的补偿方法及***能够提高高集成性阀控缸力阻抗控制***的控制精度，改善了传统力阻抗控制***的鲁棒性，且具有很好的工程实用性。

Description

针对阀控缸力阻抗控制***的外环阻抗补偿方法及***
技术领域
本发明涉及流体传动与控制领域，特别是涉及一种用于液压驱动型足式机器人的针对高集成性阀控缸力阻抗控制***的外环阻抗补偿方法及***。
背景技术
阀控缸***是液压***中最为常用的组成形式之一，在航空航天、冶金、工程机械、农业机械、先进制造等领域有着广泛应用，而高集成性阀控缸作为更高功率密度的阀控缸结构，其在航空作动器、高性能足式机器人等应用对象上具有无可比拟的优势；但以上应用对象不同于传统的民用机械设备，其应具备杰出的控制性能，以保证其能在复杂的环境下具有很好的适应性，这使得高集成性阀控缸应具有轻量化、高响应等特点，同时关于高集成性阀控缸的结构设计优化和补偿控制方法的研究也更具有现实意义。
足式机器人在实际运动过程中所使用的一种常用控制方法为阻抗控制，其控制目的是使机器人腿部关节具备一定的柔顺性，使机器人整条腿等效为一种具备期望刚度、阻尼和质量的二阶质量-弹簧-阻尼***，该种控制方法已经成功应用于多个电机驱动的足式机器人领域中，如：Tekken、Scout、KOLT、MIT cheetahrobot、spotmini等。近年来，随着液压驱动的足式机器人逐渐成为研究热点，阻抗控制方法也应用在了这类机器人中，如：Bigdog，HyQ，Scalf-1，LWRrobot，StarlETH，Atlas等；传统的阻抗控制的基本实现原理都是以液压控制***作为控制内环，当***受到外干扰作用时，通过阻抗控制外环，对外干扰信号进行信号转换(通常情况下是位置与力之间的转换)以改变内环的输入，从而使***实现阻抗参数；机器人行走在不同环境工况下时，腿部所需要实现的阻抗参数各不相同，如果机器人腿部不能实现期望的阻抗参数，那么势必会对其缓冲效果、步态、稳定性和行走速度等方面产生不利影响，所以机器人腿部阻抗控制的精度十分重要。
但实际情况下，由于液压***数学模型阶数较高，且具有固有的非线性、参数时变性、强耦合性以及负载复杂多变性，在多因素的共同作用下，导致传统的阻抗控制方法在液压***中很难具有令人满意的控制精度，且抗干扰性能低。
发明内容
本发明的目的是提供一种针对阀控缸力阻抗控制***的外环阻抗补偿方法及***，以解决传统的阻抗控制方法在液压***中控制精度以及抗干扰性能低的问题。
为实现上述目的，本发明提供了如下方案：
一种针对阀控缸力阻抗控制***的外环阻抗补偿方法，包括：
获取阀控缸力阻抗控制***的外环阻抗、阀控缸力阻抗控制***数学模型以及阀控缸伺服缸参数；所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积；
根据所述外环阻抗确定补偿控制策略；
根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数；
根据所述补偿控制策略以及多个所述传递函数确定补偿控制器；
根据所述补偿控制器对所述阀控缸力阻抗控制***的外环阻抗进行补偿，确定补偿后的外环阻抗。
可选的，所述根据所述外环阻抗确定补偿控制策略，具体包括：
根据所述外环阻抗，确定所述外环阻抗对应的内环的期望力；
获取输入所述阀控缸力阻抗控制***的输入力；
根据所述输入力对所述外环阻抗进行补偿，确定新的外环阻抗；
在所述新的外环阻抗的作用下，将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力；
在所述新的外环阻抗对应的内环的期望力的作用下，使得所述阀控缸力阻抗控制***的输出力等于所述外环阻抗对应的内环的期望力，确定补偿控制策略。
可选的，所述根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数，具体包括：
根据公式
Figure GDA0002448019000000031
Figure GDA0002448019000000032
以及
Figure GDA0002448019000000033
确定所述阀控缸力阻抗控制***的多个传递函数；其中，G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制***的传递函数；Kaxv为伺服阀增益；Ap为伺服缸有效活塞面积；mt为折算到伺服缸活塞上总质量，包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和；s为拉氏算子；Bp为负载阻尼；K为负载刚度；
Figure GDA0002448019000000034
k1和k2为压力流量非线性折算系数；Kd为微分增益；ps为阀控缸力阻抗控制***供油压力；p1为伺服缸的左腔压力；p2为伺服缸的右腔压力；p0为阀控缸力阻抗控制***回油压力；xv为伺服阀阀芯位移；V1为进油腔容积；V2为回油腔容积；βe为有效体积弹性模量；ω为伺服阀的固有频率；ζ为伺服阀阻尼比；Cip为伺服缸的内泄漏系数。
可选的，所述根据所述补偿控制策略以及多个所述传递函数确定补偿控制器，具体包括：
根据公式
Figure GDA0002448019000000035
确定补偿控制器；其中，GMVIPC(s)为补偿控制器；Z′D为新的外环阻抗；ZD为所述阀控缸力阻抗控制***的外环阻抗；KF为力传感器增益；GPID(s)为PID控制器；XL为干扰位置；Fr为输入力。
一种针对阀控缸力阻抗控制***的外环阻抗补偿***，包括：
参数获取模块，用于获取阀控缸力阻抗控制***的外环阻抗、阀控缸力阻抗控制***数学模型以及阀控缸伺服缸参数；所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积；
补偿控制策略确定模块，用于根据所述外环阻抗确定补偿控制策略；
传递函数确定模块，用于根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数；
补偿控制器确定模块，用于根据所述补偿控制策略以及多个所述传递函数确定补偿控制器；
补偿后的外环阻抗确定模块，用于根据所述补偿控制器对所述阀控缸力阻抗控制***的外环阻抗进行补偿，确定补偿后的外环阻抗。
可选的，所述补偿控制策略确定模块具体包括：
外环阻抗对应的内环的期望力确定单元，用于根据所述外环阻抗，确定所述外环阻抗对应的内环的期望力；
输入力获取单元，用于获取输入所述阀控缸力阻抗控制***的输入力；
新的外环阻抗确定单元，用于根据所述输入力对所述外环阻抗进行补偿，确定新的外环阻抗；
新的外环阻抗对应的内环的期望力确定单元，用于在所述新的外环阻抗的作用下，将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力；
补偿控制策略确定单元，用于在所述新的外环阻抗对应的内环的期望力的作用下，使得所述阀控缸力阻抗控制***的输出力等于所述外环阻抗对应的内环的期望力，确定补偿控制策略。
可选的，所述传递函数确定模块具体包括：
传递函数确定单元，用于根据公式
Figure GDA0002448019000000051
Figure GDA0002448019000000052
以及
Figure GDA0002448019000000053
确定所述阀控缸力阻抗控制***的多个传递函数；其中，G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制***的传递函数；Kaxv为伺服阀增益；Ap为伺服缸有效活塞面积；mt为折算到伺服缸活塞上总质量，包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和；s为拉氏算子；Bp为负载阻尼；K为负载刚度；
Figure GDA0002448019000000055
k1和k2为压力流量非线性折算系数；Kd为微分增益；ps为阀控缸力阻抗控制***供油压力；p1为伺服缸的左腔压力；p2为伺服缸的右腔压力；p0为阀控缸力阻抗控制***回油压力；xv为伺服阀阀芯位移；V1为进油腔容积；V2为回油腔容积；βe为有效体积弹性模量；ω为伺服阀的固有频率；ζ为伺服阀阻尼比；Cip为伺服缸的内泄漏系数。
可选的，所述补偿控制器确定模块具体包括：
补偿控制器确定单元，用于根据公式
Figure GDA0002448019000000054
确定补偿控制器；其中，GMVIPC(s)为补偿控制器；Z′D为新的外环阻抗；ZD为所述阀控缸力阻抗控制***的外环阻抗；KF为力传感器增益；GPID(s)为PID控制器；XL为干扰位置；Fr为输入力。
根据本发明提供的具体实施例，本发明公开了以下技术效果：本发明提供了一种针对阀控缸力阻抗控制***的外环阻抗补偿方法及***，对阀控缸力阻抗控制***数学模型进行了简化，分离成多个传递函数，降低数学模型复杂度，并根据外环阻抗确定了补偿控制策略，本发明基于机理建模方法，通过改变阻抗参数，使干扰位置作用到阀控缸力阻抗控制***产生新的期望力，当新的期望力输入到阀控缸力阻抗控制***之后，阀控缸力阻抗控制***新产生的输出力可以更接近于阻抗期望力，从而提高了高集成性阀控缸力阻抗控制***的控制精度，极大地改善了传统力阻抗控制***的鲁棒性，且具有很好的工程实用性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为本发明所提供的针对阀控缸力阻抗控制***的外环阻抗补偿方法流程图；
图2为本发明所提供的外环阻抗补偿控制策略示意图；
图3为本发明所提供的高集成性阀控缸力阻抗控制传递框图；
图4为本发明所提供的图3简化的高集成性阀控缸力阻抗控制传递框图；
图5为本发明所提供的加入补偿控制器后的力阻抗控制传递框图；
图6为本发明所提供的针对阀控缸力阻抗控制***的外环阻抗补偿***结构图。
其中，ω——伺服阀的固有频率；ζ——伺服阀阻尼比；
Figure GDA0002448019000000061
——等效流量系数；Cd——流量系数；W——面积梯度；ρ——液压油的密度；ps——阀控缸力阻抗控制***供油压力；p1——伺服缸的左腔压力；p2——伺服缸的右腔压力；p0——阀控缸力阻抗控制***回油压力；L——伺服缸活塞总行程；L0——高集成性阀控缸伺服缸活塞初始位置；Cip——伺服缸的内泄漏系数；Cep——伺服缸的外泄漏系数；Ap——伺服缸有效活塞面积；βe——有效体积弹性模量；mt——折算到伺服缸活塞上总质量，包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液以及其它动件的折算质量和；Fr——输入力；KF——力传感器增益；KPID——PID控制器增益；Kaxv——伺服阀增益；K——负载刚度；Bp——负载阻尼；XL——干扰位置；Xv——伺服阀阀芯位移；Xp——伺服缸活塞位移；Vg1——伺服阀与伺服缸进油管连接流道容积；Vg2——伺服阀与伺服缸回油管连接流道容积；Ff——摩擦力；Q1——伺服缸左腔流量；Q2——伺服缸右腔流量；Fd——期望力；Fd′——新的期望力；Fp——伺服缸输出力；Fp′——伺服缸新的输出力；ZD——外环阻抗；Z′D——新的外环阻抗；GMVIPC(s)——变阻抗参数的补偿控制器。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明的目的是提供一种针对阀控缸力阻抗控制***的外环阻抗补偿方法及***，能够降低高集成性阀控缸力阻抗控制***数学模型的阶数，提高控制精度以及抗干扰性能。
为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。
图1为本发明所提供的针对阀控缸力阻抗控制***的外环阻抗补偿方法流程图，如图1所示，一种针对阀控缸力阻抗控制***的外环阻抗补偿方法，包括：
步骤101：获取阀控缸力阻抗控制***的外环阻抗、阀控缸力阻抗控制***数学模型以及阀控缸伺服缸参数；所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积等。
步骤102：根据所述外环阻抗确定补偿控制策略。
阀控缸力阻抗控制***的高集成性阀控缸主要由力传感器、位移传感器、伺服阀和伺服缸四部分组成，其中位置传感器检测力阻抗控制***所受的干扰位置XL，力传感器检测***输出力Fp，用于实现力闭环控制。
当高集成性阀控缸仅采用PID控制器时，力阻抗控制***虽可以实现在不同输入信号下实现力跟随，但是在不同位置干扰信号下，力控鲁棒性较差，此时高集成性阀控缸所具有的力阻抗控制性能无法满足高精度和高鲁棒性的力伺服控制需求。究其原因，是因为液压***的强非线性，参数时变性，油液可压缩性和负载复杂多变性等方面的因素，当***存在未知且不可控的负载干扰时，力控制内环的控制精度较差，从而影响***的整体阻抗控制性能。
针对上述问题，本发明提供了外环阻抗参数补偿控制策略，如图2所示，通过对外环阻抗参数ZD进行补偿使之变为ZD′，从而干扰位置在ZD′的作用下，使内环的期望力Fd变为新期望力Fd′，在Fd′的作用下***产生的输出力Fp′可以趋近于期望阻抗参数ZD产生的期望力Fd，从而提高了高集成性阀控缸力阻抗控制***的性能。
步骤103：根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数。
图3为本发明所提供的高集成性阀控缸力阻抗控制传递框图，如图3所示，由此可知，阀控缸力阻抗控制***数学模型非常复杂，且无法分离出***各部分传递函数，所以需要对***数学模型进行整理简化，经过简化的数学模型并没有改变模型的精度，只是分离出***各部分传递函数，阀控缸力阻抗控制***数学模型简化后不会影响控制效果，反而能够减轻运算程序，提高运行速度及控制精度；其中，图3中KPID为PID控制器增益；Vg1为伺服阀与伺服缸进油管连接流道容积；Vg2为伺服阀与伺服缸回油管连接流道容积；Ff为摩擦力；Q1为伺服缸左腔流量；Q2为伺服缸右腔流量；Xp为伺服缸活塞位移；L为伺服缸活塞总行程；L0为高集成性阀控缸伺服缸活塞初始位置；Cep为伺服缸的外泄漏系数；
Figure GDA0002448019000000091
为等效流量系数；Cd为流量系数；W为面积梯度；ρ为液压油的密度；
图4为本发明所提供的图3简化的高集成性阀控缸力阻抗控制传递框图，图4中***传递函数G1(s)、G2(s)和Gx(s)如下所示：
Figure GDA0002448019000000092
Figure GDA0002448019000000093
其中，G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制***的传递函数；Kaxv为伺服阀增益；Ap为伺服缸有效活塞面积；mt为折算到伺服缸活塞上总质量，包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和；s为拉氏算子；Bp为负载阻尼；K为负载刚度；
Figure GDA0002448019000000094
k1和k2为压力流量非线性折算系数Kd为微分增益；ps为阀控缸力阻抗控制***供油压力；p1为伺服缸的左腔压力；p2为伺服缸的右腔压力；p0为阀控缸力阻抗控制***回油压力；xv为伺服阀阀芯位移；V1为进油腔容积；V2为回油腔容积；βe为有效体积弹性模量；ω为伺服阀的固有频率；ζ为伺服阀阻尼比；Cip为伺服缸的内泄漏系数。
步骤104：根据所述补偿控制策略以及多个所述传递函数确定补偿控制器。
图5为本发明所提供的加入补偿控制器后的力阻抗控制传递框图，如图5所示，Ⅰ、Ⅱ以及Ⅲ表示***控制框图中的位置，Φ1′(s)为Ⅱ到Ⅰ的传递函数，其可表示为
Figure GDA0002448019000000101
将上式做如下变换可得
Figure GDA0002448019000000102
Φ2(s)为Ⅱ到Ⅲ的传递函数，其可表示为
Figure GDA0002448019000000103
Φ2(s)的误差传递函数为E2(s)，则其可表示为
Figure GDA0002448019000000104
为了使被控阀控缸力阻抗控制***变为无误差的***，需要Φ2(s)的误差传递函数E2(s)等于零，则可以得到新的阻抗参数ZD′：
Figure GDA0002448019000000105
则补偿控制器GMVIPC(s)可表示为
Figure GDA0002448019000000106
步骤105：根据所述补偿控制器对所述阀控缸力阻抗控制***的外环阻抗进行补偿，确定补偿后的外环阻抗。
本发明基于液压***的强非线性，参数时变性，油液可压缩性和负载复杂多变性等方面的因素，基于机理建模的方法，提供了一种通过动态改变外环阻抗参数提高力控***鲁棒性的补偿控制策略，通过动态的改变外环的阻抗参数，提高了高集成性阀控缸力阻抗控制***的鲁棒性和控制精度；极大地改善了传统的力阻抗控制性能，且具有较好的工程实用性和多工况适应。
图6为本发明所提供的针对阀控缸力阻抗控制***的外环阻抗补偿***结构图，如图6所示，一种针对阀控缸力阻抗控制***的外环阻抗补偿***，包括：
参数获取模块601，用于获取阀控缸力阻抗控制***的外环阻抗、阀控缸力阻抗控制***数学模型以及阀控缸伺服缸参数；所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积。
补偿控制策略确定模块602，用于根据所述外环阻抗确定补偿控制策略。
所述补偿控制策略确定模块602具体包括：外环阻抗对应的内环的期望力确定单元，用于根据所述外环阻抗，确定所述外环阻抗对应的内环的期望力；输入力获取单元，用于获取输入所述阀控缸力阻抗控制***的输入力；新的外环阻抗确定单元，用于根据所述输入力对所述外环阻抗进行补偿，确定新的外环阻抗；新的外环阻抗对应的内环的期望力确定单元，用于在所述新的外环阻抗的作用下，将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力；补偿控制策略确定单元，用于在所述新的外环阻抗对应的内环的期望力的作用下，使得所述阀控缸力阻抗控制***的输出力等于所述外环阻抗对应的内环的期望力，确定补偿控制策略。
传递函数确定模块603，用于根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数。
所述传递函数确定模块603具体包括：传递函数确定单元，用于根据公式
Figure GDA0002448019000000121
Figure GDA0002448019000000122
以及
Figure GDA0002448019000000123
确定所述阀控缸力阻抗控制***的多个传递函数；其中，G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制***的传递函数；Kaxv为伺服阀增益；Ap为伺服缸有效活塞面积；mt为折算到伺服缸活塞上总质量，包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和；s为拉氏算子；Bp为负载阻尼；K为负载刚度；
Figure GDA0002448019000000124
k1和k2为压力流量非线性折算系数；Kd为微分增益；ps为阀控缸力阻抗控制***供油压力；p1为伺服缸的左腔压力；p2为伺服缸的右腔压力；p0为阀控缸力阻抗控制***回油压力；xv为伺服阀阀芯位移；V1为进油腔容积；V2为回油腔容积；βe为有效体积弹性模量；ω为伺服阀的固有频率；ζ为伺服阀阻尼比；Cip为伺服缸的内泄漏系数。
补偿控制器确定模块604，用于根据所述补偿控制策略以及多个所述传递函数确定补偿控制器。
所述补偿控制器确定模块604具体包括：补偿控制器确定单元，用于根据公式
Figure GDA0002448019000000125
确定补偿控制器；其中，GMVIPC(s)为补偿控制器；Z′D为新的外环阻抗；ZD为所述阀控缸力阻抗控制***的外环阻抗；KF为力传感器增益；GPID(s)为PID控制器；XL为干扰位置；Fr为输入力。
补偿后的外环阻抗确定模块605，用于根据所述补偿控制器对所述阀控缸力阻抗控制***的外环阻抗进行补偿，确定补偿后的外环阻抗。
本发明极大地改善了传统力阻抗控制***的鲁棒性，且具有较好的工程实用性。
本说明书中各个实施例采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似部分互相参见即可。对于实施例公开的***而言，由于其与实施例公开的方法相对应，所以描述的比较简单，相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处。综上所述，本说明书内容不应理解为对本发明的限制。

Claims (8)

1.一种针对阀控缸力阻抗控制***的外环阻抗补偿方法，其特征在于，包括：
获取阀控缸力阻抗控制***的外环阻抗、阀控缸力阻抗控制***数学模型以及阀控缸伺服缸参数；所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸的左腔压力、伺服缸的右腔压力、阀控缸力阻抗控制***回油压力以及伺服缸有效活塞面积；
根据所述外环阻抗确定补偿控制策略；
根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数；
根据所述补偿控制策略以及多个所述传递函数确定补偿控制器；
根据所述补偿控制器对所述阀控缸力阻抗控制***的外环阻抗进行补偿，确定补偿后的外环阻抗。
2.根据权利要求1所述的针对阀控缸力阻抗控制***的外环阻抗补偿方法，其特征在于，所述根据所述外环阻抗确定补偿控制策略，具体包括：
根据所述外环阻抗，确定所述外环阻抗对应的内环的期望力；
获取输入所述阀控缸力阻抗控制***的输入力；
根据所述输入力对所述外环阻抗进行补偿，确定新的外环阻抗；
在所述新的外环阻抗的作用下，将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力；
在所述新的外环阻抗对应的内环的期望力的作用下，使得所述阀控缸力阻抗控制***的输出力等于所述外环阻抗对应的内环的期望力，确定补偿控制策略。
3.根据权利要求2所述的针对阀控缸力阻抗控制***的外环阻抗补偿方法，其特征在于，所述根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数，具体包括：
根据公式
Figure FDA0002448018990000021
Figure FDA0002448018990000022
以及
Figure FDA0002448018990000023
确定所述阀控缸力阻抗控制***的多个传递函数；其中，G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制***的传递函数；Kaxv为伺服阀增益；Ap为伺服缸有效活塞面积；mt为折算到伺服缸活塞上总质量，包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和；s为拉氏算子；Bp为负载阻尼；K为负载刚度；
Figure FDA0002448018990000024
k1和k2为压力流量非线性折算系数；Kd为微分增益；ps为阀控缸力阻抗控制***供油压力；p1为伺服缸的左腔压力；p2为伺服缸的右腔压力；p0为阀控缸力阻抗控制***回油压力；xv为伺服阀阀芯位移；V1为进油腔容积；V2为回油腔容积；βe为有效体积弹性模量；ω为伺服阀的固有频率；ζ为伺服阀阻尼比；Cip为伺服缸的内泄漏系数。
4.根据权利要求3所述的针对阀控缸力阻抗控制***的外环阻抗补偿方法，其特征在于，所述根据所述补偿控制策略以及多个所述传递函数确定补偿控制器，具体包括：
根据公式
Figure FDA0002448018990000025
确定补偿控制器；其中，GMVIPC(s)为补偿控制器；Z′D为新的外环阻抗；ZD为所述阀控缸力阻抗控制***的外环阻抗；KF为力传感器增益；GPID(s)为PID控制器；XL为干扰位置；Fr为输入力。
5.一种针对阀控缸力阻抗控制***的外环阻抗补偿***，其特征在于，包括：
参数获取模块，用于获取阀控缸力阻抗控制***的外环阻抗、阀控缸力阻抗控制***数学模型以及阀控缸伺服缸参数；所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸的左腔压力、伺服缸的右腔压力、阀控缸力阻抗控制***回油压力以及伺服缸有效活塞面积；
补偿控制策略确定模块，用于根据所述外环阻抗确定补偿控制策略；
传递函数确定模块，用于根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制***数学模型进行简化分离，确定所述阀控缸力阻抗控制***的多个传递函数；
补偿控制器确定模块，用于根据所述补偿控制策略以及多个所述传递函数确定补偿控制器；
补偿后的外环阻抗确定模块，用于根据所述补偿控制器对所述阀控缸力阻抗控制***的外环阻抗进行补偿，确定补偿后的外环阻抗。
6.根据权利要求5所述的针对阀控缸力阻抗控制***的外环阻抗补偿***，其特征在于，所述补偿控制策略确定模块具体包括：
外环阻抗对应的内环的期望力确定单元，用于根据所述外环阻抗，确定所述外环阻抗对应的内环的期望力；
输入力获取单元，用于获取输入所述阀控缸力阻抗控制***的输入力；
新的外环阻抗确定单元，用于根据所述输入力对所述外环阻抗进行补偿，确定新的外环阻抗；
新的外环阻抗对应的内环的期望力确定单元，用于在所述新的外环阻抗的作用下，将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力；
补偿控制策略确定单元，用于在所述新的外环阻抗对应的内环的期望力的作用下，使得所述阀控缸力阻抗控制***的输出力等于所述外环阻抗对应的内环的期望力，确定补偿控制策略。
7.根据权利要求6所述的针对阀控缸力阻抗控制***的外环阻抗补偿***，其特征在于，所述传递函数确定模块具体包括：
传递函数确定单元，用于根据公式
Figure FDA0002448018990000041
Figure FDA0002448018990000042
以及
Figure FDA0002448018990000043
确定所述阀控缸力阻抗控制***的多个传递函数；其中，G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制***的传递函数；Kaxv为伺服阀增益；Ap为伺服缸有效活塞面积；mt为折算到伺服缸活塞上总质量，包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和；s为拉氏算子；Bp为负载阻尼；K为负载刚度；
Figure FDA0002448018990000044
k1和k2为压力流量非线性折算系数；Kd为微分增益；ps为阀控缸力阻抗控制***供油压力；p1为伺服缸的左腔压力；p2为伺服缸的右腔压力；p0为阀控缸力阻抗控制***回油压力；xv为伺服阀阀芯位移；V1为进油腔容积；V2为回油腔容积；βe为有效体积弹性模量；ω为伺服阀的固有频率；ζ为伺服阀阻尼比；Cip为伺服缸的内泄漏系数。
8.根据权利要求7所述的针对阀控缸力阻抗控制***的外环阻抗补偿***，其特征在于，所述补偿控制器确定模块具体包括：
补偿控制器确定单元，用于根据公式
Figure FDA0002448018990000045
确定补偿控制器；其中，GMVIPC(s)为补偿控制器；Z′D为新的外环阻抗；ZD为所述阀控缸力阻抗控制***的外环阻抗；KF为力传感器增益；GPID(s)为PID控制器；XL为干扰位置；Fr为输入力。
CN201910588647.3A 2019-07-02 2019-07-02 针对阀控缸力阻抗控制***的外环阻抗补偿方法及*** Active CN110273876B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910588647.3A CN110273876B (zh) 2019-07-02 2019-07-02 针对阀控缸力阻抗控制***的外环阻抗补偿方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910588647.3A CN110273876B (zh) 2019-07-02 2019-07-02 针对阀控缸力阻抗控制***的外环阻抗补偿方法及***

Publications (2)

Publication Number Publication Date
CN110273876A CN110273876A (zh) 2019-09-24
CN110273876B true CN110273876B (zh) 2020-06-09

Family

ID=67963948

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910588647.3A Active CN110273876B (zh) 2019-07-02 2019-07-02 针对阀控缸力阻抗控制***的外环阻抗补偿方法及***

Country Status (1)

Country Link
CN (1) CN110273876B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111783247B (zh) * 2020-06-29 2023-06-02 燕山大学 液压阀控缸***动力机构与负载轻量化匹配方法及***

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105500147A (zh) * 2015-12-14 2016-04-20 中国科学院沈阳自动化研究所 基于力控制的龙门吊装机器人打磨加工方法
CN105690388B (zh) * 2016-04-05 2017-12-08 南京航空航天大学 一种腱驱动机械手腱张力约束阻抗控制方法及装置
CN106475999B (zh) * 2016-12-23 2018-11-09 东南大学 刚性条件下基于阻抗模型的双臂协调的加速度控制方法
US11337881B2 (en) * 2017-08-22 2022-05-24 New Jersey Institute Of Technology Exoskeleton with admittance control
CN107882795B (zh) * 2017-10-26 2019-07-26 燕山大学 一种高集成性阀控缸力控***动态柔顺补偿控制方法
CN108115690A (zh) * 2017-12-31 2018-06-05 芜湖哈特机器人产业技术研究院有限公司 一种机器人自适应控制***和方法

Also Published As

Publication number Publication date
CN110273876A (zh) 2019-09-24

Similar Documents

Publication Publication Date Title
CN106078750B (zh) 一种足式机器人液压驱动单元主动柔顺控制方法
CN108873702B (zh) 一种电液位置伺服控制***的线性自抗扰控制方法及装置
CN109210037B (zh) 一种针对液压驱动单元基于位置的阻抗控制方法及***
WO2021184517A1 (zh) 一种机器人关节力矩控制***及其负载补偿方法
CN108180180B (zh) 双液压缸流量补偿同步起竖装置及其控制方法
Yao et al. Cross-coupled fuzzy PID control combined with full decoupling compensation method for double cylinder servo control system
CN110273876B (zh) 针对阀控缸力阻抗控制***的外环阻抗补偿方法及***
CN111255756A (zh) 一种液压***中的变速泵控制***
Ba et al. The position-based impedance control combined with compliance-eliminated and feedforward compensation for HDU of legged robot
CN110398895A (zh) 一种基于位置的主动柔顺控制方法及***
CN107882795B (zh) 一种高集成性阀控缸力控***动态柔顺补偿控制方法
CN108005971B (zh) 双阀控缸带负载力控补偿协同装置及其控制方法
CN111648758B (zh) 一种水井钻机推进装置无模型自适应控制方法及***
CN110308648B (zh) 基于位置的阻抗控制***变阻抗特性补偿控制方法及***
CN110671373A (zh) 一种双阀并联控制液压缸的电液力控制***
CN112196856B (zh) 一种电传动设备的液压***及其控制方法
Saeedzadeh et al. Energy-efficient position control of an actuator in a digital hydraulic system using on/off valve
CN102248005B (zh) 双阀联动闭环控制实现工作辊的弯辊和平衡的方法
Cao et al. Design and control of a flexible joint as a hydraulic series elastic actuator for manipulation applications
CN108333919B (zh) 一种考虑路面波动干扰的非平衡身管俯仰位置控制方法
Yu et al. High-accuracy force control with nonlinear feedforward compensation for a hydraulic drive unit
CN113431816A (zh) 对称不均等的负叠合比例阀控非对称缸***的控制方法
CN112065798A (zh) 一种数字比例插装阀及控制方法
CN117289612B (zh) 一种液压机械臂自适应神经网络控制方法
CN212272669U (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