[发明专利]流体压力控制方法和流体控制柜在审
申请号: | 202211446992.1 | 申请日: | 2022-11-18 |
公开(公告)号: | CN116048148A | 公开(公告)日: | 2023-05-02 |
发明(设计)人: | 安然;李昊天 | 申请(专利权)人: | 智涂机器人(深圳)有限公司 |
主分类号: | G05D16/20 | 分类号: | G05D16/20 |
代理公司: | 北京超凡宏宇专利代理事务所(特殊普通合伙) 11463 | 代理人: | 梁韬 |
地址: | 518000 广东省深圳市南山区粤*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 流体 压力 控制 方法 | ||
1.一种流体压力控制方法,其特征在于,应用于流体控制柜,所述方法包括:
压力传感器按照预设采样周期采样所述流体控制柜出口的当前出口压力;
单片机计算所述当前出口压力和预设出口压力的压力误差;
PID控制器基于所述压力误差计算电机转速增量;
所述单片机根据所述电机转速增量计算目标电机转速;
驱动电机以所述目标电机转速运转,以控制所述流体控制柜以目标出口压力输出流体。
2.根据权利要求1所述的流体压力控制方法,其特征在于,所述基于所述压力误差计算电机转速增量,包括:
获取上一时刻的压力误差E(tn-1)、当前时刻的压力误差E(tn)和当前时刻的累积误差Esum(tn);
根据公式
计算所述电机转速增量;其中,Δv(tn)表示所述电机转速增量,P表示比例系数,I表示积分系数,D表示微分系数,Ts表示所述预设采样周期。
3.根据权利要求2所述的流体压力控制方法,其特征在于,所述PID控制器的比例系数P、积分系数I、微分系数D通过仿真调参获得。
4.根据权利要求1所述的流体压力控制方法,其特征在于,所述根据所述电机转速增量计算目标电机转速,包括:
获取当前电机转速,计算所述当前电机转速和所述电机转速增量的和值;
将所述和值确定为所述目标电机转速。
5.根据权利要求1所述的流体压力控制方法,其特征在于,所述驱动电机以所述目标电机转速运转,以控制所述流体控制柜以目标出口压力输出流体,包括:
所述驱动电机以所述目标电机转速运转,以控制所述流体控制柜中的流体流速;
所述流体控制柜根据所述流体流速以目标出口压力输出所述流体。
6.根据权利要求5所述的流体压力控制方法,其特征在于,所述流体流速等于所述目标电机转速乘以第一参数的积值与第一常量相加的和值。
7.根据权利要求6所述的流体压力控制方法,其特征在于,所述目标出口压力等于流体流速乘以第二参数的积值与第二常量相加的和值。
8.一种流体控制柜,其特征在于,包括:
压力传感器,用于按照预设采样周期采样所述流体控制柜出口的当前出口压力;
单片机,用于计算所述当前出口压力和预设出口压力的压力误差;
PID控制器,用于基于所述压力误差计算电机转速增量;
所述单片机,还用于根据所述电机转速增量计算目标电机转速;
驱动电机,用于以所述目标电机转速运转,以控制所述流体控制柜以目标出口压力输出流体。
9.根据权利要求8所述的流体控制柜,其特征在于,所述PID控制器,还用于:
获取上一时刻的压力误差E(tn-1)、当前时刻的压力误差E(tn)和当前时刻的累积误差Esum(tn);
根据公式
计算所述电机转速增量;其中,Δv(tn)表示所述电机转速增量,P表示比例系数,I表示积分系数,D表示微分系数,Ts表示所述预设采样周期。
10.根据权利要求8所述的流体控制柜,其特征在于,所述单片机,还用于:
获取当前电机转速,计算所述当前电机转速和所述电机转速增量的和值;
将所述和值确定为所述目标电机转速。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于智涂机器人(深圳)有限公司,未经智涂机器人(深圳)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202211446992.1/1.html,转载请声明来源钻瓜专利网。