CN103823999A - 一种基于拉格朗日插值多项式的瞬时转速估计方法 - Google Patents
一种基于拉格朗日插值多项式的瞬时转速估计方法 Download PDFInfo
- Publication number
- CN103823999A CN103823999A CN201410104252.9A CN201410104252A CN103823999A CN 103823999 A CN103823999 A CN 103823999A CN 201410104252 A CN201410104252 A CN 201410104252A CN 103823999 A CN103823999 A CN 103823999A
- Authority
- CN
- China
- Prior art keywords
- moment
- function
- lagrange interpolation
- time
- velocity
- 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.)
- Pending
Links
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
本发明涉及一种基于拉格朗日插值多项式的瞬时转速估计方法,利用2阶拉格朗日插值多项式对电机位置轨迹进行函数拟合,然后把得到的位置函数对时间t求导得到其相应的速度函数,对指定的任一时刻,在速度函数中代入位置增量和时间间隔,即求得该时刻对应的瞬时速度。该方法实时性强,精度高,易于实现。
Description
技术领域
本发明涉及电机转速测量技术领域,特别涉及一种基于拉格朗日(Lagrange)插值多项式的瞬时转速估计方法。
背景技术
转速是各类电机运行中的一个重要物理量,如何准确、快速而又方便地测量电机转速,极为重要。目前国内外常用的转速测量方法主要分为两大类:模拟电路测速和数字电路测速。
模拟电路测速是把测速机的模拟输出信号经A/D变换为数字量,然后输入到计算机中。这种测速算法响应速度快、时间延迟小,但是测速机灵敏度低、寿命短、安装成本较高,而且其速度分辨率和量化误差受到A/D转换芯片的位数限制。
另一类方法是采用数字测速。在速度回路中用它来代替直流测速机,不但可提高测速精度,扩大测速范围,还可大大简化***结构,这对设计高精度、高分辨率、小型化的编码器测速***显得尤为重要。数字测速的手段是多种多样的,有脉冲测速机,光栅盘等。目前使用最广泛的是增量式码盘。在闭环伺服控制***中,根据脉冲计数来测量转速的常用方法有M法、T法,以及M/T法等。但是上述各方法得到的结果是测速区间内的速度“平均值”,而不是采样时刻的速度“真实值”(瞬时速度),这两种速度之间的差异相当于引入了一个延迟或相位滞后,可能降低伺服控制***的性能甚至导致不稳定。
发明内容
本发明的目的在于提供一种基于拉格朗日插值多项式的瞬时转速估计方法,该方法实时性强,精度高,易于实现。
为实现上述目的,本发明的技术方案是:一种基于拉格朗日插值多项式的瞬时转速估计方法,利用2阶拉格朗日插值多项式对电机位置轨迹进行函数拟合,然后把得到的位置函数对时间t求导得到其相应的速度函数,对指定的任一时刻,在速度函数中代入位置增量和时间间隔,即求得该时刻对应的瞬时速度。
进一步的,选取位置增量相等的三个位置事件,根据三个位置事件的时刻和位置量求得对应的位置增量和时间间隔并代入所述速度函数,即得到指定时刻的瞬时速度。
进一步的,本发明方法具体按如下步骤进行:把电机位置轨迹近似成一个以时间t为自变量的2阶函数f(t),并用2阶拉格朗日插值多项式L(t)来拟合,使其满足L(t i ) = f(t i ),i = 0,1,2,即函数L(t)通过(t 0, L(t 0))、(t 1, L(t 1))和(t 2, L(t 2))这三点;所述2阶拉格朗日插值多项式L(t)为:
其中t i 是发生位置事件的时刻,L(t i )是对应时刻的位置量;
其中Δt 1 = t 1-t 0,Δt 2 = t 2-t 1,分别表示相邻两次位置事件对应的时间间隔,Δt 3 = t-t 2为当前时刻t距上一次位置事件的时间间隔。
本发明的有益效果是,利用2阶拉格朗日插值多项式对电机位置轨迹进行函数拟合,基于此估计瞬时速度,能够实时、精确地检测到电机的转速,为高性能伺服控制创造了有利条件。
附图说明
图1是本发明实施例的实例流程图。
图2是本发明实施例中2阶拉格朗日插值函数示意图。
图3是本发明实施例中瞬时转速实时估计示意图。
在图2中,401-位置事件1,402-位置事件2,403-位置事件3。
具体实施方式
本发明基于拉格朗日插值多项式的瞬时转速估计方法,如图1所示,利用2阶拉格朗日插值多项式对电机位置轨迹进行函数拟合,然后把得到的位置函数对时间t求导得到其相应的速度函数,对指定的任一时刻,在速度函数中代入位置增量和时间间隔,即求得该时刻对应的瞬时速度。
选取位置增量相等的三个位置事件,根据三个位置事件的时刻和位置量求得对应的位置增量和时间间隔并代入所述速度函数,即得到指定时刻的瞬时速度。
本发明基于拉格朗日插值多项式的瞬时转速估计方法具体按如下步骤进行:
把电机位置轨迹近似成一个以时间t为自变量的2阶函数f(t),如图2所示。假设其在时刻t 0、t 1和t 2对应的位置分别为L(t 0)、L(t 1)和L(t 2),用2阶拉格朗日插值多项式L(t)来拟合函数f(t),使其满足L(t i ) = f(t i ),i = 0,1,2,即函数L(t)通过(t 0, L(t 0))、(t 1, L(t 1))和(t 2, L(t 2))这三点;所述2阶拉格朗日插值多项式L(t)为:
其中t i 是发生位置事件的时刻,L(t i )是对应时刻的位置量;
其中Δt 1 = t 1-t 0,Δt 2 = t 2-t 1,分别表示相邻两次位置事件对应的时间间隔,Δt 3 = t-t 2为当前时刻t距上一次位置事件的时间间隔。
上式给出了位置函数L(t)在时刻t的斜率,即瞬时转速。若能测出两个位置增量相等的时间间隔Δt 1、Δt 2,再测出距离当前时刻t的时间间距Δt 3,则利用上式即可估计当前时刻的瞬时转速。其工作原理如图3所示。
本发明已实际应用于电机测速***中。假定t 0、t 1、t 2和L(t 0)、L(t 1)、L(t 2)分别为最近3个位置事件对应的时刻和位置量,其中每个位置事件对应的编码器脉冲数都是 N (位置增量相等)。令Δt 1 = t 1-t 0,Δt 2 = t 2-t 1,Δt 3 = t-t 2,则可利用下式来估计当前时刻t的瞬时转速(转/分):
式中N 0是电机旋转一圈所产生的编码器脉冲数,对一个500线双路正交输出的光电编码器,N 0=4×500=2000。利用TMS320F28XXDSP的QEP边缘捕获电路可以准确地获得编码器脉冲(即位置事件)对应的时间。上式中的Δt 1、Δt 2为位置事件发生时,捕获周期寄存器的值对应的时间(秒),Δt 3为当前时刻的捕获定时器的值对应的时间。1个位置事件对应的编码器脉冲数N也可在DSP的QEP模块中进行选择设置,从而更好地适应宽范围的转速估计。电机瞬时速度的准确估计,为高性能的速度控制提供了有利条件。
以上是本发明的较佳实施例,凡依本发明技术方案所作的改变,所产生的功能作用未超出本发明技术方案的范围时,均属于本发明的保护范围。
Claims (3)
1.一种基于拉格朗日插值多项式的瞬时转速估计方法,其特征在于,利用2阶拉格朗日插值多项式对电机位置轨迹进行函数拟合,然后把得到的位置函数对时间t求导得到其相应的速度函数,对指定的任一时刻,在速度函数中代入位置增量和时间间隔,即求得该时刻对应的瞬时速度。
2.根据权利要求1所述的一种基于拉格朗日插值多项式的瞬时转速估计方法,其特征在于,选取位置增量相等的三个位置事件,根据三个位置事件的时刻和位置量求得对应的位置增量和时间间隔并代入所述速度函数,即得到指定时刻的瞬时速度。
3.根据权利要求2所述的一种基于拉格朗日插值多项式的瞬时转速估计方法,其特征在于,具体按如下步骤进行:把电机位置轨迹近似成一个以时间t为自变量的2阶函数f(t),并用2阶拉格朗日插值多项式L(t)来拟合,使其满足L(t i ) = f(t i ),i = 0,1,2,即函数L(t)通过(t 0, L(t 0))、(t 1, L(t 1))和(t 2, L(t 2))这三点;所述2阶拉格朗日插值多项式L(t)为:
其中t i 是发生位置事件的时刻,L(t i )是对应时刻的位置量;
其中Δt 1 = t 1-t 0,Δt 2 = t 2-t 1,分别表示相邻两次位置事件对应的时间间隔,Δt 3 = t-t 2为当前时刻t距上一次位置事件的时间间隔。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410104252.9A CN103823999A (zh) | 2014-03-20 | 2014-03-20 | 一种基于拉格朗日插值多项式的瞬时转速估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410104252.9A CN103823999A (zh) | 2014-03-20 | 2014-03-20 | 一种基于拉格朗日插值多项式的瞬时转速估计方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103823999A true CN103823999A (zh) | 2014-05-28 |
Family
ID=50759055
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410104252.9A Pending CN103823999A (zh) | 2014-03-20 | 2014-03-20 | 一种基于拉格朗日插值多项式的瞬时转速估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103823999A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104374939A (zh) * | 2014-11-06 | 2015-02-25 | 西安交通大学 | 基于振动信号同步压缩变换的旋转机械瞬时转速估测方法 |
CN104678301A (zh) * | 2015-02-14 | 2015-06-03 | 华中科技大学 | 一种基于脉冲反馈检测电机运动学参数的方法 |
CN108731703A (zh) * | 2018-06-05 | 2018-11-02 | 上海麦歌恩微电子股份有限公司 | 角度传感器和旋转编码器的转动方向逆变迟滞方法 |
CN110044362A (zh) * | 2019-04-29 | 2019-07-23 | 中国人民解放军32035部队 | 一种空间目标间相对距离极小值的快速计算方法 |
-
2014
- 2014-03-20 CN CN201410104252.9A patent/CN103823999A/zh active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104374939A (zh) * | 2014-11-06 | 2015-02-25 | 西安交通大学 | 基于振动信号同步压缩变换的旋转机械瞬时转速估测方法 |
CN104374939B (zh) * | 2014-11-06 | 2017-02-15 | 西安交通大学 | 基于振动信号同步压缩变换的旋转机械瞬时转速估测方法 |
CN104678301A (zh) * | 2015-02-14 | 2015-06-03 | 华中科技大学 | 一种基于脉冲反馈检测电机运动学参数的方法 |
CN104678301B (zh) * | 2015-02-14 | 2017-06-09 | 华中科技大学 | 一种基于脉冲反馈检测电机运动学参数的方法 |
CN108731703A (zh) * | 2018-06-05 | 2018-11-02 | 上海麦歌恩微电子股份有限公司 | 角度传感器和旋转编码器的转动方向逆变迟滞方法 |
CN110044362A (zh) * | 2019-04-29 | 2019-07-23 | 中国人民解放军32035部队 | 一种空间目标间相对距离极小值的快速计算方法 |
CN110044362B (zh) * | 2019-04-29 | 2022-05-24 | 中国人民解放军32035部队 | 一种空间目标间相对距离极小值的快速计算方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104753425B (zh) | 一种实现永磁同步电机机械零点在线找寻与补偿的方法 | |
CN103823999A (zh) | 一种基于拉格朗日插值多项式的瞬时转速估计方法 | |
CN104317253A (zh) | 一种用于伺服电机位置控制的***方法 | |
CN102291062A (zh) | 一种基于fpga的高精度多电机控制方法 | |
CN104218865B (zh) | 一种永磁电机转子位置计算方法 | |
CN204203725U (zh) | 一种用于伺服电机高精度位置控制*** | |
CN103913591B (zh) | 旋转设备转速测量方法和装置 | |
CN103869094B (zh) | 一种主泵转速测量信号处理方法 | |
CN107579690B (zh) | 一种基于滑模观测的超高速永磁同步电机转速估计方法 | |
CN105676780B (zh) | 基于模糊小脑模型关节控制器的xy运动平台轮廓控制装置 | |
CN108181482A (zh) | 基于虚拟正弦波的实时低速检测装置 | |
CN108155910A (zh) | 一种基于fpga的高速正余弦编码器解码方法 | |
CN107834914A (zh) | 基于霍尔的无刷电机转子角度计算方法 | |
CN103605374A (zh) | 一种能提高云台定位精度的装置及方法 | |
CN105571617B (zh) | 一种基于高斯算法的高精度数字积分器 | |
CN104571246A (zh) | 一种应用于霍尔传感器的旋转电流电路 | |
CN106802597A (zh) | 一种增量式光电轴角编码器数据处理装置及处理方法 | |
CN106374794A (zh) | 一种基于反电势波峰波谷的bldc电机相位检测方法 | |
CN206989972U (zh) | 一种抑制干扰与温漂的霍尔信号采样磁电编码器 | |
CN110133316B (zh) | 一种光电编码器精密测速***及方法 | |
CN108075697B (zh) | 一种位置信号倍频的开关磁阻电机相电流迭代控制方法 | |
CN103995144B (zh) | 一种无刷直流电机高性能测速方法 | |
CN203135770U (zh) | 开关磁阻电机分布式控制*** | |
CN106569406A (zh) | 基于尺度变换的有刷直流电机模型参数快速辨识方法 | |
CN107508512B (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20140528 |
|
RJ01 | Rejection of invention patent application after publication |