CN109323649B - 一种基于霍尔效应的角位移解算方法 - Google Patents
一种基于霍尔效应的角位移解算方法 Download PDFInfo
- Publication number
- CN109323649B CN109323649B CN201811204614.6A CN201811204614A CN109323649B CN 109323649 B CN109323649 B CN 109323649B CN 201811204614 A CN201811204614 A CN 201811204614A CN 109323649 B CN109323649 B CN 109323649B
- 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.)
- Active
Links
Images
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
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 (7)
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。
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 CN109323649A (zh) | 2019-02-12 |
CN109323649B true 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) |
Families Citing this family (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 | 天津津航技术物理研究所 | 双通道旋转变压器测角的三角函数模型误差补偿方法 |
CN112781484B (zh) * | 2020-12-22 | 2022-11-08 | 广州极飞科技股份有限公司 | 线性霍尔传感器的转子角度校准方法及装置、电子设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
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 | 英飞凌科技股份有限公司 | 探测轴的旋转的位置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005201898A (ja) * | 2003-12-18 | 2005-07-28 | Hitachi Ltd | 変位検出装置 |
-
2018
- 2018-10-16 CN CN201811204614.6A patent/CN109323649B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
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 | 英飞凌科技股份有限公司 | 探测轴的旋转的位置 |
Also Published As
Publication number | Publication date |
---|---|
CN109323649A (zh) | 2019-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109323649B (zh) | 一种基于霍尔效应的角位移解算方法 | |
CN105007016B (zh) | 一种基于旋转变压器的永磁同步电机测速方法 | |
CN104006962A (zh) | 一种齿轮故障特征提取方法及系统 | |
CN102289804A (zh) | 通过合并方向传感器读数和图像配准估计实现3d视频稳定的系统和方法 | |
CN112859942B (zh) | 一种陀螺框架伺服系统高精度位置辨识方法 | |
CN110986988A (zh) | 融合多传感器数据的轨迹推算方法、介质、终端和装置 | |
CN102636664B (zh) | 一种动态估算加速度计分辨率的方法 | |
CN104634367A (zh) | 一种大中心孔结构的磁电式绝对位置传感器及测量绝对位置的方法 | |
CN104122439B (zh) | 提高相位校正精度的电能表 | |
CN115452032A (zh) | 一种旋转变压器数字解调装置及方法 | |
CN103776471A (zh) | 一种基于双同步旋转坐标系的磁编码器 | |
CN101865651B (zh) | 一种旋转变压器角度信号解码方法 | |
CN111038519A (zh) | 一种车载道路坡度实时估计方法 | |
CN109029437B (zh) | 三自由度闭环陀螺数字接口电路 | |
CN107561306B (zh) | 基于转子电流的绕线式电机转速测量方法 | |
CN109714059B (zh) | 正余弦磁编码器的解码方法和系统 | |
CN103162679B (zh) | 一种基于乘法消除微机械陀螺同相误差系统及方法 | |
CN111912402A (zh) | 基于地磁信息辅助gps的高旋转载体的测姿方法及装置 | |
Reddy et al. | Inverse tangent based resolver to digital converter-A software approach | |
CN203929136U (zh) | 基于磁阻传感器的计量水表 | |
Buchnik et al. | Speed and position estimation of brushless DC motor in very low speeds | |
CN114389501A (zh) | 基于坐标变换的无轴承薄片电机单霍尔转子位置检测方案 | |
CN112665531B (zh) | 一种多对级旋变坐标变换解角方法 | |
CN101881784B (zh) | 一种基于感应同步器或旋转变压器的位置及速度测量装置 | |
CN110186446B (zh) | 一种基于mems陀螺的寻北仪寻北方法 |
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 |