CN110273876A - 针对阀控缸力阻抗控制系统的外环阻抗补偿方法及系统 - Google Patents
针对阀控缸力阻抗控制系统的外环阻抗补偿方法及系统 Download PDFInfo
- Publication number
- CN110273876A CN110273876A CN201910588647.3A CN201910588647A CN110273876A CN 110273876 A CN110273876 A CN 110273876A CN 201910588647 A CN201910588647 A CN 201910588647A CN 110273876 A CN110273876 A CN 110273876A
- Authority
- CN
- China
- Prior art keywords
- valve
- outer ring
- impedance
- control system
- controlled cylinder
- 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
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 cheetah robot、spot mini等。近年来,随着液压驱动的足式机器人逐渐成为研究热点,阻抗控制方法也应用在了这类机器人中,如:Bigdog,HyQ,Scalf-1,LWR robot,StarlETH,Atlas等;传统的阻抗控制的基本实现原理都是以液压控制系统作为控制内环,当系统受到外干扰作用时,通过阻抗控制外环,对外干扰信号进行信号转换(通常情况下是位置与力之间的转换)以改变内环的输入,从而使系统实现阻抗参数;机器人行走在不同环境工况下时,腿部所需要实现的阻抗参数各不相同,如果机器人腿部不能实现期望的阻抗参数,那么势必会对其缓冲效果、步态、稳定性和行走速度等方面产生不利影响,所以机器人腿部阻抗控制的精度十分重要。
但实际情况下,由于液压系统数学模型阶数较高,且具有固有的非线性、参数时变性、强耦合性以及负载复杂多变性,在多因素的共同作用下,导致传统的阻抗控制方法在液压系统中很难具有令人满意的控制精度,且抗干扰性能低。
发明内容
本发明的目的是提供一种针对阀控缸力阻抗控制系统的外环阻抗补偿方法及系统,以解决传统的阻抗控制方法在液压系统中控制精度以及抗干扰性能低的问题。
为实现上述目的,本发明提供了如下方案:
一种针对阀控缸力阻抗控制系统的外环阻抗补偿方法,包括:
获取阀控缸力阻抗控制系统的外环阻抗、阀控缸力阻抗控制系统数学模型以及阀控缸伺服缸参数;所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积;
根据所述外环阻抗确定补偿控制策略;
根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制系统数学模型进行简化分离,确定所述阀控缸力阻抗控制系统的多个传递函数;
根据所述补偿控制策略以及多个所述传递函数确定补偿控制器;
根据所述补偿控制器对所述阀控缸力阻抗控制系统的外环阻抗进行补偿,确定补偿后的外环阻抗。
可选的,所述根据所述外环阻抗确定补偿控制策略,具体包括:
根据所述外环阻抗,确定所述外环阻抗对应的内环的期望力;
获取输入所述阀控缸力阻抗控制系统的输入力;
根据所述输入力对所述外环阻抗进行补偿,确定新的外环阻抗;
在所述新的外环阻抗的作用下,将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力;
在所述新的外环阻抗对应的内环的期望力的作用下,使得所述阀控缸力阻抗控制系统的输出力等于所述外环阻抗对应的内环的期望力,确定补偿控制策略。
可选的,所述根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制系统数学模型进行简化分离,确定所述阀控缸力阻抗控制系统的多个传递函数,具体包括:
根据公式 以及确定所述阀控缸力阻抗控制系统的多个传递函数;其中,G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制系统的传递函数;Kaxv为伺服阀增益;Ap为伺服缸有效活塞面积;mt为折算到伺服缸活塞上总质量,包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和;s为拉氏算子;Bp为负载阻尼;K为负载刚度;k1和k2为压力流量非线性折算系数;Kd为微分增益;ps为阀控缸力阻抗控制系统供油压力;p1为伺服缸的左腔压力;p2为伺服缸的右腔压力;p0为阀控缸力阻抗控制系统回油压力;xv为伺服阀阀芯位移;V1为进油腔容积;V2为回油腔容积;βe为有效体积弹性模量;ω为伺服阀的固有频率;ζ为伺服阀阻尼比;Cip为伺服缸的内泄漏系数。
可选的,所述根据所述补偿控制策略以及多个所述传递函数确定补偿控制器,具体包括:
根据公式确定补偿控制器;其中,GMVIPC(s)为补偿控制器;Z′D为新的外环阻抗;ZD为所述阀控缸力阻抗控制系统的外环阻抗;KF为力传感器增益;GPID(s)为PID控制器;XL为干扰位置;Fr为输入力。
一种针对阀控缸力阻抗控制系统的外环阻抗补偿系统,包括:
参数获取模块,用于获取阀控缸力阻抗控制系统的外环阻抗、阀控缸力阻抗控制系统数学模型以及阀控缸伺服缸参数;所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积;
补偿控制策略确定模块,用于根据所述外环阻抗确定补偿控制策略;
传递函数确定模块,用于根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制系统数学模型进行简化分离,确定所述阀控缸力阻抗控制系统的多个传递函数;
补偿控制器确定模块,用于根据所述补偿控制策略以及多个所述传递函数确定补偿控制器;
补偿后的外环阻抗确定模块,用于根据所述补偿控制器对所述阀控缸力阻抗控制系统的外环阻抗进行补偿,确定补偿后的外环阻抗。
可选的,所述补偿控制策略确定模块具体包括:
外环阻抗对应的内环的期望力确定单元,用于根据所述外环阻抗,确定所述外环阻抗对应的内环的期望力;
输入力获取单元,用于获取输入所述阀控缸力阻抗控制系统的输入力;
新的外环阻抗确定单元,用于根据所述输入力对所述外环阻抗进行补偿,确定新的外环阻抗;
新的外环阻抗对应的内环的期望力确定单元,用于在所述新的外环阻抗的作用下,将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力;
补偿控制策略确定单元,用于在所述新的外环阻抗对应的内环的期望力的作用下,使得所述阀控缸力阻抗控制系统的输出力等于所述外环阻抗对应的内环的期望力,确定补偿控制策略。
可选的,所述传递函数确定模块具体包括:
传递函数确定单元,用于根据公式 以及确定所述阀控缸力阻抗控制系统的多个传递函数;其中,G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制系统的传递函数;Kaxv为伺服阀增益;Ap为伺服缸有效活塞面积;mt为折算到伺服缸活塞上总质量,包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和;s为拉氏算子;Bp为负载阻尼;K为负载刚度;k1和k2为压力流量非线性折算系数;Kd为微分增益;ps为阀控缸力阻抗控制系统供油压力;p1为伺服缸的左腔压力;p2为伺服缸的右腔压力;p0为阀控缸力阻抗控制系统回油压力;xv为伺服阀阀芯位移;V1为进油腔容积;V2为回油腔容积;βe为有效体积弹性模量;ω为伺服阀的固有频率;ζ为伺服阀阻尼比;Cip为伺服缸的内泄漏系数。
可选的,所述补偿控制器确定模块具体包括:
补偿控制器确定单元,用于根据公式确定补偿控制器;其中,GMVIPC(s)为补偿控制器;Z′D为新的外环阻抗;ZD为所述阀控缸力阻抗控制系统的外环阻抗;KF为力传感器增益;GPID(s)为PID控制器;XL为干扰位置;Fr为输入力。
根据本发明提供的具体实施例,本发明公开了以下技术效果:本发明提供了一种针对阀控缸力阻抗控制系统的外环阻抗补偿方法及系统,对阀控缸力阻抗控制系统数学模型进行了简化,分离成多个传递函数,降低数学模型复杂度,并根据外环阻抗确定了补偿控制策略,本发明基于机理建模方法,通过改变阻抗参数,使干扰位置作用到阀控缸力阻抗控制系统产生新的期望力,当新的期望力输入到阀控缸力阻抗控制系统之后,阀控缸力阻抗控制系统新产生的输出力可以更接近于阻抗期望力,从而提高了高集成性阀控缸力阻抗控制系统的控制精度,极大地改善了传统力阻抗控制系统的鲁棒性,且具有很好的工程实用性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明所提供的针对阀控缸力阻抗控制系统的外环阻抗补偿方法流程图;
图2为本发明所提供的外环阻抗补偿控制策略示意图;
图3为本发明所提供的高集成性阀控缸力阻抗控制传递框图;
图4为本发明所提供的图3简化的高集成性阀控缸力阻抗控制传递框图;
图5为本发明所提供的加入补偿控制器后的力阻抗控制传递框图;
图6为本发明所提供的针对阀控缸力阻抗控制系统的外环阻抗补偿系统结构图。
其中,ω——伺服阀的固有频率;ζ——伺服阀阻尼比;——等效流量系数;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为伺服缸的外泄漏系数;为等效流量系数;Cd为流量系数;W为面积梯度;ρ为液压油的密度;
图4为本发明所提供的图3简化的高集成性阀控缸力阻抗控制传递框图,图4中系统传递函数G1(s)、G2(s)和Gx(s)如下所示:
其中,G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制系统的传递函数;Kaxv为伺服阀增益;Ap为伺服缸有效活塞面积;mt为折算到伺服缸活塞上总质量,包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和;s为拉氏算子;Bp为负载阻尼;K为负载刚度; k1和k2为压力流量非线性折算系数Kd为微分增益;ps为阀控缸力阻抗控制系统供油压力;p1为伺服缸的左腔压力;p2为伺服缸的右腔压力;p0为阀控缸力阻抗控制系统回油压力;xv为伺服阀阀芯位移;V1为进油腔容积;V2为回油腔容积;βe为有效体积弹性模量;ω为伺服阀的固有频率;ζ为伺服阀阻尼比;Cip为伺服缸的内泄漏系数。
步骤104:根据所述补偿控制策略以及多个所述传递函数确定补偿控制器。
图5为本发明所提供的加入补偿控制器后的力阻抗控制传递框图,如图5所示,Ⅰ、Ⅱ以及Ⅲ表示系统控制框图中的位置,Φ1′(s)为Ⅱ到Ⅰ的传递函数,其可表示为
将上式做如下变换可得
Φ2(s)为Ⅱ到Ⅲ的传递函数,其可表示为
Φ2(s)的误差传递函数为E2(s),则其可表示为
为了使被控阀控缸力阻抗控制系统变为无误差的系统,需要Φ2(s)的误差传递函数E2(s)等于零,则可以得到新的阻抗参数ZD′:
则补偿控制器GMVIPC(s)可表示为
步骤105:根据所述补偿控制器对所述阀控缸力阻抗控制系统的外环阻抗进行补偿,确定补偿后的外环阻抗。
本发明基于液压系统的强非线性,参数时变性,油液可压缩性和负载复杂多变性等方面的因素,基于机理建模的方法,提供了一种通过动态改变外环阻抗参数提高力控系统鲁棒性的补偿控制策略,通过动态的改变外环的阻抗参数,提高了高集成性阀控缸力阻抗控制系统的鲁棒性和控制精度;极大地改善了传统的力阻抗控制性能,且具有较好的工程实用性和多工况适应。
图6为本发明所提供的针对阀控缸力阻抗控制系统的外环阻抗补偿系统结构图,如图6所示,一种针对阀控缸力阻抗控制系统的外环阻抗补偿系统,包括:
参数获取模块601,用于获取阀控缸力阻抗控制系统的外环阻抗、阀控缸力阻抗控制系统数学模型以及阀控缸伺服缸参数;所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积。
补偿控制策略确定模块602,用于根据所述外环阻抗确定补偿控制策略。
所述补偿控制策略确定模块602具体包括:外环阻抗对应的内环的期望力确定单元,用于根据所述外环阻抗,确定所述外环阻抗对应的内环的期望力;输入力获取单元,用于获取输入所述阀控缸力阻抗控制系统的输入力;新的外环阻抗确定单元,用于根据所述输入力对所述外环阻抗进行补偿,确定新的外环阻抗;新的外环阻抗对应的内环的期望力确定单元,用于在所述新的外环阻抗的作用下,将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力;补偿控制策略确定单元,用于在所述新的外环阻抗对应的内环的期望力的作用下,使得所述阀控缸力阻抗控制系统的输出力等于所述外环阻抗对应的内环的期望力,确定补偿控制策略。
传递函数确定模块603,用于根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制系统数学模型进行简化分离,确定所述阀控缸力阻抗控制系统的多个传递函数。
所述传递函数确定模块603具体包括:传递函数确定单元,用于根据公式以及确定所述阀控缸力阻抗控制系统的多个传递函数;其中,G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制系统的传递函数;Kaxv为伺服阀增益;Ap为伺服缸有效活塞面积;mt为折算到伺服缸活塞上总质量,包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和;s为拉氏算子;Bp为负载阻尼;K为负载刚度; k1和k2为压力流量非线性折算系数;Kd为微分增益;ps为阀控缸力阻抗控制系统供油压力;p1为伺服缸的左腔压力;p2为伺服缸的右腔压力;p0为阀控缸力阻抗控制系统回油压力;xv为伺服阀阀芯位移;V1为进油腔容积;V2为回油腔容积;βe为有效体积弹性模量;ω为伺服阀的固有频率;ζ为伺服阀阻尼比;Cip为伺服缸的内泄漏系数。
补偿控制器确定模块604,用于根据所述补偿控制策略以及多个所述传递函数确定补偿控制器。
所述补偿控制器确定模块604具体包括:补偿控制器确定单元,用于根据公式确定补偿控制器;其中,GMVIPC(s)为补偿控制器;Z′D为新的外环阻抗;ZD为所述阀控缸力阻抗控制系统的外环阻抗;KF为力传感器增益;GPID(s)为PID控制器;XL为干扰位置;Fr为输入力。
补偿后的外环阻抗确定模块605,用于根据所述补偿控制器对所述阀控缸力阻抗控制系统的外环阻抗进行补偿,确定补偿后的外环阻抗。
本发明极大地改善了传统力阻抗控制系统的鲁棒性,且具有较好的工程实用性。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (8)
1.一种针对阀控缸力阻抗控制系统的外环阻抗补偿方法,其特征在于,包括:
获取阀控缸力阻抗控制系统的外环阻抗、阀控缸力阻抗控制系统数学模型以及阀控缸伺服缸参数;所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积;
根据所述外环阻抗确定补偿控制策略;
根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制系统数学模型进行简化分离,确定所述阀控缸力阻抗控制系统的多个传递函数;
根据所述补偿控制策略以及多个所述传递函数确定补偿控制器;
根据所述补偿控制器对所述阀控缸力阻抗控制系统的外环阻抗进行补偿,确定补偿后的外环阻抗。
2.根据权利要求1所述的针对阀控缸力阻抗控制系统的外环阻抗补偿方法,其特征在于,所述根据所述外环阻抗确定补偿控制策略,具体包括:
根据所述外环阻抗,确定所述外环阻抗对应的内环的期望力;
获取输入所述阀控缸力阻抗控制系统的输入力;
根据所述输入力对所述外环阻抗进行补偿,确定新的外环阻抗;
在所述新的外环阻抗的作用下,将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力;
在所述新的外环阻抗对应的内环的期望力的作用下,使得所述阀控缸力阻抗控制系统的输出力等于所述外环阻抗对应的内环的期望力,确定补偿控制策略。
3.根据权利要求2所述的针对阀控缸力阻抗控制系统的外环阻抗补偿方法,其特征在于,所述根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制系统数学模型进行简化分离,确定所述阀控缸力阻抗控制系统的多个传递函数,具体包括:
根据公式 以及确定所述阀控缸力阻抗控制系统的多个传递函数;其中,G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制系统的传递函数;Kaxv为伺服阀增益;Ap为伺服缸有效活塞面积;mt为折算到伺服缸活塞上总质量,包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和;s为拉氏算子;Bp为负载阻尼;K为负载刚度;k1和k2为压力流量非线性折算系数;Kd为微分增益;ps为阀控缸力阻抗控制系统供油压力;p1为伺服缸的左腔压力;p2为伺服缸的右腔压力;p0为阀控缸力阻抗控制系统回油压力;xv为伺服阀阀芯位移;V1为进油腔容积;V2为回油腔容积;βe为有效体积弹性模量;ω为伺服阀的固有频率;ζ为伺服阀阻尼比;Cip为伺服缸的内泄漏系数。
4.根据权利要求3所述的针对阀控缸力阻抗控制系统的外环阻抗补偿方法,其特征在于,所述根据所述补偿控制策略以及多个所述传递函数确定补偿控制器,具体包括:
根据公式确定补偿控制器;其中,GMVIPC(s)为补偿控制器;Z′D为新的外环阻抗;ZD为所述阀控缸力阻抗控制系统的外环阻抗;KF为力传感器增益;GPID(s)为PID控制器;XL为干扰位置;Fr为输入力。
5.一种针对阀控缸力阻抗控制系统的外环阻抗补偿系统,其特征在于,包括:
参数获取模块,用于获取阀控缸力阻抗控制系统的外环阻抗、阀控缸力阻抗控制系统数学模型以及阀控缸伺服缸参数;所述阀控缸伺服缸参数包括进油腔容积、回油腔容积、负载刚度、伺服缸左腔压力、伺服缸右腔压力、回油压力以及伺服缸有效活塞面积;
补偿控制策略确定模块,用于根据所述外环阻抗确定补偿控制策略;
传递函数确定模块,用于根据所述阀控缸伺服缸参数对所述阀控缸力阻抗控制系统数学模型进行简化分离,确定所述阀控缸力阻抗控制系统的多个传递函数;
补偿控制器确定模块,用于根据所述补偿控制策略以及多个所述传递函数确定补偿控制器;
补偿后的外环阻抗确定模块,用于根据所述补偿控制器对所述阀控缸力阻抗控制系统的外环阻抗进行补偿,确定补偿后的外环阻抗。
6.根据权利要求5所述的针对阀控缸力阻抗控制系统的外环阻抗补偿系统,其特征在于,所述补偿控制策略确定模块具体包括:
外环阻抗对应的内环的期望力确定单元,用于根据所述外环阻抗,确定所述外环阻抗对应的内环的期望力;
输入力获取单元,用于获取输入所述阀控缸力阻抗控制系统的输入力;
新的外环阻抗确定单元,用于根据所述输入力对所述外环阻抗进行补偿,确定新的外环阻抗;
新的外环阻抗对应的内环的期望力确定单元,用于在所述新的外环阻抗的作用下,将所述外环阻抗对应的内环的期望力转换为所述新的外环阻抗对应的内环的期望力;
补偿控制策略确定单元,用于在所述新的外环阻抗对应的内环的期望力的作用下,使得所述阀控缸力阻抗控制系统的输出力等于所述外环阻抗对应的内环的期望力,确定补偿控制策略。
7.根据权利要求6所述的针对阀控缸力阻抗控制系统的外环阻抗补偿系统,其特征在于,所述传递函数确定模块具体包括:
传递函数确定单元,用于根据公式 以及确定所述阀控缸力阻抗控制系统的多个传递函数;其中,G1(s)、G2(s)以及Gx(s)为所述阀控缸力阻抗控制系统的传递函数;Kaxv为伺服阀增益;Ap为伺服缸有效活塞面积;mt为折算到伺服缸活塞上总质量,包括负载、活塞、位移传感器、力传感器、连接管道和伺服缸内油液的折算质量和;s为拉氏算子;Bp为负载阻尼;K为负载刚度;k1和k2为压力流量非线性折算系数;Kd为微分增益;ps为阀控缸力阻抗控制系统供油压力;p1为伺服缸的左腔压力;p2为伺服缸的右腔压力;p0为阀控缸力阻抗控制系统回油压力;xv为伺服阀阀芯位移;V1为进油腔容积;V2为回油腔容积;βe为有效体积弹性模量;ω为伺服阀的固有频率;ζ为伺服阀阻尼比;Cip为伺服缸的内泄漏系数。
8.根据权利要求7所述的针对阀控缸力阻抗控制系统的外环阻抗补偿系统,其特征在于,所述补偿控制器确定模块具体包括:
补偿控制器确定单元,用于根据公式确定补偿控制器;其中,GMVIPC(s)为补偿控制器;Z′D为新的外环阻抗;ZD为所述阀控缸力阻抗控制系统的外环阻抗;KF为力传感器增益;GPID(s)为PID控制器;XL为干扰位置;Fr为输入力。
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 true CN110273876A (zh) | 2019-09-24 |
CN110273876B 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) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111783247A (zh) * | 2020-06-29 | 2020-10-16 | 燕山大学 | 液压阀控缸系统动力机构与负载轻量化匹配方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105500147A (zh) * | 2015-12-14 | 2016-04-20 | 中国科学院沈阳自动化研究所 | 基于力控制的龙门吊装机器人打磨加工方法 |
CN105690388A (zh) * | 2016-04-05 | 2016-06-22 | 南京航空航天大学 | 一种腱驱动机械手腱张力约束阻抗控制方法及装置 |
CN106475999A (zh) * | 2016-12-23 | 2017-03-08 | 东南大学 | 刚性条件下基于阻抗模型的双臂协调的加速度控制方法 |
CN107882795A (zh) * | 2017-10-26 | 2018-04-06 | 燕山大学 | 一种高集成性阀控缸力控系统动态柔顺补偿控制方法 |
CN108115690A (zh) * | 2017-12-31 | 2018-06-05 | 芜湖哈特机器人产业技术研究院有限公司 | 一种机器人自适应控制系统和方法 |
US20190060155A1 (en) * | 2017-08-22 | 2019-02-28 | New Jersey Institute Of Technology | Exoskeleton with admittance control |
-
2019
- 2019-07-02 CN CN201910588647.3A patent/CN110273876B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105500147A (zh) * | 2015-12-14 | 2016-04-20 | 中国科学院沈阳自动化研究所 | 基于力控制的龙门吊装机器人打磨加工方法 |
CN105690388A (zh) * | 2016-04-05 | 2016-06-22 | 南京航空航天大学 | 一种腱驱动机械手腱张力约束阻抗控制方法及装置 |
CN106475999A (zh) * | 2016-12-23 | 2017-03-08 | 东南大学 | 刚性条件下基于阻抗模型的双臂协调的加速度控制方法 |
US20190060155A1 (en) * | 2017-08-22 | 2019-02-28 | New Jersey Institute Of Technology | Exoskeleton with admittance control |
CN107882795A (zh) * | 2017-10-26 | 2018-04-06 | 燕山大学 | 一种高集成性阀控缸力控系统动态柔顺补偿控制方法 |
CN108115690A (zh) * | 2017-12-31 | 2018-06-05 | 芜湖哈特机器人产业技术研究院有限公司 | 一种机器人自适应控制系统和方法 |
Non-Patent Citations (3)
Title |
---|
MICHELE FPCCHI: "Robot impedance control and passivity analysis", 《CONTROL THEORY AND TECHNOLOGY》 * |
巴凯先: "液压驱动单元基于位置/力的阻抗控制", 《机械工程学报》 * |
覃文雷: "工业机器人力位控制的自适应方法研究", 《中国博士学位论文全文数据库信息科技辑》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111783247A (zh) * | 2020-06-29 | 2020-10-16 | 燕山大学 | 液压阀控缸系统动力机构与负载轻量化匹配方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN110273876B (zh) | 2020-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109210037B (zh) | 一种针对液压驱动单元基于位置的阻抗控制方法及系统 | |
CN106078750B (zh) | 一种足式机器人液压驱动单元主动柔顺控制方法 | |
CN106483844B (zh) | 基于非线性鲁棒的电液伺服系统自适应位置控制器的实现方法 | |
CN104345638A (zh) | 一种液压马达位置伺服系统的自抗扰自适应控制方法 | |
CN107882795B (zh) | 一种高集成性阀控缸力控系统动态柔顺补偿控制方法 | |
Ba et al. | A nonlinear model-based variable impedance parameters control for position-based impedance control system of hydraulic drive unit | |
Yao et al. | Cross-coupled fuzzy PID control combined with full decoupling compensation method for double cylinder servo control system | |
CN110273876A (zh) | 针对阀控缸力阻抗控制系统的外环阻抗补偿方法及系统 | |
CN112196856B (zh) | 一种电传动设备的液压系统及其控制方法 | |
CN110308648A (zh) | 基于位置的阻抗控制系统变阻抗特性补偿控制方法及系统 | |
CN111255756B (zh) | 一种液压系统中的变速泵控制系统 | |
CN110941181B (zh) | 一种压电陶瓷连接的刚柔耦合运动平台控制方法 | |
Qiao et al. | Design and characteristic research of a novel electromechanical-hydraulic hybrid actuator with two transmission mechanisms | |
CN107104618A (zh) | 一种磁悬浮电机转子的控制方法及系统 | |
CN108333919B (zh) | 一种考虑路面波动干扰的非平衡身管俯仰位置控制方法 | |
CN115236974A (zh) | 一种复合抗扰控制器及其控制参数优化方法 | |
CN113431816B (zh) | 对称不均等的负叠合比例阀控非对称缸系统的控制方法 | |
Pedersen et al. | Investigation of separate meter-in separate meter-out control strategies for systems with over centre valves | |
Liu et al. | Flow match and precision motion control of asymmetric electro-hydrostatic actuators with complex external force in four-quadrants | |
Yuan et al. | Characteristics of energy efficient switched hydraulic systems | |
Yu et al. | Active Disturbance Rejection Control of Position Control for Electrohydraulic Servo System. | |
CN109695607A (zh) | 一种用于预应力智能张拉设备的泵阀协同控制方法 | |
Shi et al. | Study on dynamic characteristics of negative flow control variable axial piston pump for hydraulic excavator | |
Yao et al. | Three-parameter Control Scheme based on Adaptive Pole Assignment for an Underwater Shaking Table System | |
CN114412885B (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 |