首页 / 专利库 / 企业组织 / 框图 / 一种考虑路面波动干扰的非平衡身管俯仰位置控制方法

一种考虑路面波动干扰的非平衡身管俯仰位置控制方法

阅读:927发布:2020-06-21

专利汇可以提供一种考虑路面波动干扰的非平衡身管俯仰位置控制方法专利检索,专利查询,专利分析的服务。并且本 发明 涉及一种考虑路面 波动 干扰的非平衡身管 俯仰 位置 控制方法。提供的技术方案是:首先,分析系统组成结构及工作原理,建立考虑路面波动的非平衡身管俯仰位置电液伺服系统数学模型;其次,采用矫正环节抑制路面波动对系统控制 精度 所造成的影响,并构造针对身管俯仰运动中变化非平衡重 力 距的压力差 负反馈 回路,同时调节回路增益以抑制非平衡重力距对系统静动态性能的影响;最后,以阶跃输入指令 信号 U1和正弦路面波动信号θ2分别为输入项和外干扰项,调整PID 控制器 各项权重,进行动态工况下身管调转和稳定操作时系统控制特性的分析计算。本发明不需大幅增加系统结构便能有效提高动态工况下系统的控制精度,且抑制干扰能力强。,下面是一种考虑路面波动干扰的非平衡身管俯仰位置控制方法专利的具体信息内容。

1.一种考虑路面波动干扰的非平衡身管俯仰位置控制方法,包括下述步骤:首先,分析系统组成结构及工作原理,建立考虑路面波动的非平衡身管俯仰位置电液伺服系统数学模型;其次,采用矫正环节抑制路面波动对系统控制精度所造成的影响,并构造针对身管俯仰运动中变化非平衡重距的压力差负反馈回路,同时调节回路增益以抑制非平衡重力距对系统静动态性能的影响;最后,以阶跃输入指令信号U1和正弦路面波动信号θ2分别为输入项和外干扰项,调整PID控制器各项权重,进行动态工况下身管调转和稳定操作时系统控制特性的分析计算。
2.如权利要求书1所述的一种考虑路面波动干扰的非平衡身管俯仰位置控制方法,其特征在于:具体包括以下步骤:
第一步,分析系统组成结构及工作原理,建立考虑路面波动的非平衡身管俯仰位置电液伺服系统数学模型:
设θ1和θ2分别为身管相对载体绕其回转轴转动的度和载体相对惯性空间绕回转轴转过的角度,则身管相对惯性空间绕回转轴转过的角度为:
θ=θ1+θ2
进而可以得到以θ为输出的液压缸与负载的力矩平衡方程:
其中M为液压缸输出转矩,J为身管相对轴的转动惯量,Bm为身管粘性摩擦系数;Tg为非平衡重力矩,俯仰过程中,身管重力相对于旋转中心的力臂发生变化,设Tg0为身管在0°时的非平衡重力矩,则有:
Tg=Tg0·cos(θ)
液压缸输出转矩M为输出力与输出力相对身管旋转中心力臂的乘积,即:
M=p1·A·L
其中p1液压缸进油腔压力,A为活塞缸筒有效作用面积,L为输出力相对身管旋转中心的力臂,通过L可以将液压缸活塞杆输出位移l转换为身管相对于旋转中心的输出转角。
忽略较小的回油腔压力并结合力臂转换公式,可以得到液压和缸的连续性流量方程为:
其中U1为给定的控制电压,Ka为伺服放大器增益,即Ka=i/U1,K1为伺服流量增益,这里伺服阀频率为执行机构频率的5~8倍,所以其数学模型也可以常数代替,即K1=Q/i,Ct为液压缸总的泄漏系数,βe为液压油体积弹性模数,V0为液压缸单腔容积。
系统中速度陀螺仪实时检测身管旋转速度并与对其积分所得的角度信号送入控制器进行速度闭环和位置闭环控制,其中 和Kl分别为速度反馈和位置反馈数学模型。
第二步,采用矫正环节抑制路面波动对系统控制精度所造成的影响,并构造针对身管俯仰运动中变化非平衡重力距的压力差负反馈回路,同时调节回路增益以抑制非平衡重力距对系统静动态性能的影响:
将第一步所建模型进行拉氏变换并整理得到路面波动下非平衡身管系统控制结构框图,设G1(s)为所采用的矫正环节,其作用是补偿θ2·Js2部分的影响。取控制指令U1和非平衡重力矩Tg均为0,可以求得输出角度θ关于路面波动信号θ2的传递函数为:
其中,F1(s)=Kp+Ki/s+Kds,F2(s)=KaK1,
为补偿θ2·Js2的影响,可以得到:
而G2(s)为抑制非平衡重力距影响的压力差负反馈环节,取控制指令U1和路面波动θ2均为0,综合第一步中部件模型可得到输出角度θ关于非平衡重力矩Tg的传递函数为:
为抑制非平衡重力矩的影响,可以得到:
G2(s)=-Ct/(KaK1)
第三步,以阶跃输入指令信号U1和正弦路面波动信号θ2分别为输入项和外干扰项,调整PID控制器各项权重,进行动态工况下身管调转和稳定操作时系统控制特性的分析计算:
搭建路面波动下非平衡身管控制系统Matlab/Simulink仿真框图,其中选取工程中易于实现的PID控制器进行系统控制,设定比例、积分及微分项系数分别为Kp、Ki及Kd,则控制器传递函数为:
输入身管调转角度θ1对应的指令电压U1,同时设定路面正弦波动信号θ2的幅值和频率,运行程序进行动态工况下身管调转操作时系统控制特性的分析计算;然后将身管调转角度θ1对应的指令电压U1设为0,而路面正弦波动信号θ2的幅值和频率保持不变,运行程序进行动态工况下身管稳定操作时系统控制特性的分析计算。

说明书全文

一种考虑路面波动干扰的非平衡身管俯仰位置控制方法

技术领域

[0001] 本发明涉及车载非平衡身管俯仰位置伺服控制技术领域,具体涉及一种考虑路面波动干扰的非平衡身管俯仰位置控制方法。

背景技术

[0002] 非平衡身管俯仰系统是高精度的位置跟踪伺服系统,其性能对高一级系统静动态品质起着至关重要的作用。该系统属于典型的复杂机电液耦合控制系统,实际环境下对其控制的关键是克服路面波动干扰和身管非平衡重矩的影响。
[0003] 当前,进行身管平衡的方法主要包括外部施加平衡力平衡方法和基于驱动源的平衡方法两大类。其中施加平衡力平衡方法包括质量平衡和平衡机平衡方法:质量块平衡方法一般需要提供较大的平衡质量进行非平衡质量的配平,使得系统结构较为繁杂;而平衡机平衡方法则是借助机械弹簧或液压助力方式进行非平衡质量的平衡,这种方法具有较强的抗干扰能力,但因需要设置专的机械结构而同样存在增加系统繁杂程度的不足。基于驱动源的平衡方法包括被动平衡方法和主动平衡方法:被动平衡方法需要先预估当前时刻的非平衡质量,然后以电机伺服系统或三腔液压缸结合蓄能器进行非平衡质量的平衡,电机伺服系统仅适用于较小非平衡质量的身管,同时都是依赖对非平衡质量的预估而将导致平衡精度不够高;主动平衡方法是利用三腔液压缸的平衡腔实现身管非平衡质量的主动控制平衡,由于未考虑路面波动干扰的影响因而是一种系统静止工况下的非平衡身管控制方法。因此,目前针对非平衡身管俯仰位置的控制方法存在只能进行静态工况下身管位置的控制、易造成系统结构繁杂而难以实现轻量化、控制精度不够高的问题。

发明内容

[0004]
[0005] 本发明要提供一种考虑路面波动干扰的非平衡身管俯仰位置控制方法以提供一种有效抑制路面波动干扰和非平衡重力矩影响的控制方法,解决动态工况下非平衡身管俯仰位置伺服系统控制方法设计问题,可在不大幅增加系统结构前提下有效提高系统控制精度。
[0006] 本发明的技术解决方案是:一种考虑路面波动干扰的非平衡身管俯仰位置控制方法,包括下述步骤:首先,分析系统组成结构及工作原理,建立考虑路面波动的非平衡身管俯仰位置电液伺服系统数学模型;其次,采用矫正环节抑制路面波动对系统控制精度所造成的影响,并构造针对身管俯仰运动中变化非平衡重力距的压力差负反馈回路,同时调节回路增益以抑制非平衡重力距对系统静动态性能的影响;最后,以阶跃输入指令信号U1和正弦路面波动信号θ2分别为输入项和外干扰项,调整PID控制器各项权重,进行动态工况下身管调转和稳定操作时系统控制特性的分析计算。
[0007] 上述方法具体包括以下步骤:
[0008] 第一步,分析系统组成结构及工作原理,建立考虑路面波动的非平衡身管俯仰位置电液伺服系统数学模型:
[0009] 设θ1和θ2分别为身管相对载体绕其回转轴转动的度和载体相对惯性空间绕回转轴转过的角度,则身管相对惯性空间绕回转轴转过的角度为:
[0010] θ=θ1+θ2
[0011] 进而可以得到以θ为输出的液压缸与负载的力矩平衡方程:
[0012]
[0013] 其中M为液压缸输出转矩,J为身管相对轴的转动惯量,Bm为身管粘性摩擦系数,Tg为非平衡重力矩,俯仰过程中,身管重力相对于旋转中心的力臂发生变化,设Tg0为身管在0°时的非平衡重力矩,则有:
[0014] Tg=Tg0·cos(θ)
[0015] 液压缸输出转矩M为输出力与输出力相对身管旋转中心力臂的乘积,即:
[0016] M=p1·A·L
[0017] 其中p1液压缸进油腔压力,A为活塞缸筒有效作用面积,L为输出力相对身管旋转中心的力臂,通过L可以将液压缸活塞杆输出位移l转换为身管相对于旋转中心的输出转角。
[0018] 忽略较小的回油腔压力并结合力臂转换公式,可以得到液压和缸的连续性流量方程为:
[0019]
[0020] 其中U1为给定的控制电压,Ka为伺服放大器增益,即Ka=i/U1,K1为伺服流量增益,这里伺服阀频率为执行机构频率的5~8倍,所以其数学模型也可以常数代替,即K1=Q/i,Ct为液压缸总的泄漏系数,βe为液压油体积弹性模数, V0为液压缸单腔容积。
[0021] 系统中速度陀螺仪实时检测身管旋转速度并与对其积分所得的角度信号送入控制器进行速度闭环和位置闭环控制,其中 和Kl分别为速度反馈和位置反馈数学模型。
[0022] 第二步,采用矫正环节抑制路面波动对系统控制精度所造成的影响,并构造针对身管俯仰运动中变化非平衡重力距的压力差负反馈回路,同时调节回路增益以抑制非平衡重力距对系统静动态性能的影响:
[0023] 将第一步所建模型进行拉氏变换并整理得到路面波动下非平衡身管系统控制结构框图,设G1(s)为所采用的矫正环节,其作用是补偿θ2·Js2部分的影响。取控制指令U1和非平衡重力矩Tg均为0,可以求得输出角度θ关于路面波动信号θ2的传递函数为:
[0024]
[0025] 其中,F1(s)=Kp+Ki/s+Kds,F2(s)=KaK1,
[0026] 为补偿θ2·Js2的影响,可以得到:
[0027]
[0028] 而G2(s)为抑制非平衡重力距影响的压力差负反馈环节,取控制指令U1和路面波动θ2均为0,综合第一步中部件模型可得到输出角度θ关于非平衡重力矩Tg的传递函数为:
[0029]
[0030] 为抑制非平衡重力矩的影响,可以得到:
[0031] G2(s)=-Ct/(KaK1)
[0032] 第三步,以阶跃输入指令信号U1和正弦路面波动信号θ2分别为输入项和外干扰项,调整PID控制器各项权重,进行动态工况下身管调转和稳定操作时系统控制特性的分析计算:
[0033] 搭建路面波动下非平衡身管控制系统Matlab/Simulink仿真框图,其中选取工程中易于实现的PID控制器进行系统控制,设定比例、积分及微分项系数分别为Kp、Ki及Kd,则控制器传递函数为:
[0034]
[0035] 输入身管调转角度θ1对应的指令电压U1,同时设定路面正弦波动信号θ2的幅值和频率,运行程序进行动态工况下身管调转操作时系统控制特性的分析计算;然后将身管调转角度θ1对应的指令电压U1设为0,而路面正弦波动信号θ2的幅值和频率保持不变,运行程序进行动态工况下身管稳定操作时系统控制特性的分析计算。
[0036] 本发明与现有技术相比的优点在于:
[0037] (1)本发明考虑路面波动引起载体摇摆对非平衡身管控制系统的干扰,建立干扰作用机理模型并采用矫正环节抑制干扰造成的影响,在此基础上增加执行机构压力差负反馈回路环节克服身管非平衡重力矩的影响,进而设计PID控制器实现动态工况下非平衡身管俯仰位置伺服系统的控制,可以有效提高系统控制精度但不会对系统结构的紧凑程度造成较大影响。
[0038] (2)本发明将路面波动和变化非平衡重力矩分别视作系统外部干扰和内部干扰,对路面波动干扰影响采用矫正环节进行抑制,设置校正环节后的稳态误差为无校正环节时的7%,同时增加执行机构压力差负反馈回路环节克服身管非平衡重力矩的影响,可以实现5000Nm非平衡重力矩下身管调转和稳定工况时误差均小于0.1mil,即对两种干扰具有较强的抑制能力。
附图说明
[0039] 图1为路面波动下非平衡身管系统组成结构简图;
[0040] 图2为路面波动下非平衡身管系统控制结构框图;
[0041] 图3为路面波动单独作用下系统结构框图;
[0042] 图4为非平衡重力矩单独作用下系统结构框图;
[0043] 图5为路面波动下非平衡身管系统Matlab/Simulink仿真框图;
[0044] 图6为5000Nm非平衡重力矩时30°(0.524rad)身管调转响应;
[0045] 图7为5000Nm非平衡重力矩时0°(0rad)身管稳定响应。

具体实施方式

[0046] 本发明所述的一种考虑路面波动干扰的非平衡身管俯仰位置控制方法具体实施步骤如下:
[0047] 第一步,分析系统组成结构及工作原理,建立考虑路面波动的非平衡身管俯仰位置电液伺服系统数学模型:
[0048] 如图1所示为路面波动下非平衡身管伺服系统结构简图,图中θ1和θ2分别为身管相对载体绕其回转轴转动的角度和载体相对惯性空间绕回转轴转过的角度,则身管相对惯性空间绕回转轴转过的角度为:
[0049] θ=θ1+θ2
[0050] 进而可以得到以θ为输出的液压缸与负载的力矩平衡方程:
[0051]
[0052] 其中M为液压缸输出转矩,J为身管相对耳轴的转动惯量,Bm为身管粘性摩擦系数,Tg为非平衡重力矩,俯仰过程中,身管重力相对于旋转中心的力臂发生变化,设Tg0为身管在0°时的非平衡重力矩,则有:
[0053] Tg=Tg0·cos(θ)
[0054] 液压缸输出转矩M为输出力与输出力相对身管旋转中心力臂的乘积,即:
[0055] M=p1·A·L
[0056] 其中p1液压缸进油腔压力,A为活塞缸筒有效作用面积,L为输出力相对身管旋转中心的力臂,通过L可以将液压缸活塞杆输出位移l转换为身管相对于旋转中心的输出转角,在图1中设AB的长度为:
[0057]
[0058] 其中l1为OA的长度,l2为OB的长度,l3为身管旋转角θ1为0°时AB的长度,γ+θ1为OA与OB间的夹角,对上式两边关于时间t求导可以得到:
[0059]
[0060] 忽略较小的回油腔压力并结合力臂转换公式,可以得到液压泵和缸的连续性流量方程为:
[0061]
[0062] 其中U1为给定的控制电压,Ka为伺服放大器增益,即Ka=i/U1,K1为伺服阀流量增益,这里伺服阀频率为执行机构频率的5~8倍,所以其传递函数也可以常数代替,即K1=Q/i,Ct为液压缸总的泄漏系数,βe为液压油体积弹性模数, V0为液压缸单腔容积。
[0063] 系统中速度陀螺仪实时检测身管旋转速度并与对其积分所得的角度信号送入控制器进行速度闭环和位置闭环控制,其中 和Kl分别为速度反馈和位置反馈数学模型。
[0064] 第二步,采用矫正环节抑制路面波动对系统控制精度所造成的影响,并构造针对身管俯仰运动中变化非平衡重力距的压力差负反馈回路,同时调节回路增益以抑制非平衡重力距对系统静动态性能的影响:
[0065] 将第一步所建模型进行拉氏变换并整理得到路面波动下非平衡身管系统控制结构框图如图2所示,其中G1(s)为所采用的矫正环节,其作用是补偿θ2·Js2部分的影响。取控制指令U1和非平衡重力矩Tg均为0,可以将图2转换为图3 所示的等价形式,进而求得输出角度θ关于路面波动信号θ2的传递函数为:
[0066]
[0067] 其中,F1(s)=Kp+Ki/s+Kds,F2(s)=KaK1,
[0068] 为补偿θ2·Js2的影响,令φ(s)=0,可以得到:
[0069]
[0070] 而图2中G2(s)为抑制非平衡重力距影响的压力差负反馈环节,取控制指令 U1和路面波动θ2均为0,可以将图2转换为图4所示等价形式,综合第一步中部件模型可得到输出角度θ关于非平衡重力矩Tg的传递函数为:
[0071]
[0072] 结 合 实 际 参 数 取 值 并 分 析 公 式 发 现 ,ψ ( s ) 中 的为有限值,而中(V0/Be)s的系数微乎其微,因而非平衡重力距的变化对系统稳态精度造成的影响主要是来源于G2(s)F2(s)+Ct,为此压力差反馈回路设计目的是抵消常数项Ct,即令:
[0073] G2(s)F2(s)+Ct=0
[0074] 可以得到压力差负反馈回路传递函数为:
[0075] G2(s)=-Ct/(KaK1)
[0076] 第三步,以阶跃输入指令信号U1和正弦路面波动信号θ2分别为输入项和外干扰项,调整PID控制器各项权重,进行动态工况下身管调转和稳定操作时系统控制特性的分析计算:
[0077] 如图5所示为路面波动下非平衡身管控制系统Matlab/Simulink仿真框图,其中选取工程中易于实现的PID控制器进行系统控制,设定比例、积分及微分项系数分别为Kp、Ki及Kd,则控制器传递函数为:
[0078]
[0079] 输入身管调转角度θ1对应的指令电压U1,同时设定路面正弦波动信号θ2的幅值和频率,运行程序进行动态工况下身管调转操作时系统控制特性的分析计算,计算结果如图6所示;然后将身管调转角度θ1对应的指令电压U1设为0,而路面正弦波动信号θ2的幅值和频率保持不变,运行程序进行动态工况下身管稳定操作时系统控制特性的分析计算,计算结果如图7所示;通过图6和图7 可以发现:采用本发明所述方法可以控制稳态精度在0.1mil以内,即能有效抑制路面波动干扰和非平衡重力距的影响。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈