首页 / 专利库 / 地热能 / 地热循环 / 闭环系统 / 一种用于快速检测电机闭环系统堵转的方法

一种用于快速检测电机闭环系统堵转的方法

阅读:1017发布:2020-06-03

专利汇可以提供一种用于快速检测电机闭环系统堵转的方法专利检索,专利查询,专利分析的服务。并且本 发明 提供了一种用于快速检测 电机 闭环系统 堵转的方法,根据PID 算法 ,建立电机闭环系统模型;对所述电机闭环系统模型的电机输入 电压 进行后向差分处理,得到电机的输入电压增量;对所述电机闭环系统模型的实际电机转速进行后向差分处理,得到电机的实际转速增量;当电机的输入电压增量大于电压增量设定 阈值 ,电机的实际转速增量小于速度增量设定阈值,且经过n个 采样 周期后,电机的输入电压与输入电压的最大值的差值小于电压阈值,电机的实际转速小于转速阈值时,则电机闭环系统堵转;其中,n为正整数,n≥1。本发明的有益效果是:检测性灵敏,检测速度快,精确度高。,下面是一种用于快速检测电机闭环系统堵转的方法专利的具体信息内容。

1.一种用于快速检测电机闭环系统堵转的方法,其特征在于:包括以下步骤:
S1:根据PID算法,建立电机闭环系统模型;
S2:对所述电机闭环系统模型的电机的输入电压进行后向差分处理,得到电机的输入电压增量;
S3:对所述电机闭环系统模型的电机的实际转速进行后向差分处理,得到电机的实际转速增量;
S4:当电机的输入电压增量大于电压增量设定阈值,电机的实际转速增量小于速度增量设定阈值,且经过n个采样周期后,电机的输入电压与输入电压的最大值的差值小于电压阈值,电机的实际转速小于转速阈值时,则电机闭环系统堵转;其中,n为正整数,n≥1。
2.如权利要求1所述的一种用于快速检测电机闭环系统堵转的方法,其特征在于:步骤S1中的电机闭环系统模型为离散传递函数:
err(k)=set_value(k)-actual_value(k)
其中,u(k)为电机的输入电压;kp为比例增益,Ti为积分时间,Td为微分时间,T为采样时间;err(k)为电机的转动速度差,代表设定转动速度set_value(k)和实际转动速度actual_value(k)之差。
3.如权利要求1所述的一种用于快速检测电机闭环系统堵转的方法,其特征在于:步骤S2中,电机的输入电压增量的公式为:▽u(k)=u(k)-u(k-1),▽u(k)为电机的输入电压增量,u(k)为k采样周期电机的输入电压,u(k-1)为k-1采样周期电机的输入电压,k为大于1的正整数。
4.如权利要求1所述的一种用于快速检测电机闭环系统堵转的方法,其特征在于:步骤S3中,电机的实际转速增量的公式为:▽actual_value(k)=actual_value(k)-actual_value(k-1),▽actual_value(k)为电机的实际转速增量,actual_value(k)为k采样周期电机的实际转速,actual_value(k-1)为k-1采样周期电机的实际转速,k为大于1的正整数。
5.如权利要求1所述的一种用于快速检测电机闭环系统堵转的方法,其特征在于:步骤S4中,电压增量设定阈值为正值。
6.如权利要求1所述的一种用于快速检测电机闭环系统堵转的方法,其特征在于:步骤S4中,速度增量设定阈值为负值;电机的实际转速增量小于速度增量设定阈值,即指电机实际转速的速度增量也为负值,但是电机的实际转速增量的绝对值大于速度增量设定阈值的绝对值。

说明书全文

一种用于快速检测电机闭环系统堵转的方法

技术领域

[0001] 本发明涉及电机领域,尤其涉及一种用于快速检测电机闭环系统堵转的方法背景技术
[0002] 对于电机速度闭环的系统,在很多的装置设备当中都会用到这样的一个子系统嵌入到设备当中,提高系统的稳定性,例如说无人汽车机器人伺服控制。都会用到这个系统。但是在闭环系统会有一种问题出现,那就是当电机突然受到很大阻尼时,该系统会由于负反馈效应输出最大电流,但是这是电机又是堵转的状态,于是便会造成电机和驱动电路的损坏。目前一般对于这种状态的检测方法是通过检测该系统的电机速度,当电机速度低于特定阈值达到1.5秒左右的时候,便判定该系统进入堵转状态,然后采取保护措施。这种方法检测速度慢,比较死板,不灵活,不能最大的减少该系统的损耗。因此,需要研究一种方法用来快速检测电机是否发生堵转情况。

发明内容

[0003] 为了解决上述问题,本发明提供了一种用于快速检测电机闭环系统堵转的方法,主要包括以下步骤:
[0004] S1:根据PID算法,建立电机闭环系统模型;
[0005] S2:对所述电机闭环系统模型的电机的输入电压进行后向差分处理,得到电机的输入电压增量;
[0006] S3:对所述电机闭环系统模型的电机的实际转速进行后向差分处理,得到电机的实际转速增量;
[0007] S4:当电机的输入电压增量大于电压增量设定阈值,电机的实际转速增量小于速度增量设定阈值,且经过n个采样周期后,电机的输入电压与输入电压的最大值的差值小于电压阈值,电机的实际转速小于转速阈值时,则电机闭环系统堵转;其中,n为正整数,n≥1。
[0008] 进一步地,步骤S1中的电机闭环系统模型为离散传递函数:
[0009]
[0010] err(k)=set_value(k)-actual_value(k)
[0011] 其中,u(k)为电机的输入电压;kp为比例增益,Ti为积分时间,Td为微分时间,T为采样时间;err(k)为电机的转动速度差,代表设定转动速度set_value(k)和实际转动速度actual_value(k)之差。
[0012] 进一步地,步骤S2中,电机的输入电压增量的公式为:为电机的输入电压增量,u(k)为k采样周期电机的输入电压,u(k-1)为k-1采样周期电机的输入电压,k为大于1的正整数。
[0013] 进 一 步 地 ,步 骤 S 3 中 ,电 机 的 实 际 转 速 增 量 的 公 式 为 :为电机的实
际转速增量,actual_value(k)为k采样周期电机的实际转速,actual_value(k-1)为k-1采样周期电机的实际转速,k为大于1的正整数。
[0014] 进一步地,步骤S4中,电压增量设定阈值为正值。
[0015] 进一步地,步骤S4中,速度增量设定阈值为负值;速度增量设定阈值为负值;电机的实际转速增量小于速度增量设定阈值,即指电机实际转速的速度增量也为负值,但是电机的实际转速增量的绝对值大于速度增量设定阈值的绝对值。
[0016] 本发明提供的技术方案带来的有益效果是:检测性灵敏,检测速度快,精确度高。附图说明
[0017] 下面将结合附图及实施例对本发明作进一步说明,附图中:
[0018] 图1是本发明实施例中一种用于快速检测电机闭环系统堵转的方法的流程图
[0019] 图2是本发明实施例中电机闭环系统的结构示意图。

具体实施方式

[0020] 为了对本发明的技术特征、目的和效果有更加清楚的理解,现对照附图详细说明本发明的具体实施方式。
[0021] 本发明的实施例提供了一种用于快速检测电机闭环系统堵转的方法。
[0022] 请参考图1和图2,图1是本发明实施例中一种用于快速检测电机闭环系统堵转的方法的流程图,图2是本发明实施例中电机闭环系统的结构示意图,电机闭环系统包括电机模编码器模块、主控模块、电机驱动模块和电源模块;电机驱动模块根据主控模块输出的pwm波,负责驱动电机转动;电机模块是电机闭环系统的执行模块,为控制对象,接收驱动,电机转动;编码器模块用于检测电机的转速,与电机模块通过齿轮连接;主控模块所采用的是NXP公司的MK66FX1M0VLQ18单片机,运行速度快;是电机闭环系统的控制模块,通过输出的pwm波的占空比控制输出给电机的电压,也即控制电机的输入电压;电源模块负责为整个电机闭环系统供电,包括编码器模块、电机驱动模块和主控模块;用于快速检测电机闭环系统堵转的方法具体包括如下步骤:
[0023] S1:根据PID算法,建立电机闭环系统模型;电机闭环系统模型为离散传递函数:
[0024]
[0025] err(k)=set_value(k)-actual_value(k)
[0026] 其中,u(k)为主控模块传给电机驱动模块的pwm波的占空比所分配的电压,也即电机的输入电压;kp为比例增益,Ti为积分时间,Td为微分时间,T为采样时间;err(k)为设定转动速度set_value(k)和编码器检测到的实际转动速度actual_value(k)之差。
[0027] S2:对所述电机闭环系统模型的电机的输入电压进行后向差分处理,得到电机的输入电压增量;电机的输入电压增量的公式为: 为电机的输入电压增量,u(k)为k采样周期电机的输入电压,u(k-1)为k-1采样周期电机的输入电压,k为大于1的正整数; 的正负代表了电机的变化方向,是变大还是变小; 的大小就代表电压的变化大小,即变化的剧烈程度。
[0028] S3:对所述电机闭环系统模型的电机的实际转速进行后向差分处理,得到电机的实际转速增量;为电机的实际转速增量,actual_value(k)为k采样周期电机的实际转
速,actual_value(k-1)为k-1采样周期电机的实际转速,k为大于1的正整数;
的正负代表了实际转速的变化方向,即速度是变大还是变小;
的大小代表了实际转速变化的快慢,相当于加速度。
[0029] S4:当电机的输入电压增量为大于电压增量设定阈值,电压增量设定阈值为正值;电机的实际转速增量小于速度增量设定阈值,速度增量设定阈值为负值;电机的实际转速增量小于速度增量设定阈值,即指电机的实际转速增量也为负值,但是电机的实际转速增量的绝对值大于速度增量设定阈值的绝对值;且经过n个采样周期后,电机的输入电压与输入电压的最大值的差值小于电压阈值(此时,电机的输入电压接近于输入最大值),电机的实际转速小于转速阈值(此时,电机实际转速接近于零)时,则电机闭环系统堵转,上采取保护措施进行保护,以免发生安全事故。其中,n为正整数,n≥1。本实施例中取n=2。
[0030] 当 和 均为0时,电机闭环系统正常运行;当u(k)和actual_value(k)的变化很小时,电机闭环系统正常运行;当电机闭环系统处于半堵转的时候,即系统的受到的阻尼是在变化的时候,因为判定周期为两个周期,时间很短,所以我们会把这种情况判断为堵转,在实际生产过程中,这种情况也确实需要进行保护措施。
[0031] 本发明的有益效果是:检测性灵敏,检测速度快,精确度高。
[0032] 以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
高效检索全球专利

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

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

申请试用

分析报告

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

申请试用

QQ群二维码
意见反馈