首页 > 专利 > 江苏科技大学 > 异构多阀并联驱动电液伺服系统及控制方法专利详情

异构多阀并联驱动电液伺服系统及控制方法   0    0

有效专利 查看PDF
专利申请流程有哪些步骤?
专利申请流程图
申请
申请号:指国家知识产权局受理一件专利申请时给予该专利申请的一个标示号码。唯一性原则。
申请日:提出专利申请之日。
2020-04-27
申请公布
申请公布指发明专利申请经初步审查合格后,自申请日(或优先权日)起18个月期满时的公布或根据申请人的请求提前进行的公布。
申请公布号:专利申请过程中,在尚未取得专利授权之前,国家专利局《专利公报》公开专利时的编号。
申请公布日:申请公开的日期,即在专利公报上予以公开的日期。
2020-09-29
授权
授权指对发明专利申请经实质审查没有发现驳回理由,授予发明专利权;或对实用新型或外观设计专利申请经初步审查没有发现驳回理由,授予实用新型专利权或外观设计专利权。
2022-05-24
预估到期
发明专利权的期限为二十年,实用新型专利权期限为十年,外观设计专利权期限为十五年,均自申请日起计算。专利届满后法律终止保护。
2040-04-27
基本信息
有效性 有效专利 专利类型 发明专利
申请号 CN202010343061.3 申请日 2020-04-27
公开/公告号 CN111622996B 公开/公告日 2022-05-24
授权日 2022-05-24 预估到期日 2040-04-27
申请年 2020年 公开/公告年 2022年
缴费截止日
分类号 F15B11/08F15B13/04F15B15/28F15B21/08F15B21/041 主分类号 F15B11/08
是否联合申请 独立申请 文献类型号 B
独权数量 1 从权数量 3
权利要求数量 4 非专利引证数量 0
引用专利数量 0 被引证专利数量 0
非专利引证
引用专利 被引证专利
专利权维持 2 专利申请国编码 CN
专利事件 事务标签 公开、实质审查、授权
申请人信息
申请人 第一申请人
专利权人 江苏科技大学 当前专利权人 江苏科技大学
发明人 苏世杰、潘纬鸣、唐文献、陈赟、薛挺、王真心 第一发明人 苏世杰
地址 江苏省镇江市梦溪路2号 邮编 212003
申请人数量 1 发明人数量 6
申请人所在省 江苏省 申请人所在市 江苏省镇江市
代理人信息
代理机构
专利代理机构是经省专利管理局审核,国家知识产权局批准设立,可以接受委托人的委托,在委托权限范围内以委托人的名义办理专利申请或其他专利事务的服务机构。
南京苏高专利商标事务所 代理人
专利代理师是代理他人进行专利申请和办理其他专利事务,取得一定资格的人。
赵淑芳
摘要
本发明公开了一种异构多阀并联驱动电液伺服系统及控制方法,包括柱塞泵,柱塞泵通过多个并联的各个伺服阀和比例阀与液压缸连通,液压缸的活塞杆信号连接位移传感器,位移传感器与控制器的输入端信号连接,控制器的输出端与各个比例阀和伺服阀信号连接,控制器根据油量剩余总量按照比例阀和伺服阀的工作优先级进行分配,根据分配的油量设置控制电压。本发明通过通过多阀并联协调控制方法弥补了比例阀存在的死区和响应速度慢等问题,在满足高精度、快响应、大流量等性能的同时,还通过异构多阀的并联结构节约了成本,并通过自适应鲁棒算法解决了存在的自适应可调参数和外部干扰等问题。
  • 摘要附图
    异构多阀并联驱动电液伺服系统及控制方法
  • 说明书附图:图1
    异构多阀并联驱动电液伺服系统及控制方法
  • 说明书附图:图2
    异构多阀并联驱动电液伺服系统及控制方法
  • 说明书附图:图3
    异构多阀并联驱动电液伺服系统及控制方法
法律状态
序号 法律状态公告日 法律状态 法律状态信息
1 2022-05-24 授权
2 2020-09-29 实质审查的生效 IPC(主分类): F15B 11/08 专利申请号: 202010343061.3 申请日: 2020.04.27
3 2020-09-04 公开
权利要求
权利要求书是申请文件最核心的部分,是申请人向国家申请保护他的发明创造及划定保护范围的文件。
1.一种异构多阀并联驱动电液伺服系统的控制方法,其特征在于,所述异构多阀并联驱动电液伺服系统包括柱塞泵,所述柱塞泵进油口连接油箱,所述柱塞泵出油口通过单向阀后通过支路连通并联的各个伺服阀和比例阀,各个伺服阀和比例阀的回油口通过管路与油箱连通,各个伺服阀和比例阀的出油口通过管路与液压缸连通,所述液压缸的活塞杆信号连接位移传感器,所述位移传感器与控制器的输入端信号连接,所述控制器的输出端与各个比例阀和伺服阀信号连接;
该系统的控制方法包括以下步骤:
一、控制器根据系统的工作时间T计算得到当前液压缸的目标位移xd,并对xd求一阶导数 二阶导数 和三阶导数 位移传感器R采集当前时刻的实际位移xp,对比实际位移xp和目标位移xd,得到位移偏差e,并对e求一阶导数 二阶导数 三阶导数
二、根据得到的目标位移和位移偏差及导数计算得到驱动液压缸运动的总流量Qy(T),计算公式如下:
其中,dy、My、By、Dy和Cy均为液压系统通过数学模型得出的自适应可调参数;
三、以步骤二得到的驱动液压缸运动的总流量作为初始剩余总流量,初始剩余总流量Qyi(T)=Qy(T);
四、将剩余总流量根据各个比例阀的工作优先级依次分配各比例阀的流量,根据分配的流量得到当前控制周期内比例阀的控制电压,具体如下:
当Qyi(T)>fi(Upi(T‑t)+ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)+ΔUpi;
当Qyi(T)<fi(Upi(T‑t)‑ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)‑ΔUpi;
当fi(Upi(T‑t)‑ΔUpi)≤Qyi(T)≤fi(Upi(T‑t)+ΔUpi)时,Qyi(T)>0则比例阀Pi的控制电压置为 Qyi(T)<0则控制电压置为
其中, 表示每控制周期控制电压的最大增量,Upimax表示比例阀Pi的最大输
出电压,Tpi表示比例阀Pi阀芯响应时间,Di表示比例阀Pi的死区,Kpi表示比例阀Pi的增益,t表示控制周期,fi(Upi(T‑t)+ΔUpi)表示当前控制周期比例阀输出的最大流量fi(Upi(T‑t)‑ΔUpi)表示当前控制周期比例阀输出的最小流量,Upi(T‑t)表示上个控制周期比例阀输出的电压;
五、分配完各个比例阀的流量后的剩余流量根据伺服阀的工作优先级依次分配各个伺服阀的流量,根据分配的流量得到当前控制周期内伺服阀的控制电压,具体如下:
当gi(Usi(T‑t)‑ΔUsi)≤Qyi(T)≤gi(Usi(T‑t)+ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑t)+ΔUsi;
当Qyi(T)<gi(Usi(T‑t)‑ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑t)‑ΔUsi;
当gi(Usi(T‑t)‑ΔUsi)≤Qyi(T)≤gi(Usi(T‑t)+ΔUsi)时,伺服阀Si的控制电压置为其中,Si的电压值增量 Usimax为伺服阀Si的最大输出电压,Tsi伺服阀Si阀芯
响应时间,gi(Usi(T‑t)+ΔUsi)表示当前控制周期伺服阀可以输出流量的最大值,gi(Usi(T‑t)‑ΔUsi)表示当前控制周期伺服阀可以输出流量的最小值,Usi(T‑t)表示上个控制周期伺服阀的输出电压;
六、工作时间T<Tmax0时,进行下一个控制周期的控制,对自适应可调参数进行更新,然后重复步骤一至五,直到T≥Tmax0,系统停止控制,其中自适应可调参数进行更新具体为:
自适应可调参数My根据公式 进行更新,当更新值My>Mymax时,My=
Mymax;当更新值My<Mymin时,My=Mymin;
自适应可调参数By根据公式 进行更新,当更新值By>Bymax时,By=Bymax;
当更新值By<Bymin时,By=Bymin;
自适应可调参数Cy根据公式 进行更新,当更新值Cy>Cymax时,Cy=Cymax;
当更新值Cy<Cymin时,Cy=Cymin;
自适应可调参数Dy根据公式 进行更新,当更新值Dy>Dymax时,Dy=Dymax;
当更新值Dy<Dymin时,Dy=Dymin;
自适应可调参数dy根据公式 进行更新,当更新值dy>dymax时,dy=dymax;
当更新值dy<dymin时,dy=dymin;
其中,Mymin、Mymax分别为My的最小值与最大值,Bymin、Bymax分别为By的最小值与最大值,Cymin、Cymax分别为Cy的最小值与最大值,Dymin、Dymax分别为Dy的最小值与最大值,dymin、dymax分别为dy的最小值与最大值,λ为系统增益。

2.根据权利要求1所述的异构多阀并联驱动电液伺服系统的控制方法,其特征在于,所述柱塞泵电连接三相电机,所述三相电机控制柱塞泵工作。

3.根据权利要求1所述的异构多阀并联驱动电液伺服系统的控制方法,其特征在于,所述单向阀通过回油支路连通油箱,所述回油支路上设置有溢流阀和滤油器。

4.根据权利要求1所述的异构多阀并联驱动电液伺服系统的控制方法,其特征在于,所述步骤一中根据预设函数xd=F(T)计算液压缸的目标位移,根据e=xp‑xd计算位移偏差。
说明书

技术领域

[0001] 本发明涉及电液伺服系统及控制,具体涉及一种异构多阀并联驱动电液伺服系统及控制方法。

背景技术

[0002] 电液伺服在工业生产中应用广泛,随着技术的进步,对电液伺服系统的流量、响应速度性能要求也越来越高,因此大流量、高精度电液伺服阀应运而生。但是大流量电液伺服阀的低速性能不理想,而且成本较高。为了节约成本并满足高精度控制要求,使用多个伺服阀/比例阀并联控制的方案具有一定理论和实现意义。
[0003] 中国专利CN201210467404.2的专利公开了“一种液压并联式速度换接回路连接方法”该方法通过并联两个调速阀,通过调速阀实现两次进给速度的切换回路,通过该方法使系统的位置控制精度得到了提高。其次中国专利申请号为CN200820087129.0的专利公开了“基于并联型先导级的大流量高频响电液伺服阀”,该专利提出一种并联多个小流量的伺服阀等效为大流量伺服阀的方法,随后通过同步控制控制算法实现各个伺服阀输出流量的同步,该方法有效提高了系统的响应精度和流量。
[0004] 虽然上述方法都改进了电液伺服系统的控制精度与响应速度,但由于都是采用相同的阀进行并联,因此在控制的时候通常采用同步控制方法,而同步控制要求系统中各个阀的性能指标尽量一致,因此会导致系统的成本上升、可靠性降低。

发明内容

[0005] 发明目的:本发明的目的是提供一种异构多阀并联驱动电液伺服系统及控制方法,解决现有多阀并联系统中同步控制对阀的性能指标要求高,可靠性低,成本高的问题。
[0006] 技术方案:本发明所述的异构多阀并联驱动电液伺服系统,包括柱塞泵,所述柱塞泵进油口连接油箱,所述柱塞泵出油口通过单向阀后通过支路连通并联的各个伺服阀和比例阀,各个伺服阀和比例阀的回油口通过管路与油箱连通,各个伺服阀和比例阀的出油口通过管路与液压缸连通,所述液压缸的活塞杆信号连接位移传感器,所述位移传感器与控制器的输入端信号连接,所述控制器的输出端与各个比例阀和伺服阀信号连接。
[0007] 其中,所述柱塞泵电连接三相电机,所述三相电机控制柱塞泵工作。
[0008] 为保证主回油管路上的管道压力,所述单向阀通过回油支路连通油箱,所述回油支路上设置有溢流阀和滤油器。
[0009] 本发明所述的异构多阀并联驱动电液伺服系统的控制方法,包括以下步骤:
[0010] (1)控制器根据系统的工作时间T计算得到当前液压缸的目标位移xd,并对xd求一阶导数 二阶导数 和三阶导数 位移传感器R采集当前时刻的实际位移xp,对比实际位移xp和目标位移xd,得到位移偏差e,并对e求一阶导数 二阶导数 三阶导数
[0011] (2)根据得到的目标位移和位移偏差及导数计算得到驱动液压缸运动的总流量Qy(T),计算公式如下:
[0012]
[0013] 其中,dy、My、By、Dy和Cy均为液压系统通过数学模型得出的自适应可调参数;
[0014] (3)以步骤(2)得到的驱动液压缸运动的总流量作为初始剩余总流量,初始剩余总流量Qyi(T)=Qy(T);
[0015] (4)将剩余总流量根据各个比例阀的工作优先级依次分配各比例阀的流量,根据分配的流量得到当前控制周期内比例阀的控制电压,具体如下:
[0016] 当Qyi(T)>fi(Upi(T‑t)+ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)+ΔUpi;
[0017] 当Qyi(T)<fi(Upi(T‑t)‑ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)‑ΔUpi;
[0018] 当fi(Upi(T‑t)‑ΔUpi)≤Qyi(T)≤fi(Upi(T‑t)+ΔUpi)时,Qyi(T)>0则比例阀Pi的控制电压置为 Qyi(T)<0则控制电压置为
[0019] 其中, 表示每控制周期控制电压的最大增量,Upimax表示比例阀Pi的最大输出电压,Tpi表示比例阀Pi阀芯响应时间,Di表示比例阀Pi的死区,Kpi表示比例阀Pi的增益,t表示控制周期,fi(Upi(T‑t)+ΔUpi)表示当前控制周期比例阀输出的最大流量fi(Upi(T‑t)‑ΔUpi)表示当前控制周期比例阀输出的最小流量,Upi(T‑t)表示上个控制周期比例阀输出的电压;
[0020] (5)分配完各个比例阀的流量后的剩余流量根据伺服阀的工作优先级依次分配各个伺服阀的流量,根据分配的流量得到当前控制周期内伺服阀的控制电压,具体如下:
[0021] 当gi(Usi(T‑t)‑ΔUsi)≤Qyi(T)≤gi(Usi(T‑t)+ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑t)+ΔUsi;
[0022] 当Qyi(T)<gi(Usi(T‑t)‑ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑t)‑ΔUsi;
[0023] 当gi(Usi(T‑t)‑ΔUsi)≤Qyi(T)≤gi(Usi(T‑t)+ΔUsi)时,伺服阀Si的控制电压置为[0024] 其中,Si的电压值增量 Usimax为伺服阀Si的最大输出电压,Tsi伺服阀Si阀芯响应时间,gi(Usi(T‑t)+ΔUsi)表示当前控制周期伺服阀可以输出流量的最大值,gi(Usi(T‑t)‑ΔUsi)表示当前控制周期伺服阀可以输出流量的最小值,Usi(T‑t)表示上个控制周期伺服阀的输出电压;
[0025] (6)工作时间T<Tmax0时,进行下一个控制周期的控制,对自适应可调参数进行更新,然后重复步骤(1)‑(5),直到T≥Tmax0,系统停止控制。
[0026] 其中,所述步骤(1)中根据预设函数xd=F(T)计算液压缸的目标位移,根据e=xp‑xd计算位移偏差。
[0027] 所述步骤(6)对自适应可调参数进行更新具体为:
[0028] 自适应可调参数My根据公式 进行更新,当更新值My>Mymax时,My=Mymax;当更新值My<Mymin时,My=Mymin;
[0029] 自适应可调参数By根据公式 进行更新,当更新值By>Bymax时,By=Bymax;当更新值By<Bymin时,By=Bymin;
[0030] 自适应可调参数Cy根据公式 进行更新,当更新值Cy>Cymax时,Cy=Cymax;当更新值Cy<Cymin时,Cy=Cymin;
[0031] 自适应可调参数Dy根据公式 进行更新,当更新值Dy>Dymax时,Dy=Dymax;当更新值Dy<Dymin时,Dy=Dymin;
[0032] 自适应可调参数dy根据公式 进行更新,当更新值dy>dymax时,dy=dymax;当更新值dy<dymin时,dy=dymin;
[0033] 其中,Mymin、Mymax分别为My的最小值与最大值,Bymin、Bymax分别为By的最小值与最大值,Cymin、Cymax分别为Cy的最小值与最大值,Dymin、Dymax分别为Dy的最小值与最大值,dymin、dymax分别为dy的最小值与最大值,λ为系统增益。
[0034] 有益效果:本发明通过通过多阀并联协调控制方法弥补了比例阀存在的死区和响应速度慢等问题,在满足高精度、快响应、大流量等性能的同时,还通过异构多阀的并联结构节约了成本,并通过自适应鲁棒算法解决了存在的自适应可调参数和外部干扰等问题。

实施方案

[0038] 下面结合附图对本发明进行进一步说明。
[0039] 如图1所示,异构多阀并联驱动电液伺服系统主要包括:柱塞泵6,三相电机7,比例阀P13、比例阀P2……比例阀Pm2,伺服阀Sm+19、伺服阀Sm+2……伺服阀Sn10,单向阀8,液压缸1,溢流阀4,位移传感器12,控制器11,滤油器5。三相电机7与柱塞泵6连接,柱塞泵6的进油口与油箱连接,三相电机旋转带动柱塞泵工作,柱塞泵开始对液压系统供油;输出的液压油通过柱塞泵的出油口流向单向阀,液压油通过单向阀流向滤油器,随后液压油通过高压软管流向每个伺服阀进油口和每个比例阀的进油口。溢流阀安装在主回油管路上保证管道压力,液压油通过每个伺服阀和每个比例阀的回油口与高压软管连接并流向油箱。液压缸与每个伺服阀和每个比例阀的出油口连接,液压缸的活塞杆与位移传感器连接;位移传感器
12的信号输出端与控制器11的输入端连接,控制器11的n个输出端分别和比例阀P1……Pm的控制信号输入端及伺服阀Sm+1……Sn的控制信号输入端相连接。
[0040] 本发明的控制方法具体为:
[0041] (1)控制器根据系统的工作时间T计算得到当前液压缸的目标位移xd,xd=F(T),并对xd求一阶导数 二阶导数 和三阶导数 位移传感器R采集当前时刻的实际位移xp,根据e=xp‑xd得到位移偏差e,并对e求一阶导数 二阶导数 三阶导数
[0042] (2)根据得到的目标位移和位移偏差及导数计算驱动液压缸运动的总流量,计算公式如下:
[0043]
[0044] 其中,dy、My、By、Dy和Cy均为液压系统通过数学模型得出的自适应可调参数;
[0045] (3)以步骤(2)驱动液压缸运动的总流量作为初始剩余总流量,初始剩余总流量Qyi(T)=Qy(T);
[0046] (4)将剩余总流量根据各个比例阀的工作优先级依次分配各比例阀的流量,根据分配的流量得到当前控制周期内比例阀的控制电压,具体如下:
[0047] 当Qyi(T)>fi(Upi(T‑t)+ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)+ΔUpi;
[0048] 当Qyi(T)<fi(Upi(T‑t)‑ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)‑ΔUpi;
[0049] 当fi(Upi(T‑t)‑ΔUpi)≤Qyi(T)≤fi(Upi(T‑t)+ΔUpi)时,Qyi(T)>0则比例阀Pi的控制电压置为 Qyi(T)<0则控制电压置为
[0050] 其中, 表示每控制周期控制电压的最大增量,Upimax表示比例阀Pi的最大输出电压,Tpi表示比例阀Pi阀芯响应时间,Di表示比例阀Pi的死区,Kpi表示比例阀Pi的增益,t表示控制周期,fi(Upi(T‑t)+ΔUpi)表示当前控制周期比例阀输出的最大流量fi(Upi(T‑t)‑ΔUpi)表示当前控制周期比例阀输出的最小流量,Upi(T‑t)表示上个控制周期比例阀输出的电压;
[0051] (5)分配完各个比例阀的流量后的剩余流量根据伺服阀的工作优先级依次分配各个伺服阀的流量,根据分配的流量得到当前控制周期内伺服阀的控制电压,具体如下:
[0052] 当gi(Usi(T‑t)‑ΔUsi)≤Qyi(T)≤gi(Usi(T‑t)+ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑1)+ΔUsi;
[0053] 当Qyi(T)<gi(Usi(T‑t)‑ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑1)‑ΔUsi;
[0054] 当gi(Usi(T‑t)‑ΔUsi)≤Qyi(T)≤gi(Usi(T‑t)+ΔUsi)时,伺服阀Si的控制电压置为[0055] 其中,Si的电压值增量 Usimax为伺服阀Si的最大输出电压,Tsi伺服阀Si阀芯响应时间gi(Usi(T‑t)+ΔUsi)表示当前控制周期伺服阀可以输出流量的最大值,gi(Usi(T‑t)‑ΔUsi)表示当前控制周期伺服阀可以输出流量的最小值,Usi(T‑t)表示上个控制周期伺服阀的输出电压;
[0056] (6)工作时间T<Tmax0时,进行一下个控制周期的控制,对自适应可调参数进行更新,然后重复步骤(1)‑(5),直到T≥Tmax0,系统停止控制,对自适应可调参数进行更新具体为:
[0057] 自适应可调参数My根据公式 进行更新,当更新值My>Mymax时,My=Mymax;当更新值My<Mymin时,My=Mymin;
[0058] 自适应可调参数By根据公式 进行更新,当更新值By>Bymax时,By=Bymax;当更新值By<Bymin时,By=Bymin;
[0059] 自适应可调参数Cy根据公式 进行更新,当更新值Cy>Cymax时,Cy=Cymax;当更新值Cy<Cymin时,Cy=Cymin;
[0060] 自适应可调参数Dy根据公式 进行更新,当更新值Dy>Dymax时,Dy=Dymax;当更新值Dy<Dymin时,Dy=Dymin;
[0061] 自适应可调参数dy根据公式 进行更新,当更新值dy>dymax时,dy=dymax;当更新值dy<dymin时,dy=dymin;
[0062] 其中,Mymin、Mymax分别为My的最小值与最大值,Bymin、Bymax分别为By的最小值与最大值,Cymin、Cymax分别为Cy的最小值与最大值,Dymin、Dymax分别为Dy的最小值与最大值,dymin、dymax分别为dy的最小值与最大值,λ为系统增益。
[0063] 针对本系统进行仿真试验时:
[0064] (1)根据比例阀响应速度的快慢对其进行编号,响应速度最慢的比例阀编号为P1,响应次慢的比例阀编号是P2,...,响应最快的比例阀编号为Pm。根据伺服阀响应速度的快慢对其进行编号,响应速度最慢的伺服阀编号为Sm+1,响应次慢的伺服阀编号是Sm+2,...,响应最快的伺服阀编号为Sn。因此比例阀与伺服阀工作优先级如下P1>P2>...>Pm>Sm+1>Sm+2>...>Sn,控制周期t=1ms;工作时间T;工作总时长Tmax;系统总流量Qy(T),比例阀Pi的控制电压Upi(T),输出流量Qpi(T),其中i表示阀的序号,1≤i≤m;伺服阀Si的控制电压Usi(T),输出流量Qsi(T),其中i表示阀的序号,m+1≤i≤n;液压缸H的目标位移xd,xd=F(T)是一个随工作时间T而变化的函数。系统每个控制周期都会根据工作时间T计算当前时刻的目标位移xd;液压缸H的实际轨迹xp,系统每个控制周期都会通过位移传感器对实际位移xp进行采样;系统每个控制周期中都会对目标位移xd与实际位移xp作差得到位移偏差,即e=xp‑xd,预设系统自适应可调参数My,Mymin、Mymax分别为My的最小值与最大值,系统自适应可调参数By,Bymin、Bymax分别为By的最小值与最大值,系统自适应可调参数Cy,Cymin、Cymax分别为Cy的最小值与最大值,系统自适应可调参数Dy,Dymin、Dymax分别为Dy的最小值与最大值;系统自适应可调参数dy,dymin、dymax分别为dy的最小值与最大值;系统增益为λ;
[0065] 根据比例阀的物理特性,比例阀Pi的输出流量Qpi(T)与控制电压Upi(T)的公式:
[0066]
[0067] 公式①中Kpi表示比例阀Pi的增益,Di表示比例阀Pi的死区,其中1≤i≤m。
[0068] 设比例阀Pi的最大输出电压为Upimax,比例阀Pi阀芯响应时间为Tpi,比例阀Pi的电压值增量为
[0069] 根据伺服阀的物理特性,定义伺服阀Si的输出流量Qsi(T)与控制电压Usi(T)的公式:
[0070] Qsi(T)=gi(Ui(T))=KsiUsi(T) ②
[0071] 公式②中Ksi表示伺服阀Si的增益,其中m+1≤i≤n。
[0072] 伺服阀Si的最大输出电压为Usimax,伺服阀Si阀芯响应时间为Tsi,Si的电压值增量[0073] (2)对上述参数进行初始化化,具体为:
[0074] 工作时间T=0ms;工作总时长Tmax=300ms;比例阀的控制电压Upi(T)=0V,其中i=‑71、2、3、…、m;伺服阀的控制电压Usi(T)=0V,其中i=m+1、m+2、m+3、…、n;My0=4.5×10 ,‑7 ‑7 ‑5 ‑5 ‑5
Mymin=1×10 、Mymax=10×10 ;By0=8.5×10 ,Bymin=1×10 、Bymax=9×10 ;Cy0=0.36,‑7 ‑7 ‑7
Cymin=0.1、Cymax=0.6;Dy0=5.3×10 ,Dymin=1×10 、Dymax=10×10 ;dy0=0,dymin=‑10×‑7 ‑7
10 、dymax=10×10 ;λ0=110;初始化xd,函数F(T)为斜率20、幅值1mm斜坡曲线。
[0075] (3)系统开始/继续工作,工作时间T=T+1。系统根据函数xd=F(T)计算出当前目标位移xd,并对xd求一阶导数 二阶导数 三阶导数 与此同时位移传感器R采集当前时刻的实际位移xp,并将其发送至运动控制卡C中;系统计算位移偏差e,并对其求一阶导数二阶导数 三阶导数
[0076] (4)根据公式 计算当前总流量Qy(T)。
[0077] (5)系统对(4)步骤中得到的总流量Qy(T)进行流量分配。
[0078] 设Qyi(T)为剩余流量,令Qyi(T)=Qy(T),i=1,进入步骤(5.1)。
[0079] (5.1)系统将流量按照比例阀的工作优先级分配至每个比例阀:
[0080] (5.1.1)当Qyi(T)>fi(Upi(T‑t)+ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)+ΔUpi。
[0081] (5.1.2)当Qyi(T)<fi(Upi(T‑t)‑ΔUpi)时,比例阀Pi的控制电压置为Upi(T)=Upi(T‑t)‑ΔUpi。
[0082] (5.1.2)除(5.1.1)和(5.1.2)的情况时,当Qyi(T)>0比例阀Pi的控制电压置为当Qyi(T)<0时控制电压置为
[0083] (5.1.4)随后由下一个比例阀对流量继续分配,即i=i+1。系统根据公式Qyi(T)=Qy(i‑1)(T)‑f(i‑1)(Up(i‑1)(T))计算剩余流量,并返回步骤(5.1.1)。直到i>m,进入步骤(5.2)。
[0084] (5.2)系统把剩余流量按照伺服阀的工作优先级分配至每个伺服阀:
[0085] (5.2.1)当Qyi(T)>gi(Usi(T‑t)+ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑1)+ΔUsi;
[0086] (5.2.2)当Qyi(T)<gi(Usi(T‑t)‑ΔUsi)时,伺服阀Si的控制电压置为Usi(T)=Usi(T‑1)‑ΔUsi;
[0087] (5.2.3)否则伺服阀Si的控制电压置为
[0088] (5.2.4)随后下一个伺服阀对流量继续分配,即i=i+1,系统根据公式Qyi(T)=Qy(i‑1)(T)‑f(i‑1)(Up(i‑1)(T))计算剩余流量,返回步骤(5.2.1)直到i>n时,进入步骤(6)。
[0089] (6)系统对下一个控制周期的自适应可调参数进行更新。
[0090] (7)如果工作时间T<300ms时返回步骤(3),如果T≥300ms系统将自动停止控制并将所有阀的控制信号输出置为0。
[0091] 仿真结果如图3所示,由图3可以看出本发明控制方法的跟踪曲线的响应速度和跟踪精度相比于现有的单阀PID控制方法有明显提升。

附图说明

[0035] 图1是本发明的结构示意图;
[0036] 图2是本发明控制流程示意图;
[0037] 图3是引用本发明的仿真图。
版权所有:盲专网 ©2023 zlpt.xyz  蜀ICP备2023003576号