CN105759632B - 一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法 - Google Patents
一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法 Download PDFInfo
- Publication number
- CN105759632B CN105759632B CN201610265233.3A CN201610265233A CN105759632B CN 105759632 B CN105759632 B CN 105759632B CN 201610265233 A CN201610265233 A CN 201610265233A CN 105759632 B CN105759632 B CN 105759632B
- Authority
- CN
- China
- Prior art keywords
- servo valve
- moment
- propeller
- motor
- coefficient
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems involving the use of models or simulators of said systems electric
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Fluid-Pressure Circuits (AREA)
Abstract
本发明公开了一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法。包括伺服阀传递函数模块、伺服阀流量计算模块、恒压变量泵模块、伺服阀控制液压推进器动力学系统模块、螺旋桨推力计算模块、螺旋桨转矩计算模块、螺旋桨推力与转矩系数计算模块和螺旋桨进速系数计算模块;本发明可较真实的模拟通过电液伺服阀来控制液压马达两端油液流量、压力、扭矩和转速的变化,进而调节螺旋桨输出转矩和推力的动态过程;可较真实的模拟螺旋桨负载连续变化条件下,液压马达的流量、压力扭矩和转速的动态响应过程。本发明对作业型水下机器人的伺服阀控制液压推进器动力学仿真系统提供了一种可行、有效的解决方法。
Description
技术领域
本发明属于无人水下机器人运动控制的技术领域,尤其涉及针对作业型遥控水下机器人(ROV—Remotely Operated Vehicle)的,一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法。
背景技术
作业型ROV的最大特点是能在危险深海环境中完成高强度、大负荷和高精度作业,它是我国实施深海资源开发战略不可或缺的重大技术装备之一。开发作业型ROV仿真训练模拟器,可在虚拟环境中对作业人员进行岗位培训,并对水下作业进行预演,提高水下作业效率和保证作业安全,具有重要的工程价值和现实意义。
本发明中所涉及的作业型ROV安装8台液压螺旋桨推进器,其中水平推进器4台,垂直推进器4台。为了实现作业型ROV的六自由度运动控制,需要控制8台推进器同时动作和输出推力。由于液压推进器动力学系统的执行存在较大的惯性和滞后特性,研究伺服阀控制液压推进器的动力学仿真系统,对研究作业型ROV实际装备和仿真训练模拟器具有重要的工程价值,也成为无人水下机器人控制系统研究的关键技术之一。
由于螺旋桨的推力与其进水速度、液压马达的转速和压力具有复杂的非线性关系,螺旋桨的负载转矩与其水流进速、液压马达转速和流量也具有复杂的非线性关系,按照传递函数的方法难以建立水下机器人期望推力和螺旋桨推力之间的线性化数学模型。因此,国内相关领域专家对关于伺服阀控制液压推进器动力学仿真系统的研究成果较少。同时,国外很少有公开关于作业型ROV伺服阀控制液压推进器动力学系统仿真技术方面的相关文献与资料。
本发明提出了一种水下机器人伺服阀控制液压推进器动力学系统的仿真方法,建立了一种适合作业型水下机器人的伺服阀控制液压推进器的动力学仿真系统。本发明对液压推进器动力学仿真系统的研究提供了一种有效和实用的解决方法,对作业型ROV仿真训练模拟器和ROV实际作业装备的研制都具有重要的工程价值和指导意义。
发明内容
本发明的目的是提供一种准确直观、逻辑清晰的水下机器人伺服阀控制液压推进器动力学仿真系统。本发明的目的还包括提供一种实时性强的水下机器人伺服阀控制液压推进器动力学仿真系统的仿真方法。
一种水下机器人伺服阀控制液压推进器动力学仿真系统,其特征在于:包括伺服阀传递函数模块、伺服阀流量计算模块、恒压变量泵模块、伺服阀控制液压推进器动力学系统模块、螺旋桨推力计算模块、螺旋桨转矩计算模块、螺旋桨推力与转矩系数计算模块和螺旋桨进速系数计算模块;
将与期望控制推力成正比的控制电流iv输入到伺服阀传递函数模块,输出一个伺服阀阀芯开口位移值xv;将伺服阀阀芯开口位移值xv输入到伺服阀流量计算模块,得到伺服阀流量Qv输入给伺服阀控制液压推进器动力学系统模块;将恒压变量泵的工作压力pr输入到伺服阀流量计算模块后输送给伺服阀控制液压推进器动力学系统模块;伺服阀控制液压推进器动力学系统模块根据接收的伺服阀流量Qv和t-1时刻的马达油液压力pt-1和角速度ωt-1,得到马达的由液压力pt、输出扭矩Mg和角速度ωt;
将t-1时刻的螺旋桨的进水速度Vt-1和螺旋桨的转速nt-1输入到螺旋桨进速系数计算模块,得到t时刻螺旋桨的进速系数Jt;将t时刻螺旋桨的进速系数Jt输入到螺旋桨推力与转矩系数计算模块,得到t时刻螺旋桨的转矩系数KM和推力系数KT;
将t时刻螺旋桨的推力系数KT、马达的角速度ωt输入到螺旋桨推力计算模块得到t时刻螺旋桨推力Tt;将t时刻螺旋桨的转矩系数KM、马达的转速ωt输入到螺旋桨转矩计算模块,得t时刻螺旋桨的转矩Mt。
本发明一种水下机器人伺服阀控制液压推进器动力学仿真系统的仿真方法,
包括以下步骤:
步骤一:将与期望控制推力成正比的控制电流iv输入到伺服阀传递函数模块,输出一个伺服阀阀芯开口位移值xv;
步骤二:根据伺服阀阀芯开口位移值xv,得到伺服阀流量Qv:
Qv=Kvxv
其中,Kv——伺服阀的流量增益系数;
步骤三:计算当前t时刻的马达负载流量Qt:
Qt=Kqxv-Kcp
其中:p——液压马达两端油液压力差;Kq——伺服阀流量增益;Kc——伺服阀流量压力增益;
步骤四:由当前t时刻的马达负载流量Qt、t-1时刻的马达油液压力pt-1和角速度ωt-1,根据液压马达流量连续性方程确定当前t时刻的马达油液压力增加速度
步骤五:由马达油液压力增加速度采样时间Δt和马达油液压力pt-1,确定当前t时刻马达油液压力pt:
步骤六:判断马达油液压力pt是否到达恒压变量泵的工作压力pr,若达到,则马达油液压力pt=pr,否则马达油液压力pt=pt;
步骤七:根据当前t时刻马达压力pt,计算t时刻液压马达输出扭矩Mg:
Mg=DMpt;
步骤八:由t时刻液压马达的输出扭矩Mg、t-1时刻液压马达的负载转矩Mt-1和角速度ωt-1,得到液压马达的角加速度
其中:M——液压马达的外负载转矩,即为螺旋桨转矩;液压马达的角加速度;JM——螺旋桨和液压马达轴的转动惯量;Mt——液压马达的负载转矩;
步骤九:由马达角加速度采样时间Δt和t-1时刻的马达角速度ωt-1,计算t时刻马达角速度ωt:
步骤十:根据t-1时刻的螺旋桨的进水速度Vt-1和螺旋桨的转速nt-1,得到t时刻螺旋桨的进速系数Jt:
其中,D——螺旋桨的直径;
步骤十一:根据t时刻螺旋桨的进速系数Jt,通过螺旋桨的敞水特性曲线得到t时刻螺旋桨的转矩系数KM和推力系数KT;
步骤十二:根据t时刻螺旋桨的推力系数KT、螺旋桨的角速度ωt得到t时刻螺旋桨推力Tt:
Tt=KTρnt 2D4
步骤十三:根据t时刻螺旋桨的转矩系数KM、螺旋桨的转速ωt,得到t时刻螺旋桨的转矩Mt:
Mt=KMρnt 2D5;
步骤十四:按照pt-1=pt、Qt-1=Qt、Mt-1=Mt、ωt-1=ωt重新赋初值,返回步骤一。
一种水下机器人伺服阀控制液压推进器动力学仿真系统的仿真方法,还可以包括:
1、伺服阀传递函数模块中的伺服阀传递函数为:
其中,Xv(s)——为伺服阀阀芯位移xv的拉氏变换;I(s)——为伺服阀输入电流iv的拉氏变换;Ksv——伺服阀的放大系数;Tv——伺服阀的时间常数。
2、所述的液压马达流量连续性方程为:
其中:Q——液压马达负载油液流量;DM——液压马达排量;Vt——阀腔、马达腔和连接管道的总容积;βe——等效体积弹性模量;——液压马达的压力增量;Ctc——液压马达的总泄露系数;θ——液压马达角位移;——液压马达角速度。
有益效果:
本发明将螺旋桨负载转矩引入到液压马达的力矩平衡方程中,使用步步迭代的方法实时求解液压马达的流量、压力、扭矩和转速状态;同时由马达转速和螺旋桨进水速度来实时求解螺旋桨的进速系数;最后将马达转速和螺旋桨进速系数代入螺旋桨的负载转矩和推力方程中,从而实时求解螺旋桨的负载转矩和推力。本方法可以在考虑液压马达转速和螺旋桨负载转矩实时变化的情况下,能够较准确的描述电液伺服阀控制液压推进器动力学系统的动态响应过程。本发明中的水下机器人伺服阀控制液压推进器的动力学仿真系统具有准确直观和逻辑清晰的特点,具有能够较真实的模拟实际作业型ROV的电液伺服阀控制液压推进器的功能及动态响应过程的优点。
附图说明
图1伺服阀控制液压推进器动力学仿真系统的结构原理图;
图2液压推进器的流量、压力、扭矩、转速、转矩和推力的迭代求解方法。
具体实施方式
下面将结合附图对本发明作进一步详细说明。
本发明目的在于提供一种伺服阀控制液压推进器动力学系统的仿真方法,可应用于作业型ROV仿真训练模拟器的液压推进器动力学仿真系统。如图1所示:本发明包括:伺服阀传递函数模块、伺服阀流量计算模块、恒压变量泵模块、伺服阀控制液压推进器动力学系统模块、螺旋桨推力计算模块、螺旋桨转矩计算模块、螺旋桨推力与转矩系数计算模块、螺旋桨进速系数计算模块等。本发明将螺旋桨负载转矩引入到液压马达的力矩平衡方程中,使用步步迭代的方法实时求解液压马达的流量、压力、扭矩和转速状态;同时由马达转速和螺旋桨进水速度来实时求解螺旋桨的进速系数;最后将马达转速和螺旋桨进速系数代入螺旋桨的负载转矩和推力方程中,从而实时求解螺旋桨的负载转矩和推力。本方法可以在考虑液压马达转速和螺旋桨负载转矩实时变化的情况下,能够较准确的描述电液伺服阀控制液压推进器动力学系统的动态响应过程。本发明中的水下机器人伺服阀控制液压推进器的动力学仿真系统具有准确直观和逻辑清晰的特点,具有能够较真实的模拟实际作业型ROV的电液伺服阀控制液压推进器的功能及动态响应过程的优点。
本发明的目的是这样实现的,如图1和图2所示:
第一步,与期望控制推力成正比的控制电流iv输入到“伺服阀传递函数”模块,按照下式(1)计算,输出一个伺服阀阀芯开口位移值xv。
伺服阀传递函数可由下式来表示:
式中:Xv(s)——为伺服阀阀芯位移xv的拉氏变换;I(s)——为伺服阀输入电流iv的拉氏变换;Ksv——伺服阀的放大系数;Tv——伺服阀的时间常数。
第二步,xv输入到“伺服阀流量计算”模块,按照下式(2)计算,伺服阀输出一个液压油流量Qv。
恒压泵的工作压力为p0,伺服阀的阀芯位移为xv,则伺服阀的流量Qv可按下式计算:
Qv=Kvxv (2)
式中:Kv——伺服阀的流量增益系数。
第三步,将上一t-1时刻的液压马达油液压力pt-1,根据下式(3)计算得到当前t时刻的马达负载流量Qt。
伺服阀控制液压马达的负载流量可用下式表示:
Qt=Kqxv-Kcp (3)
式中:p——液压马达两端油液压力差;xv——伺服阀阀芯移动距离;Kq——伺服阀流量增益;Kc——伺服阀流量压力增益。
第四步,由当前t时刻的马达负载流量Qt、t-1时刻的马达油液压力pt-1和角速度ωt-1,根据下式(4)计算当前t时刻的马达油液压力增加速度
液压马达流量连续性方程可以写为下式:
式中:Q——液压马达负载油液流量;DM——液压马达排量;Vt——阀腔、马达腔和连接管道的总容积;βe——等效体积弹性模量;——液压马达的压力增量;Ctc——液压马达的总泄露系数;θ——液压马达角位移;θ——液压马达角位移;——液压马达角速度。
第五步,由马达油液压力增加速度采样时间Δt和马达油液压力pt-1,计算当前t时刻马达油液压力pt。
第六步,判断pt是否到达液压泵的工作压力pr,若达到,则马达压力pt=pr,否则马达压力pt=pt。
第七步,由当前t时刻马达压力pt,根据下式(5)计算t时刻液压马达输出扭矩Mg。
液压马达的输出力矩Mg可按下式计算:
Mg=DMp (5)
第八步,由t时刻液压马达的输出扭矩Mg、t-1时刻液压马达的负载转矩Mt-1和角速度ωt-1,由下式(6)计算液压马达的角加速度
液压马达和负载力矩的平衡方程为:
式中:M——液压马达的外负载转矩,即为螺旋桨转矩;——液压马达的角加速度;JM——螺旋桨和液压马达轴的转动惯量;Mt——液压马达的负载转矩。
液压马达(螺旋桨)的转速n和角速度ω存在如下关系:
第九步,由马达角加速度采样时间Δt和t-1时刻的马达角速度ωt-1,计算t时刻马达角速度ωt。
第十步,由t时刻的ωt和转矩系数KM,按照下式(7)-(9)计算t时刻液压螺旋桨的负载转矩Mt。
螺旋桨转矩Mt可用下式计算:
Mt=KMρn2D5 (8)
式中:KM——螺旋桨转矩系数;ρ——海水密度;n——螺旋桨的转速。
可由t时刻螺旋桨的进速系数,通过螺旋桨的敞水特性曲线,得到t时刻螺旋桨的转矩系数KM和推力系数KT。
t时刻螺旋桨的进速系数J按下式计算:
式中:n——螺旋桨的转速;VA——螺旋桨的进速;即为螺旋桨的纵向进水速度;D——螺旋桨的直径。
第十一步,由t时刻马达角速度ωt和实时推力系数KT,按照下式(7)和(10)计算t时刻螺旋桨的推力Tt。
螺旋桨推力Tt可用下式计算:
T=KTρn2D4 (10)
式中:KT——螺旋桨推力系数。
螺旋桨的角速度ω和角位移θ存在如下关系:
第十二步,按照pt-1=pt、Qt-1=Qt、Mt-1=Mt、ωt-1=ωt重新赋初值。
一种水下机器人伺服阀控制液压推进器动力学系统的仿真方法,建立了一种适合水下机器人的伺服阀控制液压推进器的动力学仿真系统,提出了一种液压推进器的流量、压力、扭矩、转速、转矩和推力的迭代求解方法。本发明可较真实的模拟通过电液伺服阀来控制液压马达两端油液流量、压力、扭矩和转速的变化,进而调节螺旋桨输出转矩和推力的动态响应过程;可较真实的模拟螺旋桨负载连续变化条件下,液压马达的流量、压力和转速的动态响应过程。本发明对水下机器人的伺服阀控制液压推进器动力学仿真系统提供了一种有效和实用的解决方法。
一种液压推进器的流量、压力、扭矩、转速、螺旋桨转矩和推力的迭代计算方法,螺旋桨推力与其进水速度、液压马达流量和转速具有复杂的非线性关系,螺旋桨负载转矩与其进水速度、液压马达压力和转速也具有复杂的非线性关系,按照传递函数的方法难以建立水下机器人期望推力和螺旋桨输出推力之间的线性关系模型。本发明将螺旋桨实时负载转矩引入到液压马达的力矩平衡方程中,使用步步迭代的方法实时求解液压马达的流量、压力、扭矩和转速,进而实时求解螺旋桨的负载转矩和推力。
一种适合水下机器人的伺服阀控制液压推进器的动力学仿真系统,建立电液伺服阀的传递函数模型,将电流控制信号转换成阀芯位移信号;建立阀芯位移与液压阀流量的传递函数模型,将阀芯位移信号转换成伺服阀流量信号;建立伺服阀流量和负载流量的关系模型,将伺服阀流量转化为负载流量;建立液压螺旋桨推进器动力学系统模型,将马达负载流量转化为液压马达的油液压力、扭矩和转速,从而使螺旋桨输出转矩和推力。
可较真实模拟螺旋桨负载连续变化条件下,液压马达的流量、压力、扭矩和转速的动态响应过程,在输入控制电流信号不变的条件下,当螺旋桨负载减小时,螺旋桨负载扭矩降低,从而使马达转速增加,马达两端油液压力降低,最终负载流量增加,转速进一步增加;当马达负载流量增加到伺服阀的最大输入流量时,马达负载流量不再增加,马达转速也不再增加,保持恒定转速运行。当螺旋桨负载增加时,马达转速、压力和流量的变化规律和以上过程相反。
本发明属于无人水下机器人运动控制技术领域,具体涉及一种作业型水下机器人(ROV—Remotely Operated Vehicle)伺服阀控制液压推进器动力学系统的仿真方法。本发明目的在于建立了一种适合水下机器人的伺服阀控制液压推进器的动力学仿真系统,并提出了一种液压推进器的压力、扭矩、转速、螺旋桨转矩和推力的迭代求解方法。本发明包括:伺服阀传递函数模块、伺服阀流量计算模块、恒压变量泵模块、伺服阀控制液压推进器动力学系统模块、螺旋桨推力计算模块、螺旋桨转矩计算模块、螺旋桨推力与转矩系数计算模块、进速系数计算模块等。本发明可较真实的模拟通过电液伺服阀来控制液压马达两端油液流量、压力、扭矩和转速的变化,进而调节螺旋桨输出转矩和推力的动态过程;可较真实的模拟螺旋桨负载连续变化条件下,液压马达的流量、压力扭矩和转速的动态响应过程。本发明对作业型水下机器人的伺服阀控制液压推进器动力学仿真系统提供了一种可行、有效的解决方法。
一种水下机器人伺服阀控制液压推进器动力学仿真系统的仿真方法:
第一步,如图2所示,按照公式p0=0、Q0=0、M0=0、ω0=0对液压推进器动力学仿真系统进行初始化。
第二步,如图1所示,将控制电流iv输入到“伺服阀传递函数”模块,可以计算得到t时刻伺服阀的开口位移值xv,其中控制电流iv和推进器的期望控制推力成正比。
第三步,如图1-2所示,将伺服阀的开口位移值xv输入到“伺服阀流量计算”模块,可以计算得到t时刻伺服阀流量Qv。
第四步,如图2所示,将伺服阀流量Qv输入到“计算马达负载流量”模块,并根据t-1时刻的液压马达油液压力pt-1,由下式(12)计算当前t时刻的马达负载流量Qt。
Qt=Kqxv-Kcpt-1 (12)
第五步,如图2所示,将马达负载流量Qt输入到“计算马达油液压力增加速度”模块,并根据t-1时刻的液压马达油液压力pt-1、马达角速度ωt-1,由下式(13)计算当前t时刻的马达负载压力增加速度
第六步,如图2所示,将马达负载压力增加速度输入到“计算马达油液压力”模块,由下式(14)计算当前t时刻的马达的油液压力pt。
第七步,如图2所示,将当前t时刻的马达的油液压力pt输入到“判断当前是否达到当前液压泵的压力”模块。若达到当前工作压力,则pt=pr;否则pt=pt。
第八步,如图2所示,t时刻的马达的油液压力pt输入到计算马达输出扭矩模块,由下式(15)计算当前t时刻的马达的输出扭矩Mg。
Mg=DMpt (15)
第九步,如图2所示,将t时刻的马达的输出扭矩Mg、t-1时刻的螺旋桨负载转矩Mt-1和螺旋桨转动角速度ωt-1输入到“计算马达角加速度模块”,按照下式(16)计算t时刻液压马达的角加速度
式中:
第十步,如图2所示,将t时刻的液压马达的角加速度输入到“计算马达角速度”模块,按照下式(17)计算t时刻液压马达的角速度ωt。
第十一步,如图1所示,将t-1时刻的螺旋桨的进水速度Vt-1和螺旋桨的转速nt-1输入到“进速系数计算”模块,按照下式(18)计算t时刻螺旋桨的进速系数Jt:
式中:
第十二步,如图1所示,将t时刻螺旋桨的进速系数Jt分别输入到“螺旋桨推力系数计算”模块和“螺旋桨转矩系数计算”模块,按照对应螺旋桨的敞水特性曲线计算t时刻螺旋桨的转矩系数KM和推力系数KT。
第十三步,如图2所示,将t时刻螺旋桨的推力系数KT、螺旋桨的角速度ωt输入到“计算螺旋桨推力”模块,按照下式(19)-(20),可得t时刻螺旋桨推力Tt。
Tt=KTρnt 2D4 (20)
第十四步,如图2所示,将t时刻螺旋桨的转矩系数KM、螺旋桨的转速ωt分别输入到“计算螺旋桨转矩”模块,按照下式(21)可得t时刻螺旋桨的转矩Mt。
Mt=KMρnt 2D5 (21)
第十五步,按照下式(22)-(25)给液压推进器动力学仿真系统重新赋初值。
pt-1=pt (22)
Qt-1=Qt (23)
Mt-1=Mt (24)
ωt-1=ωt (25)
在以上模块各自功能调试及联调无误后,设定一个螺旋桨进速初始值,给一个期望推力值对应的控制电流iv。在Matlab中运行仿真程序后,在输入电流控制不变的条件下,当螺旋桨负载减小时,螺旋桨负载扭矩降低,从而使马达转速增加,马达两端油液压力降低,最终负载流量增加,转速进一步增加;当马达负载流量增加到伺服阀的最大输入流量时,马达负载流量不再增加,马达转速也不再增加,保持恒定转速运行。当螺旋桨负载增加时,马达转速、压力和流量的变化规律和以上过程相反。在Matlab中运行仿真程序后,当输入与期望推力成正比的控制电流时,螺旋桨可输出与期望推力值一致的推力。本发明可较真实模拟螺旋桨负载连续变化条件下,液压马达的转速、压力及流量的动态响应过程。本发明最终应用于作业型ROV仿真训练模拟器的设计中,可较真实的模拟在8台液压推进器的共同控制作用下,作业型ROV六自由度的运动和姿态的动态响应过程。
符号说明:
iv——伺服阀控制电流;xv——伺服阀开口位移值;pr——恒压泵的工作压力;Qv——伺服阀的流量;ω——液压马达的转动角速度;M——螺旋桨的负载转矩;T——螺旋桨的推力;KM——螺旋桨转矩系数;KT——螺旋桨推力系数;J——螺旋桨的进速系数;VA——螺旋桨的水流进速。
Qt——t时刻的负载流量;——马达油液压力增加速度;pt——t时刻的马达负载压力;Mg——t时刻的马达输出扭矩;——液压马达的角加速度;ωt——t时刻的液压马达角速度;Tt——t时刻的螺旋桨推力;Qt-1——t-1时刻的负载流量;pt-1——t-1时刻的马达负载压力;ωt-1——t-1时刻的液压马达角速度;Tt-1——t-1时刻的螺旋桨推力;Q0——初始时刻的负载流量;p0——初始时刻的马达负载压力;ω0——初始时刻的液压马达角速度;M0——初始时刻螺旋桨的负载转矩。
Claims (4)
1.一种水下机器人伺服阀控制液压推进器动力学仿真系统,其特征在于:包括伺服阀传递函数模块、伺服阀流量计算模块、恒压变量泵模块、伺服阀控制液压推进器动力学系统模块、螺旋桨推力计算模块、螺旋桨转矩计算模块、螺旋桨推力与转矩系数计算模块和螺旋桨进速系数计算模块;
将与期望控制推力成正比的控制电流iv输入到伺服阀传递函数模块,输出一个伺服阀阀芯开口位移值xv;将伺服阀阀芯开口位移值xv输入到伺服阀流量计算模块,得到伺服阀流量Qv输入给伺服阀控制液压推进器动力学系统模块;将恒压变量泵的工作压力pr输入到伺服阀流量计算模块后输送给伺服阀控制液压推进器动力学系统模块;伺服阀控制液压推进器动力学系统模块根据接收的伺服阀流量Qv和t-1时刻的马达油液压力pt-1和角速度ωt-1,得到马达的油液压力pt、输出扭矩Mg和角速度ωt;
将t-1时刻的螺旋桨的进水速度Vt-1和螺旋桨的转速nt-1输入到螺旋桨进速系数计算模块,得到t时刻螺旋桨的进速系数Jt;将t时刻螺旋桨的进速系数Jt输入到螺旋桨推力与转矩系数计算模块,得到t时刻螺旋桨的转矩系数KM和推力系数KT;
将t时刻螺旋桨的推力系数KT、马达的角速度ωt输入到螺旋桨推力计算模块得到t时刻螺旋桨推力Tt;将t时刻螺旋桨的转矩系数KM、马达的转速ωt输入到螺旋桨转矩计算模块,得t时刻螺旋桨的转矩Mt。
2.一种水下机器人伺服阀控制液压推进器动力学仿真系统的仿真方法,其特征在于:
包括以下步骤:
步骤一:将与期望控制推力成正比的控制电流iv输入到伺服阀传递函数模块,输出一个伺服阀阀芯开口位移值xv;
步骤二:根据伺服阀阀芯开口位移值xv,得到伺服阀流量Qv:
Qv=Kvxv
其中,Kv——伺服阀的流量增益系数;
步骤三:计算当前t时刻的马达负载流量Qt:
Qt=Kqxv-Kcp
其中:p——液压马达两端油液压力差;Kq——伺服阀流量增益;Kc——伺服阀流量压力增益;
步骤四:由当前t时刻的马达负载流量Qt、t-1时刻的马达油液压力pt-1和角速度ωt-1,根据液压马达流量连续性方程确定当前t时刻的马达油液压力增加速度
步骤五:由马达油液压力增加速度采样时间Δt和马达油液压力pt-1,确定当前t时刻马达油液压力pt:
步骤六:判断马达油液压力pt是否到达恒压变量泵的工作压力pr,若达到,则马达油液压力pt=pr,否则马达油液压力pt=pt;
步骤七:根据当前t时刻马达压力pt,计算t时刻液压马达输出扭矩Mg:
Mg=DMpt;
步骤八:由t时刻液压马达的输出扭矩Mg、t-1时刻液压马达的负载转矩Mt-1和角速度ωt-1,得到液压马达的角加速度
其中:M——液压马达的外负载转矩,即为螺旋桨转矩;液压马达的角加速度;JM——螺旋桨和液压马达轴的转动惯量;Mt——液压马达的负载转矩;
步骤九:由马达角加速度采样时间Δt和t-1时刻的马达角速度ωt-1,计算t时刻马达角速度ωt:
步骤十:根据t-1时刻的螺旋桨的进水速度Vt-1和螺旋桨的转速nt-1,得到t时刻螺旋桨的进速系数Jt:
其中,D——螺旋桨的直径;
步骤十一:根据t时刻螺旋桨的进速系数Jt,通过螺旋桨的敞水特性曲线得到t时刻螺旋桨的转矩系数KM和推力系数KT;
步骤十二:根据t时刻螺旋桨的推力系数KT、螺旋桨的角速度ωt得到t时刻螺旋桨推力Tt:
Tt=KTρnt 2D4
步骤十三:根据t时刻螺旋桨的转矩系数KM、螺旋桨的转速nt,得到t时刻螺旋桨的转矩Mt:
Mt=KMρnt 2D5;
步骤十四:按照pt-1=pt、Qt-1=Qt、Mt-1=Mt、ωt-1=ωt重新赋初值,返回步骤一。
3.根据权利要求2所述的一种水下机器人伺服阀控制液压推进器动力学仿真系统的仿真方法,其特征在于:伺服阀传递函数模块中的伺服阀传递函数为:
其中,Xv(s)——为伺服阀阀芯位移xv的拉氏变换;I(s)——为伺服阀输入电流iv的拉氏变换;Ksv——伺服阀的放大系数;Tv——伺服阀的时间常数。
4.根据权利要求2所述的一种水下机器人伺服阀控制液压推进器动力学仿真系统的仿真方法,其特征在于:所述的液压马达流量连续性方程为:
其中:Q——液压马达负载油液流量;DM——液压马达排量;Vt——阀腔、马达腔和连接管道的总容积;βe——等效体积弹性模量;——液压马达的压力增量;Ctc——液压马达的总泄露系数;θ——液压马达角位移;液压马达角速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610265233.3A CN105759632B (zh) | 2016-04-26 | 2016-04-26 | 一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610265233.3A CN105759632B (zh) | 2016-04-26 | 2016-04-26 | 一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105759632A CN105759632A (zh) | 2016-07-13 |
CN105759632B true CN105759632B (zh) | 2018-08-31 |
Family
ID=56325971
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610265233.3A Active CN105759632B (zh) | 2016-04-26 | 2016-04-26 | 一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105759632B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107194106B (zh) * | 2017-06-12 | 2019-12-10 | 哈尔滨工程大学 | 一种全回转推进器的液压回转动力学控制系统的仿真方法 |
CN110206488A (zh) * | 2019-07-09 | 2019-09-06 | 广州海洋地质调查局 | 一种移动型深海取样钻机 |
CN111143985B (zh) * | 2019-12-23 | 2022-06-21 | 哈尔滨工程大学 | 一种螺旋桨负载下电力推进器动力学响应的仿真方法 |
CN112596412A (zh) * | 2020-12-11 | 2021-04-02 | 中国科学院沈阳自动化研究所 | 一种多auv仿真平台 |
CN114545908B (zh) * | 2022-04-28 | 2022-07-19 | 中汽研汽车检验中心(天津)有限公司 | 车用液压系统模型构建和仿真方法,及整车仿真系统 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102006044358A1 (de) * | 2006-09-20 | 2008-04-03 | Etel S.A. | Positioniereinrichtung in Portalbauweise |
CN101544281B (zh) * | 2009-04-13 | 2011-04-06 | 苏州同元软控信息技术有限公司 | 飞机反推力液压装置半实物实时仿真系统 |
CN102734274A (zh) * | 2011-04-02 | 2012-10-17 | 北京石油化工学院 | 一种基于虚拟原型技术的液压伺服系统 |
CN104345638B (zh) * | 2014-10-09 | 2017-06-27 | 南京理工大学 | 一种液压马达位置伺服系统的自抗扰自适应控制方法 |
CN104730935A (zh) * | 2015-01-19 | 2015-06-24 | 哈尔滨工业大学 | 单向摩擦加载式无多余力矩电液负载模拟器 |
CN105425610B (zh) * | 2015-11-09 | 2018-07-24 | 哈尔滨工程大学 | 一种作业型水下机器人液压推进器的推力控制仿真系统 |
-
2016
- 2016-04-26 CN CN201610265233.3A patent/CN105759632B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105759632A (zh) | 2016-07-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105759632B (zh) | 一种水下机器人伺服阀控制液压推进器动力学仿真系统及其仿真方法 | |
CN105319987B (zh) | 一种作业型rov训练模拟器的运动控制仿真系统 | |
CN111856965A (zh) | 一种无人机可视化半实物仿真系统及其仿真方法 | |
CN103558079B (zh) | 基于并联机构驱动力闭环的多自由度加载方法 | |
Costa et al. | Simtwo realistic simulator: A tool for the development and validation of robot software | |
CN103365215A (zh) | 一种四旋翼无人飞行器半实物仿真实验系统及实验方法 | |
Montazeri-Gh et al. | Actuator-based hardware-in-the-loop testing of a jet engine fuel control unit in flight conditions | |
CN105425610B (zh) | 一种作业型水下机器人液压推进器的推力控制仿真系统 | |
CN107179682A (zh) | 一种被动式负载模拟器及多余力矩抑制方法 | |
CN104090497B (zh) | 用于海洋工程领域的动力定位系统仿真系统及其工作方法 | |
Zhou et al. | Dynamic modeling and endurance enhancement analysis of deep-sea gliders with a hybrid buoyancy regulating system | |
CN104210640B (zh) | 一种平流层浮空器矢量推进装置 | |
CN102566417A (zh) | 一种柔性关节机械臂的动态面控制方法 | |
CN114706322B (zh) | 一种盾构机姿态自动控制仿真系统 | |
CN104267606B (zh) | 一种动力定位控制系统硬件在环测试仿真器及其工作方法 | |
CN103984327B (zh) | 一种基于模糊控制的小型数字舵机系统 | |
CN109739108A (zh) | Auv运动控制系统硬件在环测试仿真系统及其工作方法 | |
Walczak et al. | Simulation of water hydraulic control system of Francis turbine | |
CN203930517U (zh) | 一种旋转倒立摆控制实验系统 | |
CN113883031B (zh) | 一种基于温差能发电驱动的剖面浮标的发电控制方法 | |
CN113933016B (zh) | 一种模拟漂浮式风电机组运动响应的风洞试验装置与方法 | |
CN202183176U (zh) | 加载梯度随动被动加载舵机负载模拟器 | |
CN107975458B (zh) | 一种基于转矩闭环控制的风力机柔性传动特性的模拟方法 | |
CN102486899B (zh) | 加载梯度随动被动加载舵机负载模拟器 | |
CN104035450A (zh) | 一种旋转倒立摆控制实验系统及控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |