CN105628956A - 利用正交编码器检测旋转运动***的方法 - Google Patents
利用正交编码器检测旋转运动***的方法 Download PDFInfo
- Publication number
- CN105628956A CN105628956A CN201511010836.0A CN201511010836A CN105628956A CN 105628956 A CN105628956 A CN 105628956A CN 201511010836 A CN201511010836 A CN 201511010836A CN 105628956 A CN105628956 A CN 105628956A
- Authority
- CN
- China
- Prior art keywords
- square wave
- wave signal
- orthogonal encoder
- phase square
- moment
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P13/00—Indicating or recording presence, absence, or direction, of movement
- G01P13/02—Indicating direction only, e.g. by weather vane
- G01P13/04—Indicating positive or negative direction of a linear movement or clockwise or anti-clockwise direction of a rotational movement
- G01P13/045—Indicating positive or negative direction of a linear movement or clockwise or anti-clockwise direction of a rotational movement with speed indication
-
- 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
- G01P3/486—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 delivered by photo-electric detectors
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
种利用正交编码器检测旋转运动***的方法,涉及测量仪器技术领域,所解决的是现有方法应用范围小,且检测精度低的技术问题。该方法将正交编码器输出的A相信号、B相信号调制成固定幅值的方波,并为正交编码器配置一个微处理器,将微处理器的两个外部中断引脚的外部中断触发方式分别设置为上升沿触发,并将正交编码器的A相方波信号、B相方波信号分别接到微处理器的该两个外部中断引脚,利用微处理器实时检测正交编码器输出的A相方波信号、B相方波信号各个上升沿的起始时刻,进而计算出旋转运动***的当前转动方向、当前转速。本发明提供的方法,适用于检测旋转运动***。
Description
技术领域
本发明涉及测量仪器技术,特别是涉及一种利用正交编码器检测旋转运动***的方法的技术。
背景技术
正交编码器(又名增量式编码器或光电式编码器)用于检测旋转运动***的旋转方向和速度,可以对多种电机控制应用实现闭环控制,诸如开关磁阻电机和交流感应电机。传统的正交编码器只能检测相位差为90度的信号,其应用范围较窄,而且检测精度较低,在相位差有偏差的情况下,旋转方向和速度的检测会出现误差,特别在低转速的情况下,检测误差特别明显。
发明内容
针对上述现有技术中存在的缺陷,本发明所要解决的技术问题是提供一种应用范围大,且检测精度高的利用正交编码器检测旋转运动***的方法。
为了解决上述技术问题,本发明所提供的一种利用正交编码器检测旋转运动***的方法,其特征在于:
将正交编码器输出的A相信号、B相信号调制成固定幅值的方波,并为正交编码器配置一个微处理器,将微处理器的两个外部中断引脚的外部中断触发方式分别设置为上升沿触发,并将正交编码器的A相方波信号、B相方波信号分别接到微处理器的该两个外部中断引脚,利用微处理器实时检测正交编码器输出的A相方波信号、B相方波信号;
如果微处理器检测到T3-T1<T2-T3,则判定旋转运动***的估计转向为正转,反之则判定旋转运动***的估计转向为反转;
其中,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前;
其中,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
微处理器在连续N次的估计转向中,如果有X1>X2,则判定旋转运动***的当前转动方向为正转,如果有X1<X2,则判定旋转运动***的当前转动方向为反转;
其中,N为预先设定的转向判定阈值,X1为判定旋转运动***的估计转向为正转的次数,X2为判定旋转运动***的估计转向为反转的次数。
进一步的,微处理器对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量进行累计,并在达到转速计算触发条件时,计算旋转运动***的当前转速,然后再对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量从0开始重新累计;
转速计算触发条件是正交编码器输出的A相方波信号的上升沿数量达到预先设定的上升沿数量累计阈值,或是正交编码器输出的B相方波信号的上升沿数量达到预先设定的上升沿数量累计阈值;
正交编码器输出的A相方波信号、B相方波信号的延续时长的累计公式为:
Y1=Y1+(T2-T1)
Y2=Y2+(T4-T3)
其中,Y1为正交编码器输出的A相方波信号的延续时长,Y2为正交编码器输出的B相方波信号的延续时长,Y1、Y2的初始值均为0,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
旋转运动***当前转速的计算公式为:
V=[(Z1-2)/(Y1-Yt1-Yb1)+(Z2-2)/(Y2-Yt2-Yb2)]/2
其中,V为旋转运动***的当前转速,Z1为正交编码器输出的A相方波信号的上升沿数量,Yt1为累计过程中的相邻上升沿起始时刻之间的最大差值,Yb1为累计过程中的相邻上升沿起始时刻之间的最小差值,Z2为正交编码器输出的B相方波信号的上升沿数量,Yt2为累计过程中的相邻上升沿起始时刻之间的最大差值,Yb2为累计过程中的相邻上升沿起始时刻之间的最小差值。
进一步的,微处理器对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量进行累计,并在达到转速计算触发条件时,计算旋转运动***的当前转速,然后再对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量从0开始重新累计;
转速计算触发条件是正交编码器输出的A相方波信号的延续时长达到预先设定的信号时长累计阈值,或是正交编码器输出的B相方波信号的延续时长达到预先设定的信号时长累计阈值;
正交编码器输出的A相方波信号、B相方波信号的延续时长的累计公式为:
Y1=Y1+(T2-T1)
Y2=Y2+(T4-T3)
其中,Y1为正交编码器输出的A相方波信号的延续时长,Y2为正交编码器输出的B相方波信号的延续时长,Y1、Y2的初始值均为0,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
旋转运动***当前转速的计算公式为:
V=(Z1/Y1+Z2/Y2)/2
其中,V为旋转运动***的当前转速,Z1为正交编码器输出的A相方波信号的上升沿数量,Z2为正交编码器输出的B相方波信号的上升沿数量。
本发明提供的利用正交编码器检测旋转运动***的方法,正交编码器两路检测信号的相位差不限于90度,只需满足两路检测信号的相位差大于微处理器的两个外部中断引脚的外部中断响应时间即可,具有应用范围大的特点,并且在正交编码器的两路检测信号的相位差有偏差的情况下,检测误差也很小,具有检测精度高的特点。
附图说明
图1是本发明实施例的利用正交编码器检测旋转运动***的方法的原理图。
具体实施方式
以下结合附图说明对本发明的实施例作进一步详细描述,但本实施例并不用于限制本发明,凡是采用本发明的相似结构及其相似变化,均应列入本发明的保护范围,本发明中的顿号均表示和的关系。
如图1所示,本发明实施例所提供的一种利用正交编码器检测旋转运动***的方法,其特征在于:
将正交编码器输出的A相信号、B相信号调制成固定幅值的方波,并为正交编码器配置一个微处理器,将微处理器的两个外部中断引脚的外部中断触发方式分别设置为上升沿触发,并将正交编码器的A相方波信号、B相方波信号分别接到微处理器的该两个外部中断引脚,利用微处理器实时检测正交编码器输出的A相方波信号、B相方波信号;
如果微处理器检测到T3-T1<T2-T3,则判定旋转运动***的估计转向为正转,反之则判定旋转运动***的估计转向为反转;
其中,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前;
其中,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
微处理器在连续N次的估计转向中,如果有X1>X2,则判定旋转运动***的当前转动方向为正转,如果有X1<X2,则判定旋转运动***的当前转动方向为反转;
其中,N为预先设定的转向判定阈值,X1为判定旋转运动***的估计转向为正转的次数,X2为判定旋转运动***的估计转向为反转的次数。
本发明实施例中,微处理器对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量进行累计,并在达到转速计算触发条件时,计算旋转运动***的当前转速,然后再对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量从0开始重新累计;
正交编码器输出的A相方波信号、B相方波信号的延续时长的累计公式为:
Y1=Y1+(T2-T1)
Y2=Y2+(T4-T3)
其中,Y1为正交编码器输出的A相方波信号的延续时长,Y2为正交编码器输出的B相方波信号的延续时长,Y1、Y2的初始值均为0,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
转速计算触发条件是触发条件1、触发条件2、触发条件3、触发条件4中的一种;
触发条件1:正交编码器输出的A相方波信号的上升沿数量达到预先设定的上升沿数量累计阈值;
触发条件2:正交编码器输出的B相方波信号的上升沿数量达到预先设定的上升沿数量累计阈值;
触发条件3:正交编码器输出的A相方波信号的延续时长达到预先设定的信号时长累计阈值;
触发条件4:正交编码器输出的B相方波信号的延续时长达到预先设定的信号时长累计阈值;
当转速计算触发条件是触发条件1或触发条件2时,旋转运动***当前转速的计算公式为:
V=[(Z1-2)/(Y1-Yt1-Yb1)+(Z2-2)/(Y2-Yt2-Yb2)]/2
其中,V为旋转运动***的当前转速,Z1为正交编码器输出的A相方波信号的上升沿数量,Yt1为累计过程中的相邻上升沿起始时刻之间的最大差值,Yb1为累计过程中的相邻上升沿起始时刻之间的最小差值,Z2为正交编码器输出的B相方波信号的上升沿数量,Yt2为累计过程中的相邻上升沿起始时刻之间的最大差值,Yb2为累计过程中的相邻上升沿起始时刻之间的最小差值;
当转速计算触发条件是触发条件3或触发条件4时,旋转运动***当前转速的计算公式为:
V=(Z1/Y1+Z2/Y2)/2
其中,V为旋转运动***的当前转速,Z1为正交编码器输出的A相方波信号的上升沿数量,Z2为正交编码器输出的B相方波信号的上升沿数量。
本发明实施例中,所采用的微处理器是型号为STM32F103的微处理芯片,所述正交编码器的A相信号、B相信号由磁阻探头产生,具体采用的是可调制成固定幅值方波输出的转速探头。
Claims (3)
1.一种利用正交编码器检测旋转运动***的方法,其特征在于:
将正交编码器输出的A相信号、B相信号调制成固定幅值的方波,并为正交编码器配置一个微处理器,将微处理器的两个外部中断引脚的外部中断触发方式分别设置为上升沿触发,并将正交编码器的A相方波信号、B相方波信号分别接到微处理器的该两个外部中断引脚,利用微处理器实时检测正交编码器输出的A相方波信号、B相方波信号;
如果微处理器检测到T3-T1<T2-T3,则判定旋转运动***的估计转向为正转,反之则判定旋转运动***的估计转向为反转;
其中,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前;
其中,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
微处理器在连续N次的估计转向中,如果有X1>X2,则判定旋转运动***的当前转动方向为正转,如果有X1<X2,则判定旋转运动***的当前转动方向为反转;
其中,N为预先设定的转向判定阈值,X1为判定旋转运动***的估计转向为正转的次数,X2为判定旋转运动***的估计转向为反转的次数。
2.根据权利要求1所述的利用正交编码器检测旋转运动***的方法,其特征在于:微处理器对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量进行累计,并在达到转速计算触发条件时,计算旋转运动***的当前转速,然后再对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量从0开始重新累计;
转速计算触发条件是正交编码器输出的A相方波信号的上升沿数量达到预先设定的上升沿数量累计阈值,或是正交编码器输出的B相方波信号的上升沿数量达到预先设定的上升沿数量累计阈值;
正交编码器输出的A相方波信号、B相方波信号的延续时长的累计公式为:
Y1=Y1+(T2-T1)
Y2=Y2+(T4-T3)
其中,Y1为正交编码器输出的A相方波信号的延续时长,Y2为正交编码器输出的B相方波信号的延续时长,Y1、Y2的初始值均为0,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
旋转运动***当前转速的计算公式为:
V=[(Z1-2)/(Y1-Yt1-Yb1)+(Z2-2)/(Y2-Yt2-Yb2)]/2
其中,V为旋转运动***的当前转速,Z1为正交编码器输出的A相方波信号的上升沿数量,Yt1为累计过程中的相邻上升沿起始时刻之间的最大差值,Yb1为累计过程中的相邻上升沿起始时刻之间的最小差值,Z2为正交编码器输出的B相方波信号的上升沿数量,Yt2为累计过程中的相邻上升沿起始时刻之间的最大差值,Yb2为累计过程中的相邻上升沿起始时刻之间的最小差值。
3.根据权利要求1所述的利用正交编码器检测旋转运动***的方法,其特征在于:微处理器对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量进行累计,并在达到转速计算触发条件时,计算旋转运动***的当前转速,然后再对正交编码器输出的A相方波信号、B相方波信号的延续时长及上升沿数量从0开始重新累计;
转速计算触发条件是正交编码器输出的A相方波信号的延续时长达到预先设定的信号时长累计阈值,或是正交编码器输出的B相方波信号的延续时长达到预先设定的信号时长累计阈值;
正交编码器输出的A相方波信号、B相方波信号的延续时长的累计公式为:
Y1=Y1+(T2-T1)
Y2=Y2+(T4-T3)
其中,Y1为正交编码器输出的A相方波信号的延续时长,Y2为正交编码器输出的B相方波信号的延续时长,Y1、Y2的初始值均为0,T1、T2为正交编码器输出的A相方波信号的最近两个上升沿的起始时刻,并且T1时刻位于T2时刻之前,T3、T4为正交编码器输出的B相方波信号的最近两个上升沿的起始时刻,并且T3时刻位于T4时刻之前;
旋转运动***当前转速的计算公式为:
V=(Z1/Y1+Z2/Y2)/2
其中,V为旋转运动***的当前转速,Z1为正交编码器输出的A相方波信号的上升沿数量,Z2为正交编码器输出的B相方波信号的上升沿数量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511010836.0A CN105628956A (zh) | 2015-12-30 | 2015-12-30 | 利用正交编码器检测旋转运动***的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511010836.0A CN105628956A (zh) | 2015-12-30 | 2015-12-30 | 利用正交编码器检测旋转运动***的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105628956A true CN105628956A (zh) | 2016-06-01 |
Family
ID=56044086
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201511010836.0A Pending CN105628956A (zh) | 2015-12-30 | 2015-12-30 | 利用正交编码器检测旋转运动***的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105628956A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106253763A (zh) * | 2016-07-31 | 2016-12-21 | 上海新时达电气股份有限公司 | 编码器的滤波方法及装置 |
CN108535507A (zh) * | 2018-02-08 | 2018-09-14 | 威科达(东莞)智能控制有限公司 | 用于增量式编码器测速的计算机存储介质 |
CN112146686A (zh) * | 2019-06-27 | 2020-12-29 | 西安诺瓦星云科技股份有限公司 | 旋转信息获取方法、装置及***和计算机可读存储介质 |
CN113008539A (zh) * | 2021-03-09 | 2021-06-22 | 昆明理工大学 | 一种无线传输的旋转编码器采集卡及应用 |
-
2015
- 2015-12-30 CN CN201511010836.0A patent/CN105628956A/zh active Pending
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106253763A (zh) * | 2016-07-31 | 2016-12-21 | 上海新时达电气股份有限公司 | 编码器的滤波方法及装置 |
CN106253763B (zh) * | 2016-07-31 | 2019-03-29 | 上海新时达电气股份有限公司 | 编码器的滤波方法及装置 |
CN108535507A (zh) * | 2018-02-08 | 2018-09-14 | 威科达(东莞)智能控制有限公司 | 用于增量式编码器测速的计算机存储介质 |
CN112146686A (zh) * | 2019-06-27 | 2020-12-29 | 西安诺瓦星云科技股份有限公司 | 旋转信息获取方法、装置及***和计算机可读存储介质 |
CN113008539A (zh) * | 2021-03-09 | 2021-06-22 | 昆明理工大学 | 一种无线传输的旋转编码器采集卡及应用 |
CN113008539B (zh) * | 2021-03-09 | 2022-05-06 | 昆明理工大学 | 一种无线传输的旋转编码器采集卡及应用 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104079218B (zh) | 一种电机转子位置角度获得方法 | |
CN105628956A (zh) | 利用正交编码器检测旋转运动***的方法 | |
CN101604946B (zh) | 一种适合高速的开关磁阻电机无位置传感器控制方法 | |
CN103166563B (zh) | 永磁同步电机中转子位置初始定位检测方法 | |
CN201018440Y (zh) | 开关磁阻电机转子的角位置和转速检测装置 | |
CN201608680U (zh) | 电机旋转检测装置 | |
CN101764553A (zh) | 一种开关型霍尔传感器的永磁同步电机控制方法 | |
CN101266284A (zh) | 开关磁阻电机转子的角位置和转速检测装置及方法 | |
CN107769636B (zh) | 一种无位置传感器永磁同步电机转子位置检测方法 | |
CN104838237A (zh) | 处理传感器信号用于确定马达轴的运动的方法 | |
CN102386820B (zh) | 一种带补偿能力的电机转子位置测量方法及其装置 | |
CN105182238A (zh) | 步进电机堵转检测装置及检测方法 | |
CN104065319B (zh) | 永磁同步电机零位初始角的标定方法 | |
CN104242748A (zh) | 一种用于开关磁阻电机***的转子位置估计方法及装置 | |
CN110247606B (zh) | 一种脉冲注入无位置传感器开关磁阻电机控制方法 | |
CN202940701U (zh) | 旋转电机的转速和位移测量*** | |
CN112304211B (zh) | 一种通过反电动势校准电机霍尔扇区的方法 | |
CN103940398A (zh) | 回转角度测量方法、装置、***及工程机械 | |
CN102818579B (zh) | 一种旋转变压器角度测量信号准确性判断方法 | |
CN105720876A (zh) | 一种永磁同步电机的内功率因数角检测方法 | |
WO2015172455A1 (zh) | 一种开关磁阻电动机无转子位置传感器控制方法 | |
CN108759644A (zh) | 移动距离的检测方法、装置和存储介质 | |
JP5082481B2 (ja) | 回転角度位置算出装置及びモータ | |
CN108803462B (zh) | 伺服***位置反馈的故障检测方法 | |
CN104682808B (zh) | 基于简化磁链法的开关磁阻电机调速***容错运行方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20160601 |