CN112305256A - 一种自适应mt过渡测速方法 - Google Patents
一种自适应mt过渡测速方法 Download PDFInfo
- Publication number
- CN112305256A CN112305256A CN202011086592.5A CN202011086592A CN112305256A CN 112305256 A CN112305256 A CN 112305256A CN 202011086592 A CN202011086592 A CN 202011086592A CN 112305256 A CN112305256 A CN 112305256A
- Authority
- CN
- China
- Prior art keywords
- time
- queue
- pulse
- value
- speed
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/42—Devices characterised by the use of electric or magnetic means
- G01P3/44—Devices characterised by the use of electric or magnetic means for measuring angular speed
- G01P3/48—Devices characterised by the use of electric or magnetic means for measuring angular speed by measuring frequency of generated current or voltage
- G01P3/481—Devices characterised by the use of electric or magnetic means for measuring angular speed by measuring frequency of generated current or voltage of pulse signals
Abstract
本发明公开了一种自适应MT过渡测速方法,包括以下步骤:首先将编码器含有的电机转角信号发送至电机控制器中的解码电路,将接受到的信号转换成转角对应的脉冲计数值,传送至数字处理器进行速度和角度计算;电机控制器每隔固定时间Ts读取一次脉冲计数值,并将相邻两次的数值相减,得到当前时刻的脉冲增量数值;设定一个时间累积变量,设置两个长度为K一一对应的循环队列,并将时间队列初始化为该数值,脉冲增量队列记录初始化为0;将k个数据分别求和得到总的脉冲增量和时间,然后计算得到速度/频率值。本发明能够实现测速区间随着转速的自适应过渡,避免了测速结果跳变;除此之外,避开了需要精确捕获时间的要求,拓宽了MT法的测速应用范围。
Description
技术领域
本发明涉及测速技术领域,具体涉及一种自适应MT过渡测速方法。
背景技术
在电机控制领域,调速性能是衡量驱动器的重要指标,如何提高速度精度、稳定性及动态性等指标,伴随产品开发和设计的整个过程,而测速是其中的重要环节。
测速方案有多种,且与传感器类型相关,常用的传感器类型是数字脉冲式。针对脉冲式传感器,主要测速方法有M法、T法以及M/T法。M法测速是测量单位时间内的脉冲数换算成频率,因存在测量时间内首尾的脉冲采样问题,最大可能会有2个脉冲的计数误差;T法测速是测量两个脉冲之间的时间换算成周期,从而得到频率,因存在半个采样周期的计时问题,最大可能会有1个采样周期的误差。从上述测速原理可知,M法适合于高速,T法宜测量低速,实践中为了兼顾高低速的性能,采用M/T法测速。
数字脉冲式传感器配套的硬件采样电路主要包含两种形式,一种是脉冲信号与采样电路通过硬线直接相连,数字处理器内置的CAP和QEP单元能够实现边沿捕获和脉冲计数;另一种是传感器解码电路将实时绝对位置折算成的脉冲计数通过通讯的方式传送给处理器,如图1所示。在后一种应用中,由于无法检测脉冲边沿,T法测速效果将大打折扣。
发明内容
本发明的目的在于提供一种自适应MT过渡测速方法,以解决上述背景技术中提出的问题。
为实现上述目的,本发明提供如下技术方案:一种自适应MT过渡测速方法,包括以下步骤:
A)、首先将编码器含有的电机转角信号发送至电机控制器中的解码电路,解码电路将接受到的信号转换成转角对应的脉冲计数值;若编码器线数是2500线的,则0~2π对应0~2500;然后将所述脉冲计数值通过SPI通讯传送至数字处理器进行速度和角度计算;
B)、所述电机控制器每隔固定时间Ts通过SPI通讯读取一次脉冲计数值,并将相邻两次的数值相减,得到当前时刻的脉冲增量数值Pdelt;同时设定一个时间累积变量Thold,每采样一次数据,计时变量累加一次采样时间Ts;
C)、设置两个长度为K一一对应的循环队列,一个队列用于存放上述脉冲增量数值Pdelt,另一个列队记录该脉冲增量对应的时间Thold(如图2所示);
D)、设定一个累积时间最大值Tmax,取值在10*Ts左右,并将时间队列初始化为该数值,脉冲增量队列记录全部初始化为0;初始化完成后,队列按照一定的规则进行更新;
E)、将步骤C)中两个队列的k个数据分别求和得到总的脉冲增量和时间,然后计算得到速度/频率值;
本发明的进一步改进在于:所述步骤D)中队列数据更新的具体规则为:
a)、若第n+1次采样时刻的脉冲数值较第n次的数据发生了变化,则在当前队列指针指向的队列单元中记录当前时刻的脉冲增量和累积时间Thold,然后将累积时间Thold清零,并将队列指针指向下一个单元,完成一次队列的进队和出队操作;
b)、若采样时刻脉冲数值未变化,将累积时间Thold和单个时间记录最大值Tmax进行比较,若Thold超过了Tmax,则将当前时间队列更新为Thold,并将脉冲增量队列对应的数据记为零,同时将累积时间Thold清零,队列指针指向下一个单元;否则,队列不更新,继续下一次采样。
从上述规则可知:速度较高时,每个采样时刻对应的脉冲均发生变化,则总时间为k*Ts;速度较低时,每次队列更新都由条件Thold>Tmax触发,则总时间约等于k*Tmax,因此,测速区间是随着速度的变化而变化的,从而实现了自适应M/T过渡测速(计算流程如图3所示)。
本发明的技术效果和优点:
本发明能够实现测速区间随着转速的自适应过渡,避免了传统MT测速方法切换时带来的测速结果跳变;除此之外,本发明避开了传统T法需要精确捕获时间的要求,拓宽了MT法的测速应用范围。
附图说明
图1为信号连接示意图;
图2为队列示意图;
图3为计算流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1-图3示出了本发明一种自适应MT过渡测速方法的具体实施方式:包括以下步骤:A)、首先将编码器含有的电机转角信号发送至电机控制器中的解码电路,解码电路将接受到的信号转换成转角对应的脉冲计数值;若编码器线数是2500线的,则0~2π对应0~2500;然后将所述脉冲计数值通过SPI通讯传送至数字处理器进行速度和角度计算;
B)、所述电机控制器每隔固定时间Ts通过SPI通讯读取一次脉冲计数值,并将相邻两次的数值相减,得到当前时刻的脉冲增量数值Pdelt;同时设定一个时间累积变量Thold,每采样一次数据,计时变量累加一次采样时间Ts;
C)、设置两个长度为K一一对应的循环队列,一个队列用于存放上述脉冲增量数值Pdelt,另一个列队记录该脉冲增量对应的时间Thold(如图2所示);
D)、设定一个累积时间最大值Tmax,取值为10*Ts,并将时间队列初始化为该数值,脉冲增量队列记录全部初始化为0;初始化完成后,队列按照一定的规则进行更新;
所述队列数据更新的具体步骤为:
a)、若第n+1次采样时刻的脉冲数值较第n次的数据发生了变化,则在当前队列指针指向的队列单元中记录当前时刻的脉冲增量和累积时间Thold,然后将累积时间Thold清零,并将队列指针指向下一个单元,完成一次队列的进队和出队操作;
b)、若采样时刻脉冲数值未变化,将累积时间Thold和单个时间记录最大值Tmax进行比较,若Thold超过了Tmax,则将当前时间队列更新为Thold,并将脉冲增量队列对应的数据记为零,同时将累积时间Thold清零,队列指针指向下一个单元;否则,队列不更新,继续下一次采样;
E)、将步骤C)中两个队列的k个数据分别求和得到总的脉冲增量和时间,然后计算得到速度/频率值;
从上述步骤可知:速度较高时,每个采样时刻对应的脉冲均发生变化,则总时间为k*Ts;速度较低时,每次队列更新都由条件(Thold>Tmax)触发,则总时间约等于k*Tmax,因此,测速区间是随着速度的变化而变化的,从而实现了自适应M/T过渡测速(计算流程如图3所示)。
本发明能够实现测速区间随着转速的自适应过渡,避免了传统MT测速方法切换时带来的测速结果跳变;除此之外,本发明避开了传统T法需要精确捕获时间的要求,拓宽了MT法的测速应用范围。
申请人又一声明,本发明通过上述实施例来说明本发明的实现方法及装置结构,但本发明并不局限于上述实施方式,即不意味着本发明必须依赖上述方法及结构才能实施。所属技术领域的技术人员应该明了,对本发明的任何改进,对本发明所选用实现方法等效替换及步骤的添加、具体方式的选择等,均落在本发明的保护范围和公开的范围之内。
本发明并不限于上述实施方式,凡采用和本发明相似结构及其方法来实现本发明目的的所有方式,均在本发明的保护范围之内。
Claims (2)
1.一种自适应MT过渡测速方法,其特征在于:包括以下步骤:
A)、首先将编码器含有的电机转角信号发送至电机控制器中的解码电路,解码电路将接受到的信号转换成转角对应的脉冲计数值;然后将所述脉冲计数值通过SPI通讯传送至数字处理器进行速度和角度计算;
B)、所述电机控制器每隔固定时间Ts通过SPI通讯读取一次脉冲计数值,并将相邻两次的数值相减,得到当前时刻的脉冲增量数值Pdelt;同时设定一个时间累积变量Thold,每采样一次数据,计时变量累加一次采样时间Ts;
C)、设置两个长度为K一一对应的循环队列,一个队列用于存放上述脉冲增量数值Pdelt,另一个列队记录该脉冲增量对应的时间Thold;
D)、设定一个累积时间最大值Tmax,取值为10*Ts,并将时间队列初始化为该数值,脉冲增量队列记录全部初始化为0;初始化完成后,队列按照规则进行更新;
E)、将步骤C)中两个队列的k个数据分别求和得到总的脉冲增量和时间,然后计算得到速度/频率值。
2.根据权利要求1所述的一种自适应MT过渡测速方法,其特征在于:所述步骤D)中队列数据更新的具体规则为:
a)、若第n+1次采样时刻的脉冲数值较第n次的数据发生了变化,则在当前队列指针指向的队列单元中记录当前时刻的脉冲增量和累积时间Thold,然后将累积时间Thold清零,并将队列指针指向下一个单元,完成一次队列的进队和出队操作;
b)、若采样时刻脉冲数值未变化,将累积时间Thold和单个时间记录最大值Tmax进行比较,若Thold>Tmax,则将当前时间队列更新为Thold,并将脉冲增量队列对应的数据记为零,同时将累积时间Thold清零,队列指针指向下一个单元;否则,队列不更新,继续下一次采样。
从上述规则可知:速度较高时,每个采样时刻对应的脉冲均发生变化,则总时间为k*Ts;速度较低时,每次队列更新都由条件:Thold>Tmax触发,则总时间约等于k*Tmax,因此,测速区间是随着速度的变化而变化的,从而实现了自适应M/T过渡测速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011086592.5A CN112305256B (zh) | 2020-10-12 | 2020-10-12 | 一种自适应mt过渡测速方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011086592.5A CN112305256B (zh) | 2020-10-12 | 2020-10-12 | 一种自适应mt过渡测速方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112305256A true CN112305256A (zh) | 2021-02-02 |
CN112305256B CN112305256B (zh) | 2022-07-26 |
Family
ID=74488713
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011086592.5A Active CN112305256B (zh) | 2020-10-12 | 2020-10-12 | 一种自适应mt过渡测速方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112305256B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112986605A (zh) * | 2021-02-22 | 2021-06-18 | 合肥宏晶微电子科技股份有限公司 | 一种电机测速方法及装置 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW200914833A (en) * | 2007-09-26 | 2009-04-01 | Delta Electronics Inc | Method for automatically setting initially-estimated rotational speed in motor speed measuring system |
US20090150116A1 (en) * | 2007-12-05 | 2009-06-11 | Ching-Yi Lin | Method for automatically setting initially-estimated rotational frequency in motor frequency measuring system |
CN102035455A (zh) * | 2010-11-30 | 2011-04-27 | 中冶南方(武汉)自动化有限公司 | 一种变频器m/t测速方法 |
CN102914666A (zh) * | 2012-10-15 | 2013-02-06 | 中冶南方(武汉)自动化有限公司 | 基于dsp的自适应t法测速滤波法 |
CN103616840A (zh) * | 2013-12-13 | 2014-03-05 | 广西大学 | 一种基于fpga的速度自适应测量装置 |
CN104407166A (zh) * | 2014-11-27 | 2015-03-11 | 中国船舶重工集团公司第七二四研究所 | 一种自适应调整计数脉冲的电机转速恒精度测量方法 |
JP2015230187A (ja) * | 2014-06-03 | 2015-12-21 | 東洋電機製造株式会社 | 回転位相速度検出装置 |
CN105319384A (zh) * | 2015-08-28 | 2016-02-10 | 贵州航天林泉电机有限公司 | 一种基于fpga的自适应m/t测速系统 |
CN106199046A (zh) * | 2016-07-05 | 2016-12-07 | 中国核动力研究设计院 | 提高响应时间的转轴转速测量系统 |
CN108535507A (zh) * | 2018-02-08 | 2018-09-14 | 威科达(东莞)智能控制有限公司 | 用于增量式编码器测速的计算机存储介质 |
CN108549024A (zh) * | 2018-02-09 | 2018-09-18 | 中国科学院长春光学精密机械与物理研究所 | 一种预测式m/t的测速系统及方法 |
-
2020
- 2020-10-12 CN CN202011086592.5A patent/CN112305256B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW200914833A (en) * | 2007-09-26 | 2009-04-01 | Delta Electronics Inc | Method for automatically setting initially-estimated rotational speed in motor speed measuring system |
US20090150116A1 (en) * | 2007-12-05 | 2009-06-11 | Ching-Yi Lin | Method for automatically setting initially-estimated rotational frequency in motor frequency measuring system |
CN102035455A (zh) * | 2010-11-30 | 2011-04-27 | 中冶南方(武汉)自动化有限公司 | 一种变频器m/t测速方法 |
CN102914666A (zh) * | 2012-10-15 | 2013-02-06 | 中冶南方(武汉)自动化有限公司 | 基于dsp的自适应t法测速滤波法 |
CN103616840A (zh) * | 2013-12-13 | 2014-03-05 | 广西大学 | 一种基于fpga的速度自适应测量装置 |
JP2015230187A (ja) * | 2014-06-03 | 2015-12-21 | 東洋電機製造株式会社 | 回転位相速度検出装置 |
CN104407166A (zh) * | 2014-11-27 | 2015-03-11 | 中国船舶重工集团公司第七二四研究所 | 一种自适应调整计数脉冲的电机转速恒精度测量方法 |
CN105319384A (zh) * | 2015-08-28 | 2016-02-10 | 贵州航天林泉电机有限公司 | 一种基于fpga的自适应m/t测速系统 |
CN106199046A (zh) * | 2016-07-05 | 2016-12-07 | 中国核动力研究设计院 | 提高响应时间的转轴转速测量系统 |
CN108535507A (zh) * | 2018-02-08 | 2018-09-14 | 威科达(东莞)智能控制有限公司 | 用于增量式编码器测速的计算机存储介质 |
CN108549024A (zh) * | 2018-02-09 | 2018-09-18 | 中国科学院长春光学精密机械与物理研究所 | 一种预测式m/t的测速系统及方法 |
Non-Patent Citations (1)
Title |
---|
于增坤: "一种新的自适应M/T电机测速算法", 《微特电机》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112986605A (zh) * | 2021-02-22 | 2021-06-18 | 合肥宏晶微电子科技股份有限公司 | 一种电机测速方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN112305256B (zh) | 2022-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111693785B (zh) | 一种数字脉冲信号宽度测量电路及测量方法 | |
EP0177557B1 (en) | Counting apparatus and method for frequency sampling | |
CN112305256B (zh) | 一种自适应mt过渡测速方法 | |
CN103048508B (zh) | 提高数字示波器触发水平精度的方法、装置及数字示波器 | |
CN110017836B (zh) | 加速度计数字采样滑窗滤波跨时钟域同步数据传输方法 | |
CN108181482A (zh) | 基于虚拟正弦波的实时低速检测装置 | |
CN108549024B (zh) | 一种预测式m/t的测速系统及方法 | |
EP2177917B1 (en) | Velocity detection method and motor control device using the method | |
CN116400093A (zh) | 一种正交光电编码器带加速度校正的变窗口测速方法 | |
CN109782013B (zh) | 电机测速方法、装置、可读存储介质及电动设备 | |
CN107508512B (zh) | 闭环步进电机的超低速预估器控制算法 | |
CN208224799U (zh) | 瞄准控制系统 | |
CN105866542A (zh) | 一种高精度滑动测频法 | |
CN115220333A (zh) | 一种面向单光子激光雷达应用的高计数率时间数字转换器 | |
CN114518782A (zh) | 微控制单元、电机转速测量方法及系统、存储介质 | |
CN110799807B (zh) | 一种正交编码器信号滤波方法、装置及系统 | |
CN102589545B (zh) | 惯性测量单元的零位自校准电压频率转换装置 | |
JP2680900B2 (ja) | ジヤイロのオフセツト除去法 | |
EP0588582A1 (en) | Control circuit for a pointer instrument in a dashboard | |
CN116962552B (zh) | Ak协议轮速传感器协议数据位解析方法和装置 | |
CN114001734B (zh) | 一种惯性导航系统及其i/f采样电路、i/f转换电路 | |
SU736087A1 (ru) | Устройство дл ввода информации с магнитного носител | |
SU570900A1 (ru) | Корректирующее устройство | |
CN110672175B (zh) | 高可靠性三霍尔双向计量装置及方法 | |
CN110798205B (zh) | 一种正交编码脉冲信号的零位检测方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |