一种基于交变磁场的姿态识别系统

文档序号:935046 发布日期:2021-03-05 浏览:4次 >En<

阅读说明:本技术 一种基于交变磁场的姿态识别系统 (Alternating magnetic field-based attitude recognition system ) 是由 钱宇 赵川 云峰 于 2020-11-25 设计创作,主要内容包括:本发明涉及一种基于交变磁场的姿态识别系统包括三轴交变磁场发生器、控制单元和磁场校验单元;三轴交变磁场发生器与控制单元连接,在控制单元的控制下,产生时分复用的、三轴正交的局部交变磁场;并将监测的每个轴的磁场驱动电流反馈输出到控制单元;控制单元根据内设参数,输出局部交变磁场的频率、强度以及通道切换控制信号到三轴交变磁场发生器;并根据磁场驱动电流反馈进行局部交变磁场的强度调节;在校验时,磁场校验单元置于预设校验区域,对所述局部交变磁场进行接收、放大、滤波和采样后,将采样信号输出到控制单元,校验所述控制单元中的内设参数。本发明实现了输出交变磁场频率和强度的准确、稳定。(The invention relates to an alternating magnetic field-based attitude identification system which comprises a triaxial alternating magnetic field generator, a control unit and a magnetic field calibration unit, wherein the control unit is used for controlling the three-axis alternating magnetic field generator; the three-axis alternating magnetic field generator is connected with the control unit and generates a time division multiplexing and three-axis orthogonal local alternating magnetic field under the control of the control unit; the monitored magnetic field driving current of each shaft is fed back and output to the control unit; the control unit outputs the frequency and the intensity of the local alternating magnetic field and a channel switching control signal to the triaxial alternating magnetic field generator according to the internal parameters; adjusting the intensity of the local alternating magnetic field according to the magnetic field driving current feedback; during verification, the magnetic field verification unit is arranged in a preset verification area, receives, amplifies, filters and samples the local alternating magnetic field, and then outputs a sampling signal to the control unit to verify the internal parameters in the control unit. The invention realizes the accuracy and stability of the frequency and the intensity of the output alternating magnetic field.)

一种基于交变磁场的姿态识别系统

技术领域

本发明属于电磁技术领域,具体涉及一种基于交变磁场的姿态识别系统。

背景技术

在经典的交流磁姿态识别系统中,通常有四个基本组件:三轴磁场发生器,三轴磁场传感器,系统主控单元和电源模块。经典的交流磁姿态识别系统中三个正交线圈被驱动以提供与三轴正交线圈相似的耦合磁场。系统主控单元通过三轴磁场传感器对空间磁场进行感测并执行计算,显示传感器相对磁场发生器的姿态。

典型的单传感器交流磁姿态识别系统,三轴磁场发生器产生三维交流偶极子磁场,所产生的磁场耦合到传感器,传感器耦合转换后信号被放大并被系统主控单元同步采样并与已知的特征文件相适应,以产生用于计算三轴磁场发生器和传感器之间相对位置处的姿态信号矩阵。姿态计算结果由系统主控单元通过高速总线提供给上层应用,以便在越来越多的三维应用程序中应用。电源模块会提供所需的直流偏置电压,以操作跟踪器。

交流磁姿态识别系统未被广泛应用的主要障碍在于多数三轴磁场发生器和三轴磁场传感器受限于其体积,不易集成到消费品结构中。另一个缺点在于与个人计算机和个人电子设备相对较低成本相比,交流磁姿态识别系统其成本较高,其价格一般为数千乃至数万元。到目前为止,价格合理的姿态识别系统通常采用较低的技术方法,如倾斜传感器,因此其无法区分其他加速度和重力加速度,故在动态测量中容易出现较大误差。事实上,交流磁姿态识别系统的更广泛应用确实存在着尺寸、价格和性能方面的障碍。

传统的三轴磁场发生器是交流磁姿态识别系统价格昂贵的根本原因之一,在于三轴磁场发生器的发射器骨架结构采用特殊的材料和专有工艺制造。对三轴磁场发生器进行交流驱动要求驱动电路能够以相对较高的频率提供较大的驱动电流,进而系统电源能够持续提供持续大功率输出能力,这些都增加了三轴磁场发生器成本。

发明内容

鉴于上述的分析,本发明旨在公开了一种基于交变磁场的姿态识别系统,实现了输出交变磁场频率和强度的准确、稳定;并满足姿态识别数据输出率的要求,实现快速姿态识别。

本发明公开了一种基于交变磁场的姿态识别系统,包括三轴交变磁场发生器、控制单元和磁场校验单元;

所述三轴交变磁场发生器与控制单元连接,用于在控制单元的控制下,产生时分复用的、三轴正交的局部交变磁场;并将监测的每个轴的磁场驱动电流反馈输出到控制单元;

所述控制单元,用于根据内设的包括磁场频率控制参数、磁场强度控制参数、磁场时序控制参数在内的参数,输出局部交变磁场的频率、强度以及通道切换控制信号到三轴交变磁场发生器;并根据所述磁场驱动电流反馈进行局部交变磁场的强度调节;

所述磁场校验单元,用于校验所述局部交变磁场;在校验时,所述磁场校验单元置于预设校验区域,对所述局部交变磁场进行接收、放大、滤波和采样后,将采样信号输出到控制单元,校验所述控制单元中的内设参数。

进一步地,所述三轴交变磁场发生器包括三轴正交磁场发射天线、功率驱动电路组、驱动信号切换电路、驱动信号发生电路和驱动电流监测电路组;

所述三轴正交磁场发射天线包括三组发射线圈,所述功率驱动电路组包括分别与三组发射线圈连接的功率驱动电路;所述功率驱动电路组中的功率驱动电路通过驱动通道切换电路与驱动信号发生电路连接;

所述驱动信号发生电路与所述控制单元连接,在控制单元输出的频率、强度控制信号的控制下,产生对应频率和强度的磁场激励信号输出到驱动通道切换电路;

所述驱动通道切换电路在控制单元输出的通道切换控制信号的控制下,将所述驱动信号发生电路产生的磁场激励信号分时、依次切换到对应的功率驱动电路中进行功率放大输出激励电压;每个发射线圈在对应的激励电压的激励下,产生偶极子磁场;三个发射线圈产生的磁场依次作用在空间中,构成时变局部交变磁场;

所述驱动电流监测电路组包括三个驱动电流监测电路,分别连接在对应的功率驱动电路与发射线圈连接的支路上,对每个发射线圈内驱动电流进行采样和调理后,输出到控制单元。

进一步地,所述三轴正交磁场发射天线包括线圈骨架和三组发射线圈;

所述线圈骨架的外廓结构尺寸为正方体,外表面上开有固定三个发射线圈的线槽,线槽的深度以能够使三组发射线圈两两正交的缠绕固定在其外表面上后天线的外表平整为准;

所述线圈骨架采用聚醚醚酮为基础的复合材料,其耐高温值不低于300℃;所述发射线圈为0.17mm的漆包线。

进一步地,所述驱动信号发生电路包括直接数字频率合成(DDS)模块、高阶低通滤波模块、可编程增益放大模块;

所述直接数字频率合成(DDS)模块在所述功率控制单元的频率控制信号的控制下,输出设定频率的激励信号到高阶低通滤波模块;

所述高阶低通滤波模块滤除所述直接数字频率合成(DDS)模块产生的激励信号中的高次谐波,输出平滑后的激励信号;

所述可编程增益放大模块在所述功率控制单元的强度控制信号的控制下,对所述高阶低通滤波模块输出的平滑后的激励信号进行放大。

进一步地,所述直接数字频率合成(DDS)模块为具有28位频率调节字的AD9833;所述频率调节字由频率控制信号控制;

所述高阶低通滤波模块为两个由低噪声放大器OPA2189搭建的多重反馈滤波器串联组成的四阶有源低通滤波模块;

所述可编程增益放大模块为由低噪声放大器OPA189和数控电位计AD5293组成的同相比例放大电路;

所述数控电位计以串联形式接入放大电路反馈回路中,在所述功率控制信号的控制下,对数控电位计的1024个档位进行调节,实现对平滑后的激励信号连续增益放大调节。

进一步地,所述驱动通道切换电路为基于HEF4051B的一路输入-三路输出切换电路;在所述控制单元输出的通道切换控制信号控制下进行通道切换。

进一步地,所述驱动电流监测电路包括高精度电流采样模块、采样调理模块和高精度模数转换(ADC)模块;

所述高精度电流采样模块对对应的发射线圈中的激励电流进行采样,输出增益为1mV/1mA的采样电压信号;

所述采样调理模块对所述高精度电流采样模块输出的采样电压信号进行放大处理,输出放大后的采样电压;

所述高精度模数转换(ADC)模块将所述放大后采样电压进行模拟/数字转换,并将数字转换结果输出至所述控制单元。

进一步地,所述高精度电流采样模块为表面贴装电流传感芯片电阻VCS1625ZP,电阻阻值为1Ω,电阻容差为±1‰,温度系数为±0.05ppm/℃;

所述采样调理模块为由差分放大器LT6376组成的放大电路和低噪声放大器OPA189组成的放大电路串联组成的比例放大电路,其中差分放大器LT6376组成的放大电路增益为10,低噪声放大器OPA189组成的放大电路增益为1.5;

所述高精度模数转换(ADC)模块为具有110.8KHz带宽的24位ADC的AD7768-4。

进一步地,所述磁场发生器校验单元包含单轴磁场感应线圈、磁场感应信号调理电路和磁场感应信号采集电路;

所述单轴磁场感应线圈包括线圈骨架和感应线圈;所述线圈骨架采用玻璃包裹非晶丝制成;所述感应线圈采用密绕方式固定缠绕在线圈骨架外表面上。

进一步地,所述非晶丝骨架长度为6mm;所述感应线圈采用直径0.02mm的自粘性漆包线,所述绕制感应线圈长度不超过5mm;

所述磁场反应信号调理电路为由仪表放大器AD8429组成的放大电路和低噪声放大器OPA2189搭建的多重反馈滤波器串联组成的四阶有源低通滤波模块电路串联组成,其中差分放大器LT6376组成的放大电路增益为600,高阶低通滤波模块截止频率设置为15KHz;

所述高精度模数转换(ADC)模块将所述磁场反应信号调理电路输出的放大后采样信号进行模拟/数字转换,并将数字转换结果输出至控制单元。

本发明至少可实现以下有益效果之一:

本发明的基于交变磁场的姿态识别系统,解决了传统的三轴磁场发生器成本高、效率低的问题,所产生的磁场频率和强度准确、稳定;可满足姿态识别数据输出率的要求,实现快速姿态识别。

在三轴磁场发生器中采用直接数字频率合成(DDS)模块产生固定频率信号,然后由高阶低通滤波模块滤除信号源中谐波成分。激励信号频率编程可调,可实现信号频率的准确、连续地调节;基于驱动电流监测电路的反馈回路,对三轴交变磁场发生器的磁场强度进行自适应调整。使三轴交变磁场发生器产生的磁场强度保持稳定,由此提到姿态识别精度,采用基于磁场感应电路的校验电路,对三轴交变磁场发生器的磁场频率、磁场稳定时间进行标校,使三轴交变磁场发生器产生的磁场频率稳定,分时时间内产生磁场稳定度符合实际应用需求。

附图说明

附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。

图1为本实施例中的姿态识别系统磁场产生和校验部分的组成连接示意图;

图2本实施例中的三轴正交磁场发射天线的结构示意图;

图3本实施例中的驱动信号发生电路机构框图;

图4本实施例中的驱动电流监测电路机构框图;

图5本实施例中的磁场校验单元机构框图;

图6本实施例中的单轴磁场感应线圈的结构示意图。

具体实施方式

下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理。

本实施例公开了一种基于交变磁场的姿态识别系统,如图1所示,包括三轴交变磁场发生器、控制单元和磁场校验单元;

所述三轴交变磁场发生器与控制单元连接,在控制单元的控制下,产生时分复用的、三轴正交的局部交变磁场;并将监测的每个轴的磁场驱动电流反馈输出到控制单元;

所述控制单元,根据内设的包括磁场频率控制参数、磁场强度控制参数、磁场时序控制参数在内的参数,输出局部交变磁场的频率、强度以及通道切换控制信号到三轴交变磁场发生器;并根据所述磁场驱动电流反馈进行局部交变磁场的强度调节;

所述磁场校验单元,用于校验所述局部交变磁场;在校验时,所述磁场校验单元置于预设校验区域,对所述局部交变磁场进行接收、放大、滤波和采样后,将采样信号输出到控制单元,校验所述控制单元中内设的包括磁场频率控制参数、磁场强度控制参数、磁场时序控制参数在内的参数。

具体的,所述三轴交变磁场发生器包括三轴正交磁场发射天线、功率驱动电路组、驱动信号切换电路、驱动信号发生电路和驱动电流监测电路组;

所述三轴正交磁场发射天线包括三组发射线圈Tx、Ty和Tz,所述功率驱动电路组包括分别与三组发射线圈连接的功率驱动电路a、功率驱动电路b和功率驱动电路c;所述功率驱动电路组中的三个功率驱动电路通过驱动通道切换电路与驱动信号发生电路连接;

所述驱动信号发生电路与所述控制单元连接,在控制单元输出的频率、强度控制信号的控制下,产生对应频率和强度的磁场激励信号输出到驱动通道切换电路;

所述驱动通道切换电路在控制单元输出的通道切换控制信号的控制下,将所述驱动信号发生电路产生的磁场激励信号分时、依次切换到对应的功率驱动电路中进行功率放大输出激励电压;每个发射线圈在对应的激励电压的激励下,产生偶极子磁场;三个发射线圈产生的磁场依次作用在空间中,构成时变局部交变磁场。

所述驱动电流监测电路组包括三个驱动电流监测电路分别连接在对应的功率驱动电路与发射线圈连接的支路上,对每个发射线圈内驱动电流进行采样和调理后,输出到控制单元。

更具体的,如图2所示,所述三轴正交磁场发射天线包括线圈骨架和三组发射线圈Tx、Ty和Tz;

所述线圈骨架的结构满足能够使三个发射线圈Tx、Ty、Tz两两正交同心的固定缠绕在线圈骨架外表面上;

所述线圈骨架采用耐高温非金属材料制成,所述非金属材料为聚醚醚酮为基础的复合材料,所述非金属材料的耐高温值不低于300℃;采用用以聚醚醚酮为基础的复合材料,骨架材料易于获取并降低工艺制造要求。

所述发射线圈由铜质漆包线绕制,所述正交磁场发射天线组的每个发射线圈与各自串联谐振电容网络组成串联谐振回路;

特殊的,所述三轴正交磁场发射天线的线圈骨架结构尺寸、发射线圈线径和绕制匝数是根据所需要产生的磁场强度,依据毕奥-沙伐尔定律计算得出。

本实施例中,线圈骨架外廓结构尺寸为32mm×32mm×32mm的正方体,漆包线线径选择为0.17mm;所述正方体的外表面上开有固定三个发射线圈的线槽,线槽的深度以三个发射线圈缠绕后,三轴正交磁场发射天线的外表平整为准。

所述串联谐振电容网络由若干电容值为pF至nF级别,耐压能力为600V以上的COG等级陶瓷电容器并联组成,与发射线圈组成的串联谐振回路;

所述串联谐振电容网络的电容值:

其中,f为谐振频率;L为谐振频率条件下,发射天线线圈电感量。

如图3所示,所述驱动信号发生电路包括直接数字频率合成(DDS)模块、高阶低通滤波模块、可编程增益放大模块;

所述直接数字频率合成(DDS)模块在所述功率控制单元的频率控制信号的控制下,输出设定频率的激励信号到高阶低通滤波模块;

更具体的,所述直接数字频率合成(DDS)模块为具有28位频率调节字的AD9833;所述频率调节字由频率控制信号控制;在本实施例中,在频率控制信号的控制下,直接数字频率合成(DDS)模块输出频率为5kHz的激励信号到高阶低通滤波模块;

所述高阶低通滤波模块滤除所述直接数字频率合成(DDS)模块产生的激励信号中的高次谐波,输出平滑后的激励信号;

更具体的,所述高阶低通滤波模块为两个由低噪声放大器OPA2189搭建的多重反馈滤波器串联组成的四阶有源低通滤波模块;,高阶低通滤波模块截止频率设置为15KHz;

所述可编程增益放大模块在所述功率控制单元的强度控制信号的控制下,对所述高阶低通滤波模块输出的平滑后的激励信号进行放大;

更具体的,所述可编程增益放大模块为由低噪声放大器OPA189和数控电位计AD5293组成的同相比例放大电路;

所述数控电位计以串联形式接入放大电路反馈回路中,在所述功率控制信号的控制下,对数控电位计的1024个档位进行调节,实现对平滑后的激励信号连续增益放大调节。

采用直接数字频率合成(DDS)模块产生固定频率信号,然后由高阶低通滤波模块滤除信号源中谐波成分。激励信号频率编程可调,可实现信号频率的准确、连续地调节。

具体的,所述功率驱动电路组包括三路功率驱动电路,所述功率驱动电路为由D类功率放大器TPA3126D2组成的固定增益功率驱动电路,D类功率放大器TPA3126D2组成的功率驱动电路固定增益为20dB。

在发射线圈所处交流回路中采用D类功率放大器进行驱动,D类功率放大器输出正弦脉宽调制电压激励电压驱动发射线圈,在发射线圈驱动电流确定要求下,降低了电源功率要求,优化了效率。

具体的,所述驱动通道切换电路为基于HEF4051B的一路输入-三路输出切换电路;在所述控制单元输出的通道切换控制信号控制下进行通道切换,控制三个发射线圈分时激励,在空间形成局部交变磁场。

具体的,如图4所示,所述驱动电流监测电路包括高精度电流采样模块、采样调理模块和高精度模数转换(ADC)模块;

所述高精度电流采样模块对对应的发射线圈中的激励电流进行采样,输出增益为1mV/1mA的采样电压信号;

更具体的,所述高精度电流采样模块为具有极高精度表面贴装电流传感芯片电阻VCS1625ZP,电阻阻值为1Ω,电阻容差为±1‰,温度系数为±0.05ppm/℃;

所述采样调理模块对所述高精度电流采样模块输出的采样电压信号进行放大处理,输出放大后的采样电压;

更具体的,所述采样调理模块为由差分放大器LT6376组成的放大电路和低噪声放大器OPA189组成的放大电路串联组成的比例放大电路,其中差分放大器LT6376组成的放大电路增益为10,低噪声放大器OPA189组成的放大电路增益为1.5;

所述高精度模数转换(ADC)模块将所述放大后采样电压进行模拟/数字转换,并将数字转换结果输出至所述控制单元;

更具体的,所述高精度模数转换(ADC)模块为具有110.8KHz带宽的24位ADC的AD7768-4,在所述控制单元输出的监测读取信号的控制下,将数字转换结果输出至所述控制单元。

基于驱动电流监测电路的反馈回路,对三轴交变磁场发生器的磁场强度进行自适应调整。使三轴交变磁场发生器产生的磁场强度保持稳定,由此提到姿态识别精度。

具体的,本实施例的所述功率控制单元内置控制程序中,内设有包括磁场频率控制参数、磁场强度控制参数、磁场时序控制参数在内的参数,在进行局部交变磁场产生控制时,通过频率、强度控制信号,将磁场频率控制参数、磁场强度控制参数注入驱动信号发生电路的直接数字频率合成(DDS)模块和可编程增益放大模块,使接数字频率合成(DDS)模块输出符合磁场频率控制参数的激励信号,使可编程增益放大模块的增益放大调节符合磁场强度控制参数的要求,同时,所述功率控制单元还接收所述驱动电流监测电路反馈的各发射线圈的电流强度,判断各发射线圈的磁场强度是否满足控制要求,如强度不满足,则通过调节强度控制信号中的磁场强度控制参数调节可编程增益放大模块的增益放大量,使磁场强度满足要求。

具体的,在本实施例的姿态识别系统出厂或维修后,以及其他需要对局部交变磁场进行定标时,采用所述磁场校验单元对所述局部交变磁场进行校验,在进行校验时,将所述磁场校验单元置于预设校验区域。

所述预设校验区域为以三轴正交磁场发射天线为圆心,以垂直三轴正交磁场发射天线放置平面向上为正方向,半径在20cm至40cm的正半球区域内。

如图5所示,所述磁场发生器校验单元包含单轴磁场感应线圈、磁场感应信号调理电路和磁场感应信号采集电路;

具体的,如图6所示,所述单轴磁场感应线圈包括线圈骨架和感应线圈;所述线圈骨架采用玻璃包裹非晶丝制成;所述感应线圈的采用密绕方式固定缠绕在线圈骨架外表面上。

感应线圈采用密绕方式固定,提高了单轴磁场感应线圈测量灵敏度,在单轴磁场感应线圈位置确定要求下,提升空间内单点磁场测量准确性。

更具体的,所述非晶丝骨架长度为6mm;所述感应线圈采用直径0.02mm的自粘性漆包线,所述绕制感应线圈长度不超过5mm。

所述磁场反应信号调理电路为由仪表放大器AD8429组成的放大电路和低噪声放大器OPA2189搭建的多重反馈滤波器串联组成的四阶有源低通滤波模块电路串联组成,其中差分放大器LT6376组成的放大电路增益为600,高阶低通滤波模块截止频率设置为15KHz;

所述高精度模数转换(ADC)模块将所述磁场反应信号调理电路输出的放大后采样信号进行模拟/数字转换,在所述控制单元输出的标校读取信号的控制下,将数字转换结果输出至控制单元。

控制单元,分别获取三轴正交磁场发射天线中发射天线线圈产生磁场信号测量结果,测量结果作为调整磁场频率功率控制单元中程序存储参数依据,以校验所述控制单元中内设的包括磁场频率控制参数、磁场强度控制参数、磁场时序控制参数在内的参数。

基于磁场感应电路的校验电路,对三轴交变磁场发生器的磁场频率、磁场稳定时间进行标校。使三轴交变磁场发生器产生的磁场频率稳定,分时时间内产生磁场稳定度符合实际应用需求。

以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。

13页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种摇臂重力平衡机构

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!

技术分类