CN109323649A - 一种基于霍尔效应的角位移解算方法 - Google Patents
一种基于霍尔效应的角位移解算方法 Download PDFInfo
- Publication number
- CN109323649A CN109323649A CN201811204614.6A CN201811204614A CN109323649A CN 109323649 A CN109323649 A CN 109323649A CN 201811204614 A CN201811204614 A CN 201811204614A CN 109323649 A CN109323649 A CN 109323649A
- Authority
- CN
- China
- Prior art keywords
- angle
- value
- motor
- hall sensor
- hall
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B7/00—Measuring arrangements characterised by the use of electric or magnetic techniques
- G01B7/30—Measuring arrangements characterised by the use of electric or magnetic techniques for measuring angles or tapers; for testing the alignment of axes
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
- Transmission And Conversion Of Sensor Element Output (AREA)
Abstract
本发明涉及一种基于霍尔效应的角位移解算方法,属于光电吊舱技术领域。本发明基于霍尔效应设计了一种角位移解算方法,根据该方法已得到工程应用,经试验证明该方法可以有效解决基于线性霍尔传感器的测角装置的角度解算问题;数据源来自于测角装置内部的霍尔传感器采样,计算量小、计算时间短(系统时钟80MHz,计算时间小于100us),满足实时性要求;该解算方法适用范围广,可以普遍应用于类似的基于线性霍尔传感器的测角装置中。
Description
技术领域
本发明属于光电吊舱技术领域,具体涉及一种基于霍尔效应的角位移解算方法。
背景技术
小型无人机的带载能力有限,因此对作为其重要任务设备的光电吊舱也提出了小型化的要求。在小型(1.5Kg以下)四框架光电吊舱中,有限的空间用于承载光电探测设备,吊舱外框架需要做大范围角运动,使用单独的角度传感器一般体积较大,在小型吊舱中应用比较困难,因此设计了一种基于线性霍尔传感器的小型测角装置,用于测量框架角位移,装置原理图见图1。该装置使用两个线性霍尔传感器正交安装在电机驱动电路板上,电机输出轴端面粘贴圆形磁铁。磁铁随电机旋转时,两路霍尔传感器通过磁感应输出相位差90°的电压信号,电机和吊舱框架之间采用齿轮传动,减速比为d_scale,针对该装置,需要给出一种将该两路霍尔电压信号解算成在-180°~180°角度范围内相应框架角位移的方法。
发明内容
(一)要解决的技术问题
本发明要解决的技术问题是:如何针对基于线性霍尔传感器的小型测角装置中两个线性霍尔传感器感应出的电压,解算出吊舱框架-180°~180°范围内的角度值,并且使角度值的噪声尽可能小。
(二)技术方案
为了解决上述技术问题,本发明提供了一种基于霍尔效应的角位移解算方法,包括以下步骤:
第一步,组装出一种基于线性霍尔传感器的测角装置,用于测量框架角位移,该装置中,使用两个线性霍尔传感器即第一霍尔传感器和第二霍尔传感器,正交安装在电机驱动电路板上,电机输出轴端面粘贴圆形磁铁,磁铁随电机旋转时,两路霍尔传感器通过磁感应输出相位差90°的电压信号,电机和吊舱框架之间采用齿轮传动;
设Hall_sin是第一霍尔传感器输出电压经AD芯片采样后的值;Hall_cos是第二霍尔传感器输出电压经AD芯片采样后的值;Tsam是AD采样周期;fc是低通滤波器的截止频率;fHall_sinK是第一霍尔传感器输出电压经AD芯片采样后的值再经过低通滤波后的当前值;fHall_sinK-1是第一霍尔传感器输出电压AD采样值上一次低通滤波后的值;fHall_cosK是第二霍尔传感器输出电压经AD芯片采样后的值再经过低通滤波后的当前值;fHall_cosK-1是第二霍尔传感器输出电压AD采样值上一次低通滤波后的值;Angle_motorK是电机输出轴角度当前计算值;Angle_motorK-1是电机输出轴角度上一次计算值;Angle_gimbleK是吊舱框架角度当前计算值;d_scale是齿轮减速比;Angle_gimble是吊舱框架角度值;init_ang是初始零位偏差角;P是电机正转的圈数;N是电机反转的圈数;
第二步、采集两个霍尔传感器的输出的数据,并对两个霍尔传感器的输出的数据进行低通滤波:
采集第一霍尔传感器输出电压AD采样值上一次低通滤波后的值、第一霍尔传感器输出电压经AD芯片采样后的值、第二霍尔传感器输出电压经AD芯片采样后的值、第二霍尔传感器输出电压AD采样值上一次低通滤波后的值;
第三步、根据第二步的数据采集结果计算第一霍尔传感器的AD采样值数字低通滤波值:
第四步、根据第二步的数据采集结果计算第二霍尔传感器的AD采样值数字低通滤波值:
第五步、根据第三步、第四步的结果,将两路滤波后的霍尔传感器滤波值解算成电机输出轴在-180°~180°范围内的角度值:
Angle_motorK=atan2(fHall_sinK,fHall_cosK) (3)
第六步、根据第五步的结果进行正反转圈数计数逻辑判断
如果Angle_motorK-Angle_motorK-1≥300,那么P=P+1;
如果Angle_motorK-Angle_motorK-1≤-300,那么N=N-1;
第七步、将电机输出轴角度值解算成吊舱框架角
Angle_gimbleK=[Angle_motorK+(P+N)×360]/d_scale-init_ang (4)
第八步、根据以下逻辑将吊舱框架角转换到-180°~180°区间
如果Angle_gimbleK>180,那么
Angle_gimbleK=Angle_gimbleK-360;P=P-d_scale;
如果Angle_gimbleK<-180,那么
Angle_gimbleK=Angle_gimbleK+360;N=N+d_scale。
优选地,Tsam不小于1ms。
优选地,Tsam取0.5ms。
优选地,fc为100Hz。
优选地,fHall_sinK-1初始值设为0。
优选地,fHall_cosK-1初始值设为0。
优选地,P初始值为0。
优选地,N初始值为0。
(三)有益效果
本发明基于霍尔效应设计了一种角位移解算方法,根据该方法已得到工程应用,经试验证明该方法可以有效解决基于线性霍尔传感器的测角装置的角度解算问题;数据源来自于测角装置内部的霍尔传感器采样,计算量小、计算时间短(系统时钟80MHz,计算时间小于100us),满足实时性要求;该解算方法适用范围广,可以普遍应用于类似的基于线性霍尔传感器的测角装置中。
附图说明
图1是基于线性霍尔传感器的小型测角装置结构示意图;
图2是本发明的方法流程图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
本发明提供了一种基于霍尔效应的角位移解算方法,包括以下步骤:
第一步,按照图1所示的结构组装出一种基于线性霍尔传感器的小型测角装置,用于测量框架角位移,该装置中,使用两个线性霍尔传感器即第一霍尔传感器和第二霍尔传感器,正交安装在电机驱动电路板上,电机输出轴端面粘贴圆形磁铁。磁铁随电机旋转时,两路霍尔传感器通过磁感应输出相位差90°的电压信号,电机和吊舱框架之间采用齿轮传动;
设Hall_sin是第一霍尔传感器输出电压经AD芯片采样后的值;Hall_cos是第二霍尔传感器输出电压经AD芯片采样后的值;Tsam是AD采样周期,是人为根据需要进行设定的值,该值一般不小于1ms,在本装置中取0.5ms;fc是低通滤波器的截止频率,在本装置中为100Hz;fHall_sinK是第一霍尔传感器输出电压经AD芯片采样后的值再经过低通滤波后的当前值;fHall_sinK-1是第一霍尔传感器输出电压AD采样值上一次低通滤波后的值,初始值设为0;fHall_cosK是第二霍尔传感器输出电压经AD芯片采样后的值再经过低通滤波后的当前值;fHall_cosK-1是第二霍尔传感器输出电压AD采样值上一次低通滤波后的值,初始值设为0;Angle_motorK是电机输出轴角度当前计算值;Angle_motorK-1是电机输出轴角度上一次计算值;Angle_gimbleK是吊舱框架角度当前计算值;d_scale是齿轮减速比;Angle_gimble是吊舱框架角度值;init_ang是初始零位偏差角;P是电机正转的圈数,初始值为0;N是电机反转的圈数,初始值为0;
参考图2,第二步、采集两个霍尔传感器的输出的数据,并对两个霍尔传感器的输出的数据进行低通滤波:
采集第一霍尔传感器输出电压AD采样值上一次低通滤波后的值、第一霍尔传感器输出电压经AD芯片采样后的值、第二霍尔传感器输出电压经AD芯片采样后的值、第二霍尔传感器输出电压AD采样值上一次低通滤波后的值;
第三步、根据第二步的数据采集结果计算第一霍尔传感器的AD采样值数字低通滤波值:
第四步、根据第二步的数据采集结果计算第二霍尔传感器的AD采样值数字低通滤波值:
第五步、根据第三步、第四步的结果,将两路滤波后的霍尔传感器滤波值解算成电机输出轴在-180°~180°范围内的角度值:
Angle_motorK=atan2(fHall_sinK,fHall_cosK) (3)
第六步、根据第五步的结果进行正反转圈数计数逻辑判断
如果Angle_motorK-Angle_motorK-1≥300,那么P=P+1;
如果Angle_motorK-Angle_motorK-1≤-300,那么N=N-1;
第七步、将电机输出轴角度值解算成吊舱框架角
Angle_gimbleK=[Angle_motorK+(P+N)×360]/d_scale-init_ang (4)
第八步、根据以下逻辑将吊舱框架角转换到-180°~180°区间
如果Angle_gimbleK>180,那么
Angle_gimbleK=Angle_gimbleK-360;P=P-d_scale;
如果Angle_gimbleK<-180,那么
Angle_gimbleK=Angle_gimbleK+360;N=N+d_scale。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (8)
1.一种基于霍尔效应的角位移解算方法,其特征在于,包括以下步骤:
第一步,组装出一种基于线性霍尔传感器的测角装置,用于测量框架角位移,该装置中,使用两个线性霍尔传感器即第一霍尔传感器和第二霍尔传感器,正交安装在电机驱动电路板上,电机输出轴端面粘贴圆形磁铁,磁铁随电机旋转时,两路霍尔传感器通过磁感应输出相位差90°的电压信号,电机和吊舱框架之间采用齿轮传动;
设Hall_sin是第一霍尔传感器输出电压经AD芯片采样后的值;Hall_cos是第二霍尔传感器输出电压经AD芯片采样后的值;Tsam是AD采样周期;fc是低通滤波器的截止频率;fHall_sinK是第一霍尔传感器输出电压经AD芯片采样后的值再经过低通滤波后的当前值;fHall_sinK-1是第一霍尔传感器输出电压AD采样值上一次低通滤波后的值;fHall_cosK是第二霍尔传感器输出电压经AD芯片采样后的值再经过低通滤波后的当前值;fHall_cosK-1是第二霍尔传感器输出电压AD采样值上一次低通滤波后的值;Angle_motorK是电机输出轴角度当前计算值;Angle_motorK-1是电机输出轴角度上一次计算值;Angle_gimbleK是吊舱框架角度当前计算值;d_scale是齿轮减速比;Angle_gimble是吊舱框架角度值;init_ang是初始零位偏差角;P是电机正转的圈数;N是电机反转的圈数;
第二步、采集两个霍尔传感器的输出的数据,并对两个霍尔传感器的输出的数据进行低通滤波:
采集第一霍尔传感器输出电压AD采样值上一次低通滤波后的值、第一霍尔传感器输出电压经AD芯片采样后的值、第二霍尔传感器输出电压经AD芯片采样后的值、第二霍尔传感器输出电压AD采样值上一次低通滤波后的值;
第三步、根据第二步的数据采集结果计算第一霍尔传感器的AD采样值数字低通滤波值:
第四步、根据第二步的数据采集结果计算第二霍尔传感器的AD采样值数字低通滤波值:
第五步、根据第三步、第四步的结果,将两路滤波后的霍尔传感器滤波值解算成电机输出轴在-180°~180°范围内的角度值:
Angle_motorK=atan2(fHall_sinK,fHall_cosK) (3)
第六步、根据第五步的结果进行正反转圈数计数逻辑判断
如果Angle_motorK-Angle_motorK-1≥300,那么P=P+1;
如果Angle_motorK-Angle_motorK-1≤-300,那么N=N-1;
第七步、将电机输出轴角度值解算成吊舱框架角
Angle_gimbleK=[Angle_motorK+(P+N)×360]/d_scale-init_ang (4)
第八步、根据以下逻辑将吊舱框架角转换到-180°~180°区间
如果Angle_gimbleK>180,那么
Angle_gimbleK=Angle_gimbleK-360;P=P-d_scale;
如果Angle_gimbleK<-180,那么
Angle_gimbleK=Angle_gimbleK+360;N=N+d_scale。
2.如权利要求1所述的方法,其特征在于,Tsam不小于1ms。
3.如权利要求2所述的方法,其特征在于,Tsam取0.5ms。
4.如权利要求1所述的方法,其特征在于,fc为100Hz。
5.如权利要求1所述的方法,其特征在于,fHall_sinK-1初始值设为0。
6.如权利要求1所述的方法,其特征在于,fHall_cosK-1初始值设为0。
7.如权利要求1所述的方法,其特征在于,P初始值为0。
8.如权利要求1至7中任一项所述的方法,其特征在于,N初始值为0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811204614.6A CN109323649B (zh) | 2018-10-16 | 2018-10-16 | 一种基于霍尔效应的角位移解算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811204614.6A CN109323649B (zh) | 2018-10-16 | 2018-10-16 | 一种基于霍尔效应的角位移解算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109323649A true CN109323649A (zh) | 2019-02-12 |
CN109323649B CN109323649B (zh) | 2020-09-08 |
Family
ID=65262336
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811204614.6A Active CN109323649B (zh) | 2018-10-16 | 2018-10-16 | 一种基于霍尔效应的角位移解算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109323649B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110702038A (zh) * | 2019-10-15 | 2020-01-17 | 中国航空工业集团公司洛阳电光设备研究所 | 一种吊舱产品中平台绝对角度的测量系统及数据处理方法 |
CN111077777A (zh) * | 2019-12-17 | 2020-04-28 | 天津津航技术物理研究所 | 双通道旋转变压器测角的三角函数模型误差补偿方法 |
CN112781484A (zh) * | 2020-12-22 | 2021-05-11 | 广州极飞科技股份有限公司 | 线性霍尔传感器的转子角度校准方法及装置、电子设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060202679A1 (en) * | 2003-12-18 | 2006-09-14 | Hitachi, Ltd. | Displacement sensor |
CN2891435Y (zh) * | 2006-04-04 | 2007-04-18 | 上海华明电力设备制造有限公司 | 接近式电机旋转方向检测装置 |
CN104319947A (zh) * | 2014-10-18 | 2015-01-28 | 广东戈兰玛汽车系统有限公司 | 设有剩磁检测转速/转角传感器的电机及测量其转速/转角的方法 |
CN104995486A (zh) * | 2013-02-26 | 2015-10-21 | 斯凯孚公司 | 角度传感器、轴承单元、电机、控制系统及误差检验系统 |
CN105841604A (zh) * | 2015-01-30 | 2016-08-10 | 英飞凌科技股份有限公司 | 探测轴的旋转的位置 |
-
2018
- 2018-10-16 CN CN201811204614.6A patent/CN109323649B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060202679A1 (en) * | 2003-12-18 | 2006-09-14 | Hitachi, Ltd. | Displacement sensor |
CN2891435Y (zh) * | 2006-04-04 | 2007-04-18 | 上海华明电力设备制造有限公司 | 接近式电机旋转方向检测装置 |
CN104995486A (zh) * | 2013-02-26 | 2015-10-21 | 斯凯孚公司 | 角度传感器、轴承单元、电机、控制系统及误差检验系统 |
CN104319947A (zh) * | 2014-10-18 | 2015-01-28 | 广东戈兰玛汽车系统有限公司 | 设有剩磁检测转速/转角传感器的电机及测量其转速/转角的方法 |
CN105841604A (zh) * | 2015-01-30 | 2016-08-10 | 英飞凌科技股份有限公司 | 探测轴的旋转的位置 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110702038A (zh) * | 2019-10-15 | 2020-01-17 | 中国航空工业集团公司洛阳电光设备研究所 | 一种吊舱产品中平台绝对角度的测量系统及数据处理方法 |
CN111077777A (zh) * | 2019-12-17 | 2020-04-28 | 天津津航技术物理研究所 | 双通道旋转变压器测角的三角函数模型误差补偿方法 |
CN112781484A (zh) * | 2020-12-22 | 2021-05-11 | 广州极飞科技股份有限公司 | 线性霍尔传感器的转子角度校准方法及装置、电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN109323649B (zh) | 2020-09-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109323649A (zh) | 一种基于霍尔效应的角位移解算方法 | |
CN102589405B (zh) | 一种电机动子位移测量方法 | |
US9435684B2 (en) | Integrated vibration measurement and analysis system | |
CN104006962A (zh) | 一种齿轮故障特征提取方法及系统 | |
CN104897962B (zh) | 基于互素感知的单频信号短样本高精度测频方法及其装置 | |
CN105007016B (zh) | 一种基于旋转变压器的永磁同步电机测速方法 | |
CN102778580B (zh) | 一种永磁同步电机速度检测方法 | |
CN102270961B (zh) | 正余弦编码器的信号细分方法及细分装置、电机控制装置 | |
JP2016503174A (ja) | マルチターンアブソリュート磁気エンコーダ | |
US8499647B2 (en) | Electromagnetic flow meter | |
CN103023399A (zh) | 旋转变压器转子零位角度标定系统 | |
CN207780217U (zh) | 一种旋转变压器的零位角测试装置 | |
CN108181482A (zh) | 基于虚拟正弦波的实时低速检测装置 | |
CN104122439B (zh) | 提高相位校正精度的电能表 | |
CN102269803B (zh) | 基于时间延迟的离散频谱低频成分的校正方法 | |
EP4339633A3 (en) | Position sensor devices, methods and systems based on magnetic field gradients | |
CN101723213A (zh) | 一种基于SinCos编码器检测位置和速度的方法 | |
CN109029232A (zh) | 一种基于旋转磁场位移测量的方法 | |
CN101865651B (zh) | 一种旋转变压器角度信号解码方法 | |
CN102879751A (zh) | 基于数字积分的磁滞回线测量方法与装置 | |
CN107561306B (zh) | 基于转子电流的绕线式电机转速测量方法 | |
CN206989972U (zh) | 一种抑制干扰与温漂的霍尔信号采样磁电编码器 | |
Reddy et al. | Inverse tangent based resolver to digital converter-A software approach | |
CN202940767U (zh) | 旋转变压器转子零位角度标定系统 | |
CN110133316B (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 |