CN111856075A - 旋转方向判断方法和装置及旋转方向检测装置 - Google Patents

旋转方向判断方法和装置及旋转方向检测装置 Download PDF

Info

Publication number
CN111856075A
CN111856075A CN202010700855.0A CN202010700855A CN111856075A CN 111856075 A CN111856075 A CN 111856075A CN 202010700855 A CN202010700855 A CN 202010700855A CN 111856075 A CN111856075 A CN 111856075A
Authority
CN
China
Prior art keywords
panel
cache
magnetic data
rotation
rotation direction
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
Application number
CN202010700855.0A
Other languages
English (en)
Other versions
CN111856075B (zh
Inventor
张玥
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Easthouse Electrical Co Ltd
Original Assignee
Nanjing Easthouse Electrical Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing Easthouse Electrical Co Ltd filed Critical Nanjing Easthouse Electrical Co Ltd
Priority to CN202010700855.0A priority Critical patent/CN111856075B/zh
Publication of CN111856075A publication Critical patent/CN111856075A/zh
Application granted granted Critical
Publication of CN111856075B publication Critical patent/CN111856075B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P13/00Indicating or recording presence, absence, or direction, of movement
    • G01P13/02Indicating direction only, e.g. by weather vane
    • G01P13/04Indicating positive or negative direction of a linear movement or clockwise or anti-clockwise direction of a rotational movement

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Indicating Or Recording The Presence, Absence, Or Direction Of Movement (AREA)

Abstract

本发明公开了旋转方向判断方法和装置及旋转方向检测装置。旋转方向检测装置包括处理器和旋转方向探测装置。旋转方向探测装置包括相互平行设置的第一面板和第二面板。第一面板能够围绕其中心旋转,并设有弧形布置的磁钢。第二面板上设有不少于四个的圆形周向等间距布置的霍尔传感器。处理器连接各个霍尔传感器,并通过程序指令集执行的旋转方向判断方法,以确定第一面板的旋转方向,然后根据第一面板旋转方向确定其连接的被测部件的旋转方向。相比于现有技术,本发明可以检测小角度的旋转方向,并且具有较强的抗干扰能力。

Description

旋转方向判断方法和装置及旋转方向检测装置
技术领域
本发明涉及传感器领域,特别涉及用以检测旋转方位的传感器。
背景技术
现有技术中,有关方位检测的传感器通常多采用三轴陀螺仪传感器。但在判断旋转方位时,三轴陀螺仪传感器并不适用。专利文献JPH01124770A公开了一种旋转检测方法和装置,在该专利文献中,利用两个霍尔接近传感器判断磁钢转过的先后顺序判断旋转方向。但这种装置必须要求被检测的器件至少必须完整地旋转一圈,在某些应用环境下,被检测的器件假如只旋转30度,磁钢可能都无法触及霍尔接近传感器,也就无从判断旋转方向。
发明内容
本发明所要解决的问题:检测旋转方向,特别是旋转角较小时的旋转方向。
为解决上述问题,本发明采用的方案如下:
根据本发明的旋转方向判断方法,该方法包括数据分析步骤;
所述数据分析步骤包括:
实时数据获取步骤:获取当前各霍尔传感器检测到的磁数据,并按霍尔传感器周向顺序的顺序组成当前磁数据队列;
历史数据获取步骤:获取缓存中的缓存磁数据队列;
数据对比分析步骤:将当前磁数据队列和缓存磁数据队列进行比较,从而判断出旋转方向;历史数据存储步骤:若当前缓存中的缓存磁数据队列为空,或者当前正在旋转,则将当前磁数据队列存入缓存。
进一步,根据本发明的旋转方向判断方法,
当前磁数据队列表示为
Figure BDA0002592988850000011
缓存磁数据队列表示为
Figure BDA0002592988850000012
其中,
Figure BDA0002592988850000013
为按周向顺序排列的各霍尔传感器磁数据;
Figure BDA0002592988850000014
为缓存中的各霍尔传感器的磁数据;
0,1,2,…,N-1分别为按周向顺序标记的霍尔传感器的标号;
N为霍尔传感器的个数,N>4;
所述数据对比分析步骤包括如下步骤:
S31:计算
Figure BDA0002592988850000015
S33:根据HΔ统计位置点位信息集合SH={{i1,j1,k1},{i2,j2,k3},…,{iU,jU,kU}};
其中,
i1,i2,…,iU,j1,j2,…,jU,k1,k2,…,kU均为0,1,2,…,N-1的位置点;
且满足i1,i2,…,iU各不相同;
且有
Figure BDA0002592988850000021
t∈[1..U];
U为HΔ中满足条件
Figure BDA0002592988850000022
i∈[0..N-1]的个数;
jt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ前向遍历找到的第一个满足条件
Figure BDA0002592988850000023
Figure BDA0002592988850000024
jt∈[0..N-1],t∈[1..U]的位置点;
kt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ后向遍历找到的第一个满足条件
Figure BDA0002592988850000025
Figure BDA0002592988850000026
kt∈[0..N-1],t∈[1..U]的位置点;
其中,hr为阈值;
S34:计算位置点位信息集合SH中各个位置点位信息计算前向总距离Dp和后向总距离Dn;其中,
Figure BDA0002592988850000027
Figure BDA0002592988850000028
其中,MOD为求余运算。
S35:比较Dp和Dn;若Dp大于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向旋转;若Dp小于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向的逆向旋转。
进一步,根据本发明的旋转方向判断方法,所述数据对比分析步骤还包括阈值确定步骤;
所述阈值确定步骤包括如下步骤:
S321:计算HΔ半分绝对平均值
Figure BDA0002592988850000029
S322:比较hv和hs;若hv>hs,则hr=hv,否则hr=hs
其中,hs为预先设定的阈值。
进一步,根据本发明的旋转方向判断方法,
所述历史数据存储步骤中:
通过判断
Figure BDA00025929888500000210
的均值是否不大于hs判断当前缓存中的缓存磁数据队列是否为空;
通过前向总距离Dp和后向总距离Dn判断当前是否正在旋转;
Figure BDA00025929888500000211
的均值不大于hs则表示为当前缓存中的缓存磁数据队列为空;
若Dp+Dn不为0,则表示当前正在旋转;
其中,hs为预先设定的阈值。
进一步,根据本发明的旋转方向判断方法,所述数据分析步骤按一定时间间隔执行。
根据本发明的旋转方向判断装置,包括数据分析模块;
所述数据分析模块包括:
实时数据获取模块,用于:获取当前各霍尔传感器检测到的磁数据,并按霍尔传感器周向顺序的顺序组成当前磁数据队列;
历史数据获取模块,用于:获取缓存中的缓存磁数据队列;
数据对比分析模块,用于:将当前磁数据队列和缓存磁数据队列进行比较,从而判断出旋转方向;
历史数据存储模块,用于:若当前缓存中的缓存磁数据队列为空,或者当前正在旋转,则将当前磁数据队列存入缓存。
进一步,根据本发明的旋转方向判断装置,
当前磁数据队列表示为
Figure BDA0002592988850000031
缓存磁数据队列表示为
Figure BDA0002592988850000032
其中,
Figure BDA0002592988850000033
为按周向顺序排列的各霍尔传感器磁数据;
Figure BDA0002592988850000034
为缓存中的各霍尔传感器的磁数据;
0,1,2,…,N-1分别为按周向顺序标记的霍尔传感器的标号;
N为霍尔传感器的个数,N>4;
所述数据对比分析模块包括如下模块:
M31,用于:计算
Figure BDA0002592988850000035
M33,用于:根据HΔ统计位置点位信息集合SH={{i1,j1,k1},{i2,j2,k3},…,{iU,jU,kU}};
其中,
i1,i2,…,iU,j1,j2,…,jU,k1,k2,…,kU均为0,1,2,…,N-1的位置点;
且满足i1,i2,…,iU各不相同;
且有
Figure BDA0002592988850000036
t∈[1..U];
U为HΔ中满足条件
Figure BDA0002592988850000037
i∈[0..N-1]的个数;
jt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ前向遍历找到的第一个满足条件
Figure BDA0002592988850000038
Figure BDA0002592988850000041
jt∈[0..N-1],t∈[1..U]的位置点;
kt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ后向遍历找到的第一个满足条件
Figure BDA0002592988850000042
Figure BDA0002592988850000043
kt∈[0..N-1],t∈[1..U]的位置点;
其中,hr为阈值;
M34,用于:计算位置点位信息集合SH中各个位置点位信息计算前向总距离Dp和后向总距离Dn;其中,
Figure BDA0002592988850000044
Figure BDA0002592988850000045
其中,MOD为求余运算。
M35,用于:比较Dp和Dn;若Dp大于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向旋转;若Dp小于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向的逆向旋转。
进一步,根据本发明的旋转方向判断装置,所述数据对比分析模块还包括阈值确定模块;所述阈值确定模块包括如下模块:
M321,用于:计算HΔ半分绝对平均值
Figure BDA0002592988850000046
M322,用于:比较hv和hs;若hv>hs,则hr=hv,否则hr=hs
其中,hs为预先设定的阈值。
进一步,根据本发明的旋转方向判断装置,
所述历史数据存储模块中:
通过判断
Figure BDA0002592988850000047
的均值是否不大于hs判断当前缓存中的缓存磁数据队列是否为空;
通过前向总距离Dp和后向总距离Dn判断当前是否正在旋转;
Figure BDA0002592988850000048
的均值不大于hs则表示为当前缓存中的缓存磁数据队列为空;
若Dp+Dn不为0,则表示当前正在旋转;
其中,hs为预先设定的阈值。
进一步,根据本发明的旋转方向判断装置,还包括定时控制模块;所述定时控制模块用于按照一定的时间间隔执行所述数据分析模块。
根据本发明的旋转方向检测装置,该装置包括处理器和旋转方向探测装置;
所述旋转方向探测装置包括相互平行设置的第一面板和第二面板;
所述第一面板用于连接被检测部件;
当所述被检测部件旋转时,能够带动所述第一面板能够围绕其中心旋转;
所述第一面板设置有磁钢;
所述第二面板上设有不少于四个的霍尔传感器;各个霍尔传感器以所述第一面板的旋转中心为圆心周向等间距地布置在所述第二面板上;
所述第一面板上的磁钢旋转至任意位置时均能够被所述第二面板上的至少一个霍尔传感器探测到;
所述处理器连接各个霍尔传感器,并通过程序指令集执行上述的旋转方向判断方法,以确定所述第一面板的旋转方向。
本发明的技术效果如下:
1、本发明可以检测小角度的旋转方向;
2、本发明抗磁干扰能力强。
附图说明
图1是本发明旋转方向探测装置的分解示意图。
图2是本发明弧形磁钢实施方式的结构示意图。
图3是本发明旋转方向检测装置的结构示意图。
图4是本发明旋转判断方法或装置的框图。
图5是本发明数据对比分析的框图。
其中,
11是第一面板,12是第二面板,13是磁钢,14是霍尔传感器;
300是旋转方向探测装置,400是处理器。
具体实施方式
下面结合附图对本发明做进一步详细说明。
如图3所示,一种旋转方向检测装置,包括旋转方向探测装置300和处理器400。旋转方向探测装置300用于设置在被检测部件上,通过若干个霍尔传感器14探测旋转数据,提交至处理器400。处理器400通过执行程序指令集判断被检测部件的旋转方向。显而易见地,处理器400连接各个霍尔传感器14。霍尔传感器14在旋转方向探测装置300上的布置和结构,参照图1。
如图1所示,旋转方向探测装置300包括相互平行设置的第一面板11和第二面板12。第一面板11用于连接被检测部件,当被检测部件旋转时,能够带动第一面板11围绕其中心旋转。本实施例中,第一面板11是一个齿轮盘,通过齿轮盘齿轮之间的啮合连接被检测部件。第一面板11设置有磁钢13。磁钢13距离第一面板11旋转中心的中心距离为R1。第二面板12上设有不少于四个的霍尔传感器14。如图1给出的示例中,第二面板12上设置的霍尔传感器14有八个。各个霍尔传感器14以第一面板11的旋转中心为圆心周向等间距地布置在第二面板12上,并且各个霍尔传感器14所布置的半径R2与R1相同。也就是说,第二面板12上的霍尔传感器14围成一个圆,该圆的圆心位于第一面板11的旋转轴的轴心,该圆的半径R2和磁钢13距离第一面板11旋转中心的中心距离R1相同。
当第一面板11在被检测部件的带动下旋转时,第一面板11上的磁钢13围绕第一面板11的旋转轴旋转。当磁钢13围绕第一面板11的旋转轴旋转时,磁钢13沿着霍尔传感器14排列方向移动。第一面板11上的磁钢13旋转至任意位置时均能够被第二面板12上的至少一个霍尔传感器14探测到。由此,磁钢13旋转至任意位置时,能够被相应位置上的霍尔传感器14能够探测到磁钢13所产生的磁场。图1给出的示例中,第一面板11上的磁钢13采用了磁性较强的点状磁钢。而对于磁性较弱的磁钢,为了使得磁钢13旋转至任意位置时能够被相应位置上的霍尔传感器14能够探测到,亦可以采用如图2所述的弧形结构的磁钢13。该弧形的磁钢13以第一面板11的旋转中心为圆心,弧形圆心角为A2。弧形磁钢的弧形圆心角为A2和两个相邻霍尔传感器14之间的相位角A1相同。
处理器400通过执行程序指令集判断被检测部件的旋转方向所采用的方法为采用本发明所指的旋转方向判断方法确定第一面板11的旋转方向,进而根据第一面板11和被检测部件的连接关系确定被检测部件的旋转方向。本发明所指的旋转方向判断方法与本发明所指的旋转方向判断装置相对应。
如图4所示,旋转方向判断装置包括数据分析模块M100和定时控制模块M101。定时控制模块M101用于按照一定的时间间隔执行数据分析模块M100。或者,也可以说,旋转方向判断方法包括按照一定的时间间隔执行数据分析步骤S100。数据分析步骤S100对应于数据分析模块M100。
另一方面,若处理器400是一个仅于检测旋转方向的专用处理器。此时,可以不设置定时控制模块M101。此种情形亦等效于定时控制模块M101的时间间隔为零。对于旋转方向判断方法而言,数据分析步骤S100是一个无限循环执行的步骤。这也说明,根据本发明的示例,定时控制模块M101是一个可选的模块。
定时控制模块M101的时间间隔依据旋转方向检测装置实际应用场景预先配置,一般来说要求在该时间间隔内,第一面板11旋转过的角度不超过120度。比如当第一面板11每秒10转的转速下,该时间间隔应不超过33.3毫秒,当第一面板11每秒100转的转速下,该时间间隔应不超过3.3毫秒。由此可见,当第一面板11高速旋转,甚至超高速旋转的情形下,处理器400适于仅于检测旋转方向的专用处理器。
另一方面,本发明的旋转方向检测装置应用于超高转速检测旋转方向时,可以在被检测部件和旋转方向检测装置之间设置减速器。例如,图1和图2的示例中,第一面板11是一个齿轮盘,由此可以通过齿轮盘的传动实现与被检测部件之间的传动减速。由此,减速后第一面板11不会出现高速旋转的情形,此时,处理器400无需采用专用处理器的方案。通常,本发明的旋转方向检测装置应用场合中,第一面板11的转速不超过每秒10转。定时控制模块M101的时间间隔不超过33.3毫秒。因此,在实际应用场合中,定时控制模块M101的时间间隔一般不超过100毫秒,优选5~20毫秒。
数据分析模块M100包括实时数据获取模块M1、历史数据获取模块M2、数据对比分析模块M3和历史数据存储模块M4。实时数据获取模块M1、历史数据获取模块M2、数据对比分析模块M3和历史数据存储模块M4分别对应方法中的实时数据获取步骤S1、历史数据获取步骤S2、数据对比分析步骤S3和历史数据存储步骤S4。也就是,数据分析步骤S100包括实时数据获取步骤S1、历史数据获取步骤S2、数据对比分析步骤S3和历史数据存储步骤S4。
其中,实时数据获取模块M1或实时数据获取步骤S1用于:获取当前各霍尔传感器检测到的磁数据,并按霍尔传感器周向顺序的顺序组成当前磁数据队列。历史数据获取模块M2或历史数据获取步骤S2用于:获取缓存中的缓存磁数据队列。数据对比分析模块M3或数据对比分析步骤S3用于:将当前磁数据队列和缓存磁数据队列进行比较,从而判断出旋转方向。历史数据存储模块M4或历史数据存储步骤S4用于:若当前缓存中的缓存磁数据队列为空,或者当前正在旋转,则将当前磁数据队列存入缓存。这里的磁数据是霍尔传感器检测得到的数据,可以是磁通量数据或者磁场强度数据。
上述模块M1~M4之间的关系如下:M3以M1和M2的输出作为输入,M4以M3和M2的输出作为输入,M4输出的缓存又作为M2的输入。从方法的步骤时序角度而言,上述步骤S1~S4之间的时序关系如下:首先执行步骤S1和步骤S2,之后执行步骤S3然后执行步骤S4。需要指出的是,M4输出并不直接作为M2的输入,因此图4中采用虚线表示两者之间的连接关系,而其他则采用实线表示连接关系。
数据对比分析模块M3具体实现的方法有很多种。其中一种较为符合逻辑的方法是根据当前磁数据队列和缓存磁数据队列分别计算出磁钢所在的角度,然后将当前磁数据队列所计算得到的磁钢所在的角度和缓存磁数据队列计算得到的磁钢所在的角度对比判断出旋转方向。比如,当前磁数据队列所计算得到的磁钢所在的角度为270度,而缓存磁数据队列计算得到的磁钢所在的角度为30度,则可以判断出旋转方向为逆着霍尔传感器周向顺序旋转。由此,若霍尔传感器周向顺序为顺时针排列顺序,则旋转方向为逆时针旋转;若霍尔传感器周向顺序为逆时针排列顺序,则旋转方向为顺时针旋转。再比如,当前磁数据队列所计算得到的磁钢所在的角度为90度,而而缓存磁数据队列计算得到的磁钢所在的角度为140度,则可以判断出旋转方向为顺着霍尔传感器周向顺序旋转。由此,若霍尔传感器周向顺序为顺时针排列顺序,则旋转方向为顺时针旋转;若霍尔传感器周向顺序为逆时针排列顺序,则旋转方向为逆时针旋转。
一方面,考虑到磁钢13不仅仅能被一个霍尔传感器14检测到,并且得到的磁数据并非为布尔量,而为浮点数,因此,根据磁数据队列计算出磁钢所在的角度较为困难,通常需要计算磁数据队列中某一段的加权中心以作为磁钢所在的角度。特别是,在存在外界磁场干扰的情形下,计算得到的磁钢所在的角度误差非常大。同时这也要求,第二面板12上的霍尔传感器14密集布置,至少不能少于8个。
为避免上述方法的缺陷,本发明中,数据对比分析模块M3的具体实现优选采用如下方案:如图5所示,数据对比分析模块M3包括模块M31,M32,M33,M34和M35。与此对应地,数据对比分析步骤S3包括步骤S31,S32,S33,S34和S35。其中,
模块M31或步骤S31用于将当前磁数据队列和缓存磁数据队列相减后得到磁数据差值队列;也就是,
Figure BDA0002592988850000081
其中,HΔ为磁数据差值队列,
Figure BDA0002592988850000082
为来自于当前磁数据队列按周向顺序排列的各霍尔传感器磁数据,
Figure BDA0002592988850000083
组成当前磁数据队列,也就是,当前磁数据队列
Figure BDA0002592988850000084
为来自于缓存磁数据队列中的缓存中的各霍尔传感器的磁数据,
Figure BDA0002592988850000085
组成缓存磁数据队列,也就是,缓存磁数据队列
Figure BDA0002592988850000086
0,1,2,…,N-1分别为按周向顺序标记的霍尔传感器的标号;N为霍尔传感器的个数。
模块M32也就是前述的阈值确定模块,相应地,步骤M32也就是前述的阈值确定步骤。模块M32或步骤S32用于根据模块M31或步骤S31得到的磁数据差值队列HΔ确定阈值hr。模块M32包括模块M321和M322,也就是步骤S32包括步骤S321和S322。模块M321或步骤S321用于计算磁数据差值队列HΔ半分绝对平均值hv,也就是,
Figure BDA0002592988850000087
模块M322或步骤S322用于根据hv和hs确定阈值hr,具体为:比较hv和hs;若hv>hs,则hr=hv,否则hr=hs。其中,hs为预先设定的阈值。本实施例中,hs优选为0。
模块M33或步骤S33用于根据模块M32或步骤S32得到的阈值hr对模块M31或步骤S31得到的磁数据差值队列HΔ进行统计,得到位置点位信息集合SH。位置点位信息集合SH={{i1,j1,k1},{i2,j2,k3},…,{iU,jU,kU}}。其中,i1,i2,…,iU,j1,j2,…,jU,k1,k2,…,kU均为0,1,2,…,N-1的位置点,且i1,i2,…,iU各不相同,且满足且有
Figure BDA0002592988850000088
t∈[1..U];U为HΔ中满足条件
Figure BDA0002592988850000091
i∈[0..N-1]的个数。jt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ前向遍历找到的第一个满足条件
Figure BDA0002592988850000092
jt∈[0..N-1],t∈[1..U]的位置点。kt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ后向遍历找到的第一个满足条件
Figure BDA0002592988850000093
kt∈[0..N-1],t∈[1..U]的位置点。步骤S33可以分解为以下三个步骤实现:
步骤S331:对磁数据差值队列HΔ遍历,找出磁数据差值队列HΔ中满足条件
Figure BDA0002592988850000094
的为位置点i,组成集合
Figure BDA0002592988850000095
也就是,i1,i2,…,iU为0,1,2,…,N-1的位置点,且i1,i2,…,iU各不相同,且满足且有
Figure BDA0002592988850000096
步骤S332:对集合
Figure BDA0002592988850000097
中的每个位置点it,t∈[1..U]分别找出其前向负值位置点jt,从而组成集合
Figure BDA0002592988850000098
前向负值位置点jt是以位置点it为起点对HΔ前向遍历找到的第一个满足条件
Figure BDA0002592988850000099
的位置点。
步骤S333:对集合
Figure BDA00025929888500000910
中的每个位置点it,t∈[1..U]分别找出其后向负值位置点kt,从而组成集合
Figure BDA00025929888500000911
后向负值位置点kt是以位置点it为起点对HΔ后向遍历找到的第一个满足条件
Figure BDA00025929888500000912
的位置点。
这里,前向遍历是对循环队列0,1,2,…,N-1的前向遍历,也就是,按照位置点队列顺序it,it-1,it-2,..,0,N-1,N-2,…,it+1进行遍历。后向遍历是对循环队列0,1,2,…,N-1的后向遍历,也就是,按照位置点队列顺序it,it+1,it+2,..,N-1,0,1,…,it-1进行遍历。
模块M34或步骤S34用于对位置点位信息集合SH进行统计,计算出各个位置点位信息计算前向总距离Dp和后向总距离Dn。也就是,
Figure BDA00025929888500000913
Figure BDA00025929888500000914
其中,MOD为求余运算。
模块M35或步骤S35用于通过对前向总距离Dp和后向总距离Dn的比较确定旋转方向,具体为:若Dp大于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向旋转;若Dp小于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向的逆向旋转。若位置点0,1,2,…,N-1所对应的霍尔传感器按照顺时针顺序排列;此时,若Dp大于Dn,为顺时针方向旋转;若Dp小于Dn,为逆时针方向旋转。相应地,若位置点0,1,2,…,N-1所对应的霍尔传感器按照逆时针顺序排列;此时,若Dp大于Dn,为逆时针方向旋转;若Dp小于Dn,为顺时针方向旋转。对于前向总距离Dp和后向总距离Dn相等的情形,分两种情况:若Dp+Dn=0,则表示当前为非旋转的静止态;若Dp+Dn>0,则当前受外界磁干扰而无法判定旋转方向。
此外,进一步地,本实施例中,在历史数据存储模块M4或历史数据存储步骤S4中,通过判断缓存磁数据队列中
Figure BDA0002592988850000101
的均值是否不大于hs判断当前缓存中的缓存磁数据队列是否为空;通过前向总距离Dp和后向总距离Dn判断当前是否正在旋转:若
Figure BDA0002592988850000102
的均值不大于hs则表示为当前缓存中的缓存磁数据队列为空;若Dp+Dn不为0,则表示当前正在旋转。这里的Dp和Dn即为模块M35或步骤S35得到的前向总距离Dp和后向总距离Dn。显而易见地,缓存中的缓存磁数据队列存在一个初始化的过程或步骤。该初始化步骤中,
Figure BDA0002592988850000103
均被设为0。
上述旋转方向判断方法举例,假设当前第二面板12上的霍尔传感器数为8。某一时刻,处理器400接收到的8个霍尔传感器的磁数据按顺时针排列分别为0.3,5.8,6.2,0.7,0.2,0.0,0.0,0.0;而缓存中的8个霍尔传感器的磁数据按顺时针排列分别为1.2,6.3,5.3,0.3,0.1,0.0,0.0,0.1。也就是:
当前磁数据队列
Figure BDA0002592988850000104
缓存磁数据队列
Figure BDA0002592988850000105
由此,步骤S31计算得到的磁数据差值队列HΔ有:
Figure BDA0002592988850000106
磁数据差值队列HΔ绝对平均值hv=0.18,由此步骤S32得到阈值hr=0.18。
步骤S331得到的集合
Figure BDA0002592988850000107
步骤S332得到的集合
Figure BDA0002592988850000108
步骤S333得到的集合
Figure BDA0002592988850000109
由此步骤S33得到的位置点位信息集合SH={{2,1,0},{3,1,0}}。
步骤S34计算的得到的前向总距离Dp=3和后向总距离Dn=11。
步骤S35根据前向总距离Dp=3和后向总距离Dn=11判断,由于前向总距离Dp小于后向总距离Dn=11,因此按霍尔传感器0,1,2,…,N-1顺序标记的方向的逆向旋转。
由上述数据的分析可以看出,相比于,前述根据当前磁数据队列和缓存磁数据队列分别计算出磁钢所在的角度后再判断旋转方向的方法,该方法显得更为简单,并且具有较强的抗干扰能力。
此外,需要说明的是,上述的数据对比分析模块M3和数据对比分析步骤S3的实施方式下,要求霍尔传感器的个数不少于5个。

Claims (12)

1.旋转方向判断方法,其特征在于,该方法包括数据分析步骤;
所述数据分析步骤包括:
实时数据获取步骤:获取当前各霍尔传感器检测到的磁数据,并按霍尔传感器周向顺序的顺序组成当前磁数据队列;
历史数据获取步骤:获取缓存中的缓存磁数据队列;
数据对比分析步骤:将当前磁数据队列和缓存磁数据队列进行比较,从而判断出旋转方向;
历史数据存储步骤:若当前缓存中的缓存磁数据队列为空,或者当前正在旋转,则将当前磁数据队列存入缓存。
2.如权利要求1所述的旋转方向判断方法,其特征在于,
当前磁数据队列表示为
Figure FDA0002592988840000011
缓存磁数据队列表示为
Figure FDA0002592988840000012
其中,
Figure FDA0002592988840000013
为按周向顺序排列的各霍尔传感器磁数据;
Figure FDA0002592988840000014
为缓存中的各霍尔传感器的磁数据;
0,1,2,…,N-1分别为按周向顺序标记的霍尔传感器的标号;
N为霍尔传感器的个数,N>4;
所述数据对比分析步骤包括如下步骤:
S31:计算
Figure FDA0002592988840000015
S33:根据HΔ统计位置点位信息集合SH={{i1,j1,k1},{i2,j2,k3},…,{iU,jU,kU}};
其中,
i1,i2,…,iU,j1,j2,…,jU,k1,k2,…,kU均为0,1,2,…,N-1的位置点;
且满足i1,i2,…,iU各不相同;
且有
Figure FDA0002592988840000016
U为HΔ中满足条件
Figure FDA0002592988840000017
的个数;
jt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ前向遍历找到的第一个满足条件
Figure FDA0002592988840000018
Figure FDA0002592988840000019
的位置点;
kt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ后向遍历找到的第一个满足条件
Figure FDA00025929888400000110
Figure FDA00025929888400000111
的位置点;
其中,hr为阈值;
S34:计算位置点位信息集合SH中各个位置点位信息计算前向总距离Dp和后向总距离Dn;其中,
Figure FDA0002592988840000021
Figure FDA0002592988840000022
其中,MOD为求余运算。
S35:比较Dp和Dn;若Dp大于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向旋转;若Dp小于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向的逆向旋转。
3.如权利要求2所述的旋转方向判断方法,其特征在于,所述数据对比分析步骤还包括阈值确定步骤;所述阈值确定步骤包括如下步骤:
S321:计算HΔ半分绝对平均值
Figure FDA0002592988840000023
S322:比较hv和hs;若hv>hs,则hr=hv,否则hr=hs
其中,hs为预先设定的阈值。
4.如权利要求2所述的旋转方向判断方法,其特征在于,
所述历史数据存储步骤中:
通过判断
Figure FDA0002592988840000024
的均值是否不大于hs判断当前缓存中的缓存磁数据队列是否为空;
通过前向总距离Dp和后向总距离Dn判断当前是否正在旋转;
Figure FDA0002592988840000025
的均值不大于hs则表示为当前缓存中的缓存磁数据队列为空;
若Dp+Dn不为0,则表示当前正在旋转;
其中,hs为预先设定的阈值。
5.如权利要求1至4任一项所述的旋转方向判断方法,其特征在于,所述数据分析步骤按一定时间间隔执行。
6.旋转方向判断装置,其特征在于,该装置包括数据分析模块;
所述数据分析模块包括:
实时数据获取模块,用于:获取当前各霍尔传感器检测到的磁数据,并按霍尔传感器周向顺序的顺序组成当前磁数据队列;
历史数据获取模块,用于:获取缓存中的缓存磁数据队列;
数据对比分析模块,用于:将当前磁数据队列和缓存磁数据队列进行比较,从而判断出旋转方向;
历史数据存储模块,用于:若当前缓存中的缓存磁数据队列为空,或者当前正在旋转,则将当前磁数据队列存入缓存。
7.如权利要求6所述的旋转方向判断装置,其特征在于,
当前磁数据队列表示为
Figure FDA0002592988840000031
缓存磁数据队列表示为
Figure FDA0002592988840000032
其中,
Figure FDA0002592988840000033
为按周向顺序排列的各霍尔传感器磁数据;
Figure FDA0002592988840000034
为缓存中的各霍尔传感器的磁数据;
0,1,2,…,N-1分别为按周向顺序标记的霍尔传感器的标号;
N为霍尔传感器的个数,N>4;
所述数据对比分析模块包括如下模块:
M31,用于:计算
Figure FDA0002592988840000035
M33,用于:根据HΔ统计位置点位信息集合SH={{i1,j1,k1},{i2,j2,k3},…,{iU,jU,kU}};
其中,
i1,i2,…,iU,j1,j2,…,jU,k1,k2,…,kU均为0,1,2,…,N-1的位置点;
且满足i1,i2,…,iU各不相同;
且有
Figure FDA0002592988840000036
U为HΔ中满足条件
Figure FDA0002592988840000037
的个数;
jt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ前向遍历找到的第一个满足条件
Figure FDA0002592988840000038
Figure FDA0002592988840000039
的位置点;
kt,t∈[1..U]是以位置点it,t∈[1..U]为起点对HΔ后向遍历找到的第一个满足条件
Figure FDA00025929888400000310
Figure FDA00025929888400000311
的位置点;
其中,hr为阈值;
M34,用于:计算位置点位信息集合SH中各个位置点位信息计算前向总距离Dp和后向总距离Dn;其中,
Figure FDA00025929888400000312
Figure FDA00025929888400000313
其中,MOD为求余运算。
M35,用于:比较Dp和Dn;若Dp大于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向旋转;若Dp小于Dn,则按霍尔传感器0,1,2,…,N-1顺序标记的方向的逆向旋转。
8.如权利要求7所述的旋转方向判断装置,其特征在于,所述数据对比分析模块还包括阈值确定模块;所述阈值确定模块包括如下模块:
M321,用于:计算HΔ半分绝对平均值
Figure FDA0002592988840000041
M322,用于:比较hv和hs;若hv>hs,则hr=hv,否则hr=hs
其中,hs为预先设定的阈值。
9.如权利要求7所述的旋转方向判断装置,其特征在于,
所述历史数据存储模块中:
通过判断
Figure FDA0002592988840000042
的均值是否不大于hs判断当前缓存中的缓存磁数据队列是否为空;
通过前向总距离Dp和后向总距离Dn判断当前是否正在旋转;
Figure FDA0002592988840000043
的均值不大于hs则表示为当前缓存中的缓存磁数据队列为空;
若Dp+Dn不为0,则表示当前正在旋转;
其中,hs为预先设定的阈值。
10.如权利要求6至9任一项所述的旋转方向判断装置,其特征在于,该装置还包括定时控制模块;所述定时控制模块用于按照一定的时间间隔执行所述数据分析模块。
11.旋转方向检测装置,其特征在于,该装置包括处理器和旋转方向探测装置;
所述旋转方向探测装置包括相互平行设置的第一面板和第二面板;
所述第一面板用于连接被检测部件;
当所述被检测部件旋转时,能够带动所述第一面板能够围绕其中心旋转;
所述第一面板设置有磁钢;
所述第二面板上设有不少于四个的霍尔传感器;各个霍尔传感器以所述第一面板的旋转中心为圆心周向等间距地布置在所述第二面板上;
所述第一面板上的磁钢旋转至任意位置时均能够被所述第二面板上的至少一个霍尔传感器探测到;
所述处理器连接各个霍尔传感器,并通过程序指令集执行如权利要求1至4中任一项所述的旋转方向判断方法,以确定所述第一面板的旋转方向。
12.旋转方向检测装置,其特征在于,该装置包括处理器和旋转方向探测装置;
所述旋转方向探测装置包括相互平行设置的第一面板和第二面板;
所述第一面板用于连接被检测部件;
当所述被检测部件旋转时,能够带动所述第一面板能够围绕其中心旋转;
所述第一面板设置有磁钢;
所述第二面板上设有不少于四个的霍尔传感器;各个霍尔传感器以所述第一面板的旋转中心为圆心周向等间距地布置在所述第二面板上;
所述第一面板上的磁钢旋转至任意位置时均能够被所述第二面板上的至少一个霍尔传感器探测到;
所述处理器连接各个霍尔传感器,并通过程序指令集执行如权利要求5所述的旋转方向判断方法,以确定所述第一面板的旋转方向。
CN202010700855.0A 2020-07-17 2020-07-17 旋转方向判断方法和装置及旋转方向检测装置 Active CN111856075B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010700855.0A CN111856075B (zh) 2020-07-17 2020-07-17 旋转方向判断方法和装置及旋转方向检测装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010700855.0A CN111856075B (zh) 2020-07-17 2020-07-17 旋转方向判断方法和装置及旋转方向检测装置

Publications (2)

Publication Number Publication Date
CN111856075A true CN111856075A (zh) 2020-10-30
CN111856075B CN111856075B (zh) 2022-03-15

Family

ID=73000815

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010700855.0A Active CN111856075B (zh) 2020-07-17 2020-07-17 旋转方向判断方法和装置及旋转方向检测装置

Country Status (1)

Country Link
CN (1) CN111856075B (zh)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102112883A (zh) * 2008-07-31 2011-06-29 阿莱戈微系统公司 用于提供表示铁磁物体旋转速度和旋转方向的输出信号的设备和方法
CN103808960A (zh) * 2014-02-26 2014-05-21 天津工业大学 一种测量转轴的转速和方向的装置及方法
CN104422384A (zh) * 2013-08-31 2015-03-18 上海体育学院 一种旋转状态检测装置和方法
CN105261509A (zh) * 2015-08-28 2016-01-20 青岛海尔科技有限公司 分离式旋钮开关、终端设备及其工作模式调整方法
CN105445493A (zh) * 2016-01-16 2016-03-30 中车青岛四方机车车辆股份有限公司 一种微小转角情况下电机转向检测与识别装置与方法
CN106501541A (zh) * 2015-09-08 2017-03-15 空中客车英国运营有限责任公司 确定本体旋转速度或方向的装置、设备、方法和交通工具
US20170336225A1 (en) * 2016-05-17 2017-11-23 Allegro MicroSysterns, LLC Magnetic Field Sensors And Output Signal Formats For A Magnetic Field Sensor
CN111398628A (zh) * 2020-04-08 2020-07-10 深圳市晶丰弘实业有限公司 一种电动机转速方向测量装置及其测量的计算方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102112883A (zh) * 2008-07-31 2011-06-29 阿莱戈微系统公司 用于提供表示铁磁物体旋转速度和旋转方向的输出信号的设备和方法
CN104422384A (zh) * 2013-08-31 2015-03-18 上海体育学院 一种旋转状态检测装置和方法
CN103808960A (zh) * 2014-02-26 2014-05-21 天津工业大学 一种测量转轴的转速和方向的装置及方法
CN105261509A (zh) * 2015-08-28 2016-01-20 青岛海尔科技有限公司 分离式旋钮开关、终端设备及其工作模式调整方法
CN106501541A (zh) * 2015-09-08 2017-03-15 空中客车英国运营有限责任公司 确定本体旋转速度或方向的装置、设备、方法和交通工具
CN105445493A (zh) * 2016-01-16 2016-03-30 中车青岛四方机车车辆股份有限公司 一种微小转角情况下电机转向检测与识别装置与方法
US20170336225A1 (en) * 2016-05-17 2017-11-23 Allegro MicroSysterns, LLC Magnetic Field Sensors And Output Signal Formats For A Magnetic Field Sensor
CN111398628A (zh) * 2020-04-08 2020-07-10 深圳市晶丰弘实业有限公司 一种电动机转速方向测量装置及其测量的计算方法

Also Published As

Publication number Publication date
CN111856075B (zh) 2022-03-15

Similar Documents

Publication Publication Date Title
US11852958B2 (en) Gimbal control method, device, and gimbal
CN110977985A (zh) 一种定位的方法及装置
WO2007015138A1 (en) Correction device for acceleration sensor, and output value correction method for acceleration sensor
US11574167B2 (en) Circuit and a method for determining an attitude of a magnet, and joystick
JP5012252B2 (ja) 磁気データ処理装置、方法およびプログラム
CN112135124A (zh) 云台位置校准检测方法、装置以及系统
WO2011152105A1 (ja) 磁気式ジャイロ
CN105975294A (zh) 一种移动终端应用程序的启动方法及装置
CN111856075B (zh) 旋转方向判断方法和装置及旋转方向检测装置
CN110293563A (zh) 估计机器人位姿的方法、设备及存储介质
CN105937911A (zh) 一种磁传感器姿态解算方法
CN109677508B (zh) 一种车辆运动数据获取方法、装置、设备和存储介质
US7668689B2 (en) Velocity detection apparatus
KR101239570B1 (ko) 속도 검출 장치 및 서보 모터
JP4987269B2 (ja) 速度検出装置およびサーボモータ
CN101930013A (zh) 转向检测方法及转向检测电路
CN109470269B (zh) 空间目标测量机构的标定方法、标定设备及标定系统
CN106959704A (zh) 三维形貌测量仪的控制方法及其系统
JP5816879B2 (ja) 磁気式ジャイロ
JP2016211907A (ja) 傾斜度測定方法及び装置並びに電子機器及びプログラム
JP6477214B2 (ja) 傾斜度測定方法及び装置並びに電子機器及びプログラム
CN107730712A (zh) 一种干扰定位方法及装置
CN116033271A (zh) 一种摄像机控制方法、装置、存储介质及系统
US20240007613A1 (en) Camera Rotation Correction
CN113014725A (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
CB02 Change of applicant information
CB02 Change of applicant information

Address after: No.27 Puzhou Road, Jiangbei new district, Nanjing, Jiangsu Province 210032

Applicant after: Dongwu Shian IOT Technology (Jiangsu) Co.,Ltd.

Address before: No.27 Puzhou Road, Jiangbei new district, Nanjing, Jiangsu Province 210032

Applicant before: NANJING EASTHOUSE ELECTRICAL Co.,Ltd.

GR01 Patent grant
GR01 Patent grant