PNI

PNI

PNI电子罗盘 TCM3与TCM XB的区别

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 500 次浏览 • 2021-07-22 18:38 • 来自相关话题

11096 PNI公司最早地磁传感器专用芯片停产。

回复

匿名用户 发起了问题 • 1 人关注 • 0 个回复 • 444 次浏览 • 2021-07-20 19:29 • 来自相关话题

3D MagIC(12927) 与 11096 区别比较

回复

laoguo 回复了问题 • 1 人关注 • 2 个回复 • 817 次浏览 • 2021-07-20 19:27 • 来自相关话题

IMU、AHRS和VRU的区别

回复

laoguo 发起了问题 • 1 人关注 • 0 个回复 • 483 次浏览 • 2021-07-18 21:44 • 来自相关话题

DR是什么?

回复

匿名用户 发起了问题 • 1 人关注 • 0 个回复 • 419 次浏览 • 2021-07-18 18:41 • 来自相关话题

QMC7983 QST的这款参数实际如何?

回复

匿名用户 发起了问题 • 1 人关注 • 0 个回复 • 472 次浏览 • 2021-07-16 12:19 • 来自相关话题

HMC1053使用效果如何?

回复

匿名用户 发起了问题 • 1 人关注 • 0 个回复 • 428 次浏览 • 2021-07-16 12:16 • 来自相关话题

基于IMU和地磁传感器的捷联惯性导航系统(2)

laoguo 发表了文章 • 1 个评论 • 492 次浏览 • 2021-07-16 12:11 • 来自相关话题

上节内容:http://www.ganwen.net.cn/?/article/30

基于MSE的传感器融合

在上一节中,观测变量是

基于IMU和地磁传感器的捷联惯性导航系统

其中没有来自罗盘的信息。由于ω是角速率,我们只能使用四 元数来导入罗盘数据q. 我们使用MSE方法获得q, 即观测变量 中的组分。

我们将各变量定义如下:

mb和ab: 体坐标系里的罗盘磁值和加速度值。

mn和an: 导航坐标系里的罗盘磁值和加速度值。

mn0和an0: 导航坐标系里的初始静态罗盘磁值和加速度值。

基于IMU和地磁传感器的捷联惯性导航系统

为从体坐标系到导航坐标系的姿态转换矩阵,用四元数表示,可以写成

基于IMU和地磁传感器的捷联惯性导航系统

其给出了导航坐标系中初始值与实时从体坐标系映射到导航坐标系的值之间的误差ε。

根据之前的定义,MSE方法可用于求取最优值。

基于IMU和地磁传感器的捷联惯性导航系统

通过求方程8的最小值:

基于IMU和地磁传感器的捷联惯性导航系统

对f(q)求导并使其等于零,

基于IMU和地磁传感器的捷联惯性导航系统

我们将获得方差意义上的最优q。我们使用高斯-牛顿方法,用一阶梯度收敛来求解以上非线性方程。

通过组合角速率,我们将得到观测变量

基于IMU和地磁传感器的捷联惯性导航系统

其中融合了卡尔曼滤波器中的罗盘数据和IMU数据。

该过程可以简单地描述为图5中的框图。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图5. 使用MSE方法的传感器融合框图。

松耦合

如前所述,我们经常遇到无法使用罗盘传感器的情况。如果磁数据受到干扰,则求解的姿态精度将比仅使用IMU时更差。因此,我们使用松耦合来判断磁传感器是否可用。当磁传感器不可用时,我们只用IMU来求解姿态;当磁传感器可用时,我们将使用融合算法找到姿态,如图6所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图6. 姿态计算流程图。

在获得新数据之后或者在求解新的姿态时(在某些系统中,采样周期与姿态解算周期不同,但我们在此处进行的是单采样周期解算),我们计算加速度的大小,如果结果不等于1g, 我们 就不会使用加速器的输出进行姿态计算。然后我们计算罗盘输出的大小并将其与初始值进行比较。如果它们彼此不相等,我们就不会在此周期中使用地磁传感器的数据。当满足两个条件时,我们会使用卡尔曼滤波器并执行MSE融合。

使用ADIS16470进行航位推算(DR)

在导航中,航位推算是计算当前位置的过程,先使用先前确定的位置,然后在解算周期中基于已知或估计的速度或加速度更新该位置。这里将使用ADIS16470里的加速度计。基于上一节解出的姿态,我们可以得到捷联系统的移动方向,然后需要计算该方向上的距离,最后确定位置。

捷联航位推算需要使用基于加速度测量的比力方程来跟踪INS的位置。比力方程可以简单描述为等式10、等式11和等式12:

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

其中ae是地球坐标系里的加速度,ab 是体坐标系里的加速度,ve是地球坐标系里的速度,se是地球坐标系里的距离,ge 是 地球坐标系里的重力加速为[0 0 1],单位为 g。需要强调的是,地球坐标系与导航坐标系不同——地球坐标系是基于NED的。该 δtt是解算周期。

用第一个等式可以得到从IMU体坐标系到地球坐标系的加速度映射,如格式

基于IMU和地磁传感器的捷联惯性导航系统

第二个等式将加速度积分或累加为速度;然而,由于测量的加速度包含了重力分量,所以需要减去重力。

与等式11类似,等式12将速度积分成距离。

传统方法存在几个问题。

● 加速度计输出总是有偏置,与重力相结合后,难以从公式10中减去,因此更准确的表达式应为:

基于IMU和地磁传感器的捷联惯性导航系统

除非是用一些专业设备来测量该偏置,例如分度头。

● 基于数值积分的实现方式,通常使用零阶保持器方法(前一个值)进行积分。但是,对于连续移动,这将带来重大的误差。例如,我们来比较以下方法:

方法1:

(零阶保持器)

方法2:

基于IMU和地磁传感器的捷联惯性导航系统

(线性插值)

在5秒内加速度为为0.5 m/s2时,位移最高将相差4m。仿真结果如图7所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图7. 速度计算中的零阶保持与一阶积分方法比较。

基于前面的讨论,基于应用,我们修改了传统比例方程中的两个地方:

X 我们不使用地球坐标作为导航坐标系。相反,正如我们在计算先前姿态时所做的那样,我们用初始姿态

基于IMU和地磁传感器的捷联惯性导航系统

作为导航坐标系。通过这种方式,偏置和重力都可以轻松取消,如公式14所示:

基于IMU和地磁传感器的捷联惯性导航系统

虽然姿态中同时包含了偏置和重力分量,但这样我们就不需要将它们分开成单独的分量,而是直接一起减去它们。

基于零阶保持器与一阶插值之间的比较,我们使用一阶方法来获得更准确的积分结果。

运动学模式和零速更新技术(ZUPT)

通过使用IMU的初始值作为导航坐标系,我们可以消除一部分加速度的偏置影响。然而,即使我们在使用设备之前能用分度头准确测量偏置,仍然很难取消,除非使用另一个精确的传感器来定期校准它。这主要是由两个原因引起的:一是偏置不稳定,这意味着我们之前测量的偏置不是现在的实际偏置。二是速度随机游走,由加速度噪声积分而来。前面提到的不良特性会使我们计算的距离显著漂移。即使我们停止移动并保持静止,从加速度积分而来的速度仍然存在,距离仍会增加。

要解决这个问题,我们需要找到一种通过使用ZUPT技术重置速度的方法。ZUPT技术与具体的应用密切相关,因此我们需要获得系统和应用的运动学特征,然后给出一些算法规则。我们发现的运动学模式越多,结果就越准确。

我们通过移动带有SINS系统的转椅来进行实验。由于我们的研究不限于特定应用,我们使用以下运动学假设:

● 对于航位推算,导航坐标系中没有z轴移动。此限制仅适用于航位推算,不适用于姿态求解。显然,我们是在二维空间中移动系统。这有助于消除z轴误差。

● 所有转弯都发生在停止后。如果在移动时发生转弯,则会因为引入额外加速而干扰姿态求解。

● 如果系统正在移动,加速度不能保持不变超过500毫秒。速度不能保持不变超过2秒。由于我们在推动或拉动转椅,因此很难手动使力精确地保持不变超过500毫秒,并且个人很难以匀速持续推动转椅2秒以上。事实上,我们正是运用这一规则来实施ZUPT。

● 加速度不能大于±1 m/s2。该规则用于一些噪音过滤,后者基于我们施加于椅子上、不会很大的拉力或推力。

如图8所示,当系统在X方向上移动时(投影到导航坐标系后),Y方向也会产生加速度;积分后,Y方向速度不会为零,这意味着即使我们只是在X方向上移动,航位推算系统仍然会给我们带来Y分量。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图8. 导航坐标系中三个方向的加速度。

基于第三条运动学假设,我们可以使用ZUPT来消除此误差。经ZUPT处理之后的积分速度如图9所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图9. 导航坐标系中三个方向的速度。

虽然我们使用了第三条假设,如前所示,误差仍然无法完全取消。误差消除取决于设定的零加速度和零速度的判断阈值。但是,大多数误差已得到修正。

虽然使用了ZUPT,但有时仍然无法达到零速。这由两个因素导致:

● 我们无法用ZUPT完全消除偏置不稳定误差和速度随机游走。

● 我们求出的姿态有一些误差,结果将导致投影(从体坐标系到导航坐标系)后的加速度误差。

以图10为例。图10中的左图是ADIS16470的原始数据(体坐标系),图10中的右图是投影到导航坐标系的加速度。可以看出,停止移动时,投影加速度不为零。由于它总是在变化,我们此处称之为基线漂移。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图10. 体坐标系(左)和导航坐标系(右)的加速度。

为了消除基线漂移,我们需要实时连续获得偏移偏置并从投影加速度中减去该值。结果如图11所示

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

Figure图11. 基线漂移消除之前(上)和之后(下)的加速度。

上图是基线漂移消除前的加速度,下图中的绿色轨迹是我们计算的基线偏移,红色轨迹是基线偏移消除后的加速度。

可以使用图12中的框图简要描述航位推算过程。我们将体坐标系加速度ab和姿态转移矩阵(来自AHRS)输入

基于IMU和地磁传感器的捷联惯性导航系统

到DR系统。完成后,我们将获得导航坐标系中的位置。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图12. 航位推算流程图

实验结果与结论

实验结果

使用SPI端口,我们将ADIS16470评估板和RM3100罗盘评估板连接到ADI公司的ADuCM4050电路板,构建出我们的系统,如图13所示。ADuCM4050 调整数据格式并进行时间同步(因为IMU和罗盘的数据速率不同)。然后使用UART将捕获的数据传输到计算机。所有计算(包括校准、AHRS和DR在MATLAB)均在MATLAB®中执行。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图13. 实验平台设置。

将评估板和计算机放在转椅上,并在实验室中推着转椅绕圈。

● AHRS输出:姿态以四元数格式和DCM格式表示,如图14所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图14. 四元数格式(左)和DCM格式(右)的姿态。

● DR输出:带XYZ位置的航位推算结果和三维图如图15所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图15. 位置计算结果。

结论

本文介绍了使用ADI公司的IMU ADIS16470和地磁传感器RM3100构建捷联惯导系统的基本过程,介绍了我们使用的校准、AHRS和DR方法。在平台和实验环境等条件有限的情况下,很难进一步测试平台和算法。

有很多方法可用于改善结果,例如:

● 使用里程表或UWB距离测量方法与IMU中的加速度计融合,以在DR中获得更准确的距离值。

● 使用更复杂的运动学模型,从而在AHRS和DR中在传感器和系统层次引入更多特性,例如系统的振动、加速和减速模型、地面平整度等。这意味着为了提高导航结果的准确性,需要给出更多的边界条件。

● X 使用更精确的数值计算方法,比如用辛普森规则或三次样条插值在DR中进行积分,或者使用牛顿方法而非高斯-牛顿方法求解非线性MSE方程等。

最后但也是最重要的一点,我们在试验中发现INS与应用或运动学模型紧密相关。例如,我们在两个地方进行了实验:未铺地毯的实验室和铺有地毯的办公室。如果我们使用相同的参数集,DR结果会显示出巨大的差异。因此,无论哪种应用,例如患者跟踪、AGV导航或停车定位,或者对于同一应用中的不同条 件,我们都需要全面了解其运动学模型。


基于IMU和地磁传感器的捷联惯性导航系统(1)

laoguo 发表了文章 • 0 个评论 • 634 次浏览 • 2021-07-16 11:05 • 来自相关话题

简介

随着服务机器人市场和技术的发展,导航已成为研究和应用中的一个热点。与车辆、船舶或飞机相比,服务机器人体积小,成本低,因此它们的导航系统应该具有捷联和低成本的特点。传统的稳定平台导航系统通常要采用独立的加速度计和光纤或激光陀螺仪,所有传感器都机械且刚性地安装在与正在移动的车辆隔离的稳定平台上。这导致了尺寸大、可靠性差、成本高的缺点。相反,在捷联惯导系统中,惯性传感器直接固定在车辆本体上,这意味着传感器会与车辆一起旋转。这种捷联方法消除了稳定平台惯导的缺点。然而,平台惯导的准确性通常高于SINS。平台惯导往往可以达到战略级(0.0001°/时的陀螺仪偏置,1μg的加速器偏置)或军用级(0.005°/时的陀螺仪偏置,30μg的加速器偏置),而多数SINS只能到达导航级(0.01°/时的陀螺仪偏置,50μg的加速器偏置)或战术级(10°/时的陀螺仪偏置,1mg的加速器偏置)。对于大多数服务机器人或AGV导航应用,这一精度足够了。

导航方法很多,包括机器视觉、GPS、UWB、SLAM型激光雷达等。基于IMU的惯性导航始终是导航的重要组成部分。然而,由于这种传感器的限制——例如偏置误差、轴间误差、噪声,特别是零偏不稳定性——惯性导航通常需要采用一个伙伴传感器,定期为它提供参考或校准,本文将这种情况称为传感器融合。许多传感器都可以与IMU融合,例如摄像头和里程表,但在这些传感器中,地磁传感器是一种低成本的方案,可与IMU配合获得姿态信息。

在本文中,我们使用ADI的IMU ADIS16470和地磁传感器来开发平台和算法,实现捷联惯性导航系统。但是,地磁传感器只能提供姿态信息。对于航位推算或距离测量,我们只能使用IMU中的 加速度传感器。

ADIS16470 IMU简介

ADI公司的ADIS16470是一款微型MEMS IMU,集成了3轴陀螺仪和3轴加速度计。其陀螺仪零偏稳定性为8°/时,加速计零偏稳定性为13μg 其关键参数都经过出厂校准。此外,ADIS16470的 低价格在同级产品中具有吸引力,得到了许多客户的广泛使用。在本文中,我们使用微控制器与ADIS16470通过SPI接口进行通信。

地磁传感器介绍

地磁传感器是用于测量罗盘体坐标(即坐标系)中的地磁场的传感器,可为航向提供绝对参考。其x、y和z分量值由本地地磁场投影而来。这种传感器有两个主要缺点——一是精度和分辨 率不高——例如,常用的霍尼韦尔罗盘传感器HMC5883L的分辨率仅为12位。另一个缺点是传感器容易受到周围环境的干扰,因为地磁场非常弱,强度范围为毫高斯到8高斯。

尽管有这些缺点,仍然可以在许多情况下使用,例如户外、低EMI环境等。将地磁传感器与IMU进行松耦合,就可以在大多数环境中使用这类传感器。

在本文中,我们使用PNI传感器公司的高性能电子罗盘传感器RM3100,它提供了24位分辨率。PNI使用主动激励法来提高抗噪声能力。

罗盘传感器的校准

在使用罗盘传感器之前,需要对其进行校准以消除两个主要误差。一个是失调误差,这原本是由传感器和电路的失调误差引起的。另一个是标度误差。这两种误差都容易受到周围磁环境的干扰。例如,如果有一个x轴向的外部磁场施加到传感器上,就会给出外部x轴失调误差。同时,x轴标度也将与y轴和z轴不同。

通常用于校准磁传感器的方法是在xy平面上转动传感器绕圈,然后抽取数据。一个地点的地磁场强度是一个常数值,因此绘制的数据应该是一个圆;然而,事实上,我们将看到一个椭圆形,这意味着我们需要移动椭圆并重新缩放到以零为中心的圆。

上述2D校准方法有一些缺点,并且需要用加速器来测量其倾斜度。我们使用3D球面拟合方法来校准罗盘传感器。首先,我们需要将传感器旋转到x-y-z空间中的每个方向,并在3D坐标中绘制其值。然后我们需要使用最小平方误差(MSE)方法将数据拟合为椭球面。

椭球方程可以表示为

Equation 1

其中,X、Y和Z是罗盘输出在三个方向上的地磁分量。将这些值拟合为椭球面意味着,我们需要得到一组最优系数解。我们将系数定义为:

Text Equation 1

在拟合时,我们定义向量:

Text Equation 2

所以我们需要计算最优σ,并使用公式2来找出最小值:

Equation 2

这样我们就可以得到图1所示的拟合结果。

234033-fig-01


图1. 原始罗盘数据分布(左)和使用椭球拟合后的罗盘数据(右)。

为了校准传感器,我们需要拉伸或压缩拟合的椭球面并将其移至以零为中心的球面上。我们使用矩阵奇异值分解(SVD)方法来进行这种校准。校准后的球体如图2所示。1,2

234033-fig-02


图2. 用SVD方法进行球体校准后的罗盘数据。

校准后,我们可以看到,测得的磁场强度(球半径)几乎恒定不变,如图3所示。

234033-fig-03


图3. 校准前和校准后的磁场比较。

使用ADIS16470和罗盘的姿态和航向参考系统

AHRS由三个轴上的传感器组成,提供姿态信息,包括横滚角、俯仰角和偏航角。AHRS是一个来自飞机导航的概念。我们用它来描述方向,即姿态。

在介绍我们的方法之前,有必要首先解释为什么确定姿态需要进行融合。事实上,我们的系统现在有三种传感器:陀螺仪、加速器和罗盘(地磁传感器)。

陀螺仪提供围绕各轴的旋转角速度。通过角速率积分计算,我们可以得到旋转角度。如果我们知道初始航向,通过角度就始终能够得到航向姿态。积分将累积陀螺仪的不稳定零偏,这将导致角度误差。此外,来自陀螺仪的高斯分布噪声将积分成一个布朗运动过程,并导致随机游走误差。因此,我们很难长时 间使用陀螺仪,陀螺仪需要定期校准。

加速度计提供每个轴方向的移动加速度。在静态状态下,我们可以得到每个轴与重力加速度之间的角度。由于重力加速度在方向和值上恒定不变,我们可以获得相对于重力方向的航向姿态。然而,该方法使用重力加速度作为参考,因此不能解出围绕重力加速度旋转的角度。

罗盘提供从地磁场投影的每个轴的值。我们可以从每个轴与恒为常数向量的地磁场方向之间的关系推导出角度值。如前一节所述,由于对外部磁场的抗扰性较差,罗盘需要一个低干扰的环境。

从这一解释中,我们可以看到,很难靠一个传感器来找到姿态,我们需要组合使用两个或三个传感器并把信息融合起来。本文用加速度计、陀螺仪和地磁罗盘查找姿态。这种融合也被称为磁、角速率和重力(MARG)系统。

扩展卡尔曼滤波器的设计与传感器融合

有多种方法可以将IMU和罗盘数据融合起来,例如互补滤波器、统计学ARMA滤波器,卡尔曼滤波器等。我们在本文中使用的是扩展卡尔曼滤波器。

首先,我们需要介绍本文中使用的一些定义。

坐标定义

T航向或方向是两个坐标(即坐标系)之间的关系。一个坐标总在变化,另一个坐标保持不变。对于坐标定义方法,我们使用导航坐标和体坐标。与东北地(NED)坐标系或地理方法相反,我们将测量的初始体坐标值定义为导航坐标系,此后该坐标为恒定坐标。从体坐标到导航坐标的映射(投影)矩阵定义为

Text Equation 3

姿态定义

与欧拉角或方向余弦矩阵(DCM)不同,我们在这里使用四元数,定义为

Text Equation 4

常用于导航以避免奇异性。

用卡尔曼滤波器更新姿态

我们在本文中使用的运动学方程(即状态转移方程)是非线性微分方程,因此需要使用一个EKF,用于对该微分方程进行一阶近似。对于EKF设计,我们定义

Text Equation 5

一个1×7向量作为状态变量,其中

Text Equation 6

为角速率;

Text Equation 7

为姿态四元数。

Text Equation 8

一个1×7向量作为观测变量,与状态变量具有相同的分量。

Text Equation 9

一个7×7矩阵作为状态转移矩阵,其中,A的第一部分是角速率的数字化微分方程,第二部分是数字化四元数更新方程,后者从运动学方程推导而来。

Text Equation 10

一个7×7矩阵作为观察矩阵。

Text Equation 11

为误差协方差矩阵,这是一个7×7矩阵,其中e估计向量 真实值xx之间的误差我们在测试中将初始误差设为相对较小的值。该值会自动收敛到一个小值。

R,Q被设为状态转移噪声和观测噪声的协方差矩阵。我们得到它们的初始值,

R0和Q0在保持IMU和罗盘处于静止状态的同时,通过测量陀螺仪和加速器的交流均方根值的平方得到。我们设

R0 = Q0

根据以上定义,卡尔曼滤波器将通过以下五个步骤完成:

步骤1:使用公式3计算卡尔曼增益K

Equation 3

步骤2:计算误差协方差矩阵,P:

Equation 4

步骤3:输出估算状态:

Equation 5

步骤4:更新状态:

Equation 6

步骤5:更新误差协方差矩阵P:

Equation 7

该过程可以简单地描述为图4中的框图。

234033-fig-04


图4. 用于更新姿态的卡尔曼滤波器流程图。


篇幅有限,可下载PDF原文阅读 

基于IMU和地磁传感器的捷联惯性导航系统_cn.pdf


Honeywell地磁传感器有哪些?

回复

laoguo 回复了问题 • 1 人关注 • 2 个回复 • 456 次浏览 • 2021-07-14 23:56 • 来自相关话题

磁场单位T,mT,Guass,kA/m的关系?

回复

laoguo 回复了问题 • 1 人关注 • 3 个回复 • 11837 次浏览 • 2021-07-14 19:38 • 来自相关话题

利用什么传感器测量地球磁场?原理是什么?

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 419 次浏览 • 2021-07-02 11:29 • 来自相关话题

TMR磁传感器简介

laoguo 发表了文章 • 0 个评论 • 432 次浏览 • 2021-06-30 15:23 • 来自相关话题

磁传感器广泛用于现代工业和电子产品中以感应磁场强度来测量电流、位置、方向等物理参数。在现有技术中,有许多不同类型的传感器用于测量磁场和其他参数,例如采用霍尔(Hall)元件,各向异性磁电阻(Anisotropic Magnetoresistance, AMR)元件或巨磁电阻(Giant Magnetoresistance, GMR)元件为敏感元件的磁传感器。

  以霍尔元件为敏感元件的磁传感器通常使用聚磁环结构来放大磁场,提高霍尔输出灵敏度,从而增加了传感器的体积和重量,同时霍尔元件具有功耗大,线性度差的缺陷。AMR元件虽然其灵敏度比霍尔元件高很多,但是其线性范围窄,同时以AMR为敏感元件的磁传感器需要设置Set/Reset线圈对其进行预设/复位操作,造成其制造工艺的复杂,线圈结构的设置在增加尺寸的同时也增加了功耗。以GMR元件为敏感元件的磁传感器较之霍尔电流传感器有更高的灵敏度,但是其线性范围偏低。

  TMR(Tunnel MagnetoResistance)元件是近年来开始工业应用的新型磁电阻效应传感器,其利用的是磁性多层膜材料的隧道磁电阻效应对磁场进行感应,比之前所发现并实际应用的AMR元件和GMR元件具有更大的电阻变化率。我们通常也用磁隧道结(Magnetic Tunnel Junction,MTJ)来代指TMR元件,MTJ元件相对于霍尔元件具有更好的温度稳定性,更高的灵敏度,更低的功耗,更好的线性度,不需要额外的聚磁环结构;相对于AMR元件具有更好的温度稳定性,更高的灵敏度,更宽的线性范围,不需要额外的set/reset线圈结构;相对于GMR元件具有更好的温度稳定性,更高的灵敏度,更低的功耗,更宽的线性范围。下图是四代磁传感技术原理图。

 c磁传感器技术发展历程

  下表是霍尔元件、AMR元件、GMR元件以及TMR元件的技术参数对比,可以更清楚直观的看到各种技术的优劣。

技术

功耗(mA)

尺寸  (mm)

灵敏度

(mV/V/Oe)

工作范围

(Oe)

分辨率

(mOe

温度特性

(℃)

Hall

5~20

1×1

0.05

1~1000

500

<150

AMR

1~10

1×1

1

0.001~10

0.1

<150

GMR

1~10

2×2

3

0.1~30

2

<150

TMR

0.001~0.01

0.5×0.5

20

0.001~200

0.1

<200

  auto_1426

  右图是一个MTJ元件的结构原理图。MTJ元件由钉扎层(Pinning Layer)、隧道势垒层(Tunnel Barrier)、自由层(Free Layer)构成。钉扎层由铁磁层(被钉扎层,Pinned Layer)和反铁磁层(AFM Layer)构成,铁磁层和反铁磁层之间的交换耦合作用决定了铁磁层的磁矩方向;隧道势垒层通常由MgO或Al2O3构成,位于铁磁层的上部。铁磁层位于隧道势垒层的上部。如图所示的箭头分别代表被钉扎层和自由层的磁矩方向。被钉扎层的磁矩在一定大小的磁场作用下是相对固定的,自由层的磁矩相对于被钉扎层的磁矩是相对自由且可旋转的,随外场的变化而发生翻转。各薄膜层的典型厚度为0.1 nm到100 nm之间。

  底电极层(Bottom Conducting Layer)和顶电极层(Top Conducting Layer)直接与相关的反铁磁层和自由层电接触。电极层通常采用非磁性导电材料,能够携带电流输入欧姆计,欧姆计适用于已知的穿过整个隧道结的电流,并对电流(或电压)进行测量。通常情况下,隧道势垒层提供了器件的大多数电阻,约为1000欧姆,而所有导体的阻值约为10欧姆。底电极层位于绝缘基片(Insulating Layer)上方,绝缘基片要比底电极层要宽,且位于其他材料构成的底基片(Body Substrate)的上方。底基片的材料通常是硅、石英、耐热玻璃、GaAs、AlTiC或者是能够于晶圆集成的任何其他材料。硅由于其易于加工为集成电路(尽管磁性传感器不总是需要这种电路)成为最好的选择。 

auto_1427

  右图所示的是在理想情况下的MTJ元件的响应曲线。在理想状态下,磁电阻R随外场H的变化是完美的线性关系,同时没有磁滞(在实际情况下,磁电阻的响应曲线随外场变化具有滞后的现象,我们称之为磁滞。磁电阻的响应曲线为一个回路,通常作为应用的磁电阻材料的磁滞很小,在实际使用中可以看做一个完美的线性曲线)。在现实应用的传感器领域,由于磁传感设计的制约以及材料的缺陷,这条曲线会更弯曲。本发明涉及了传感器的设计、结构以及能够生产实施的工序,该传感器具有卓越的工作感应,在工作区域内同时具有高线性度、低磁滞、高灵敏度的特点(即磁电阻响应曲线斜率大)。

  R-H曲线具有低阻态RL和高阻态RH。其高灵敏度的区域是在零场附近,传感器的工作区间位于零场附近,约为饱和场之间1/3的区域。响应曲线的斜率和传感器的灵敏度成正比。如图3所示,零场切线和低场切线以及高场切线相交于点(-Hs+Ho)和点(Hs+Ho),可以看出,响应曲线不是沿H = 0的点对称的。Ho是典型的偏移场。Ho值通常被称为“橘子皮效应(Orange-peel Coupling)”或“奈尔耦合(Néel Coupling)”,其典型值为1到40 Oe。其与磁电阻元件中铁磁性薄膜的结构和平整度有关,依赖于材料和制造工艺。Hs被定量地定义为线性区域的切线与正负饱和曲线的切线的交点对应的值,该值是在响应曲线相对于Ho点的不对称性消除的情况下所取的。图3中,白色箭头代表自由层磁矩方向,黑色箭头代表钉扎层磁矩方向,磁电阻响应曲线随自由层磁矩和被钉扎层磁矩之间角度的变化而变化:当自由层磁矩与钉扎层磁矩反平行时,曲线对应高阻态RH;当自由层磁矩与钉扎层磁矩平行时,曲线对应低阻态RL;当自由层磁矩与钉扎层磁矩垂直时,阻值是位于RLRH之间的中间值,该区域是理想的线性磁传感器的“工作点”。

上图中的内插图是另一个磁电阻R与外场H的响应曲线图,该磁电阻沿传感器的法线旋转了180°。在同一外场H的作用下,该磁电阻的响应曲线与主图对应的磁电阻的响应曲线呈相反的变化趋势。主图对应的磁电阻和旋转180°设置的磁电阻可以构造电桥,这被证明比其他可能的方法输出值更大。

  电桥可以用来改变磁电阻传感器的信号,使其输出电压便于被放大。这可以改变信号的噪声,取消共模信号,减少温漂或其他的不足。MTJ元件可以连接构成惠斯通电桥或其他电桥。auto_1428

 右图是一个典型的MTJ推挽半桥传感器结构。沿传感器的法线旋转180°排列的两个MTJ磁电阻构成了半桥结构,其具有3个外接焊盘(Contact-Pad),依次为:偏置电压(Vbias)、中心点VOUT以及接地点(GND),桥式电路可通过焊盘进行电连,稳恒电压Vbias施加于焊盘Vbias端和GND端。在同一外场H的作用下,一个磁电阻的阻值增加的同时另一个的阻值会随之降低,施加相反方向的外场会使一个磁电阻的阻值降低的同时另一个的阻值会随之增加,使两个磁电阻测量外场有相反的响应——一个阻值增加另一个阻值降低——这可以增加传感器的灵敏度,因此被称为“推挽式”桥式电路。

  推挽半桥传感器的输出电压可以通过很多已知的方法进行测量,例如在V1和GND焊盘之间连接电压表,V1和GND之间的电位差(V1-GND)就是输出电压,其典型的输出曲线的模拟结果如图4所示。

auto_1429

  右图是MTJ电桥的输出曲线为模拟信号,可以通过设置一个专用的ASIC芯片对模拟信号进行处理,可根据用途输出数字信号

  巨磁电阻效应的发现者法国科学家阿尔贝·费尔(Albert Fert)和德国科学家彼得·格林贝格尔(Peter Andreas Grünberg)由于其对现代磁记录和工业领域的巨大贡献而获得2007年诺贝尔物理学奖,作为GMR元件的下一代技术,TMR(MTJ)元件已完全取代GMR元件,被广泛应用于硬盘磁头领域。相信TMR磁传感技术将在工业、生物传感、磁性随机存储(Magnetic Random Access Memory,MRAM)等领域有极大的发展与贡献



pni13156与pni12927地磁传感器驱动芯片的区别

金生 回复了问题 • 2 人关注 • 2 个回复 • 1218 次浏览 • 2021-05-20 17:04 • 来自相关话题

磁性角度传感器如何选?

laoguo 发表了文章 • 0 个评论 • 655 次浏览 • 2020-08-06 09:56 • 来自相关话题

随着工厂和车辆自动化程度的提高,准确、低延迟的电机轴速度和位置感测对于过程控制、系统可靠性和安全性至关重要。为了满足这些需求,设计人员需要快速、精确,而且能够灵活应对磁场变化和轴向错位的角度旋转传感器。


 
对设计人员来说,令这个问题复杂化的是无时不在的成本和时间压力,以及各类工业和汽车应用的操作环境性质,它们可能会在化学品和油类以及温度和EMI等方面带来巨大的挑战。其他考虑因素还包括磨损和不断变化的配置,这要求传感器件具有一定程度的灵活性。
 
本文将介绍角度传感器的作用,并展示如何使用磁输入和传感器元件的特定组合来自定义位置感测特性(例如速度和低延迟)。然后介绍AKM Semiconductor、Infineon Technologies和Monolithic Power Systems的传感器解决方案示例,并讨论它们的实现。


角度传感器的作用



角度传感器可用于感测电机轴的位置和速度变化,实现汽车的转向角感测和机器人系统中的高精度控制。它们通过检测所施加磁场的方向并测量其正弦和余弦分量,来确定旋转轴上径向磁化圆柱体的绝对角位置。由于轴可能会高速旋转,因此需要以最小的延迟快速获取和处理来自传感器的数据,这一点至关重要。
 
通常使用四种磁性技术之一:霍尔效应、各向异性磁阻 (AMR)、巨磁阻 (GMR) 和隧道磁阻 (TMR)(图1)。在使用其中任意一种技术时,设计人员都必须首先根据特定参数(例如磁属性、传感器规格和组装公差),确定从磁铁表面到传感器的合适距离。

图 1:当磁铁在TMR传感器上旋转时,感测元件的电阻会随旋转角度而变化。(图片来源:Digi-Key Electronics)
 
该气隙必须与磁铁尺寸和剩磁(也称为剩余磁化强度)之类的参数保持一致。设计人员还必须确保气隙变化不会导致磁场过弱或过强。这需要仔细考虑适合应用气隙的磁铁(图2)。

图2:设计人员可以根据多种设计考虑因素选择磁铁与传感器的相对位置,例如所需的抗外部磁场干扰能力和气隙公差。(图片来源:Monolithic Power Systems)
 
不过,角度传感器可以支持广泛的空间配置和磁场强度,包括离轴或侧轴安装和轴端配置。为了帮助适应变化,使用片载非易失性存储器存储配置参数,例如参考零角度位置、ABZ编码器设置以及电机绕组的相位信息。
 
接着,该器件能够检测各种磁场强度,从而使开发人员能够针对特定功能(例如诊断和轴向运动感测)定制角度传感器。获取可编程磁场强度阈值还有助于实现输出为两个逻辑信号的推挽按钮功能。
 
不过,尽管速度、低延迟和分辨率等特性均依赖于应用要求,但安全性才是角度传感器设计的核心。功能安全标准合规性进一步证实了对汽车和工业设计环境的承诺,而这些环境对于准确性和可靠性的要求非常严格。
 

符合功能安全要求



汽车应用中使用的角度传感器需要达到乃至0.1˚的高精度,有助于确保在面对非常苛刻的操作环境时符合ISO 26262功能安全标准。这些传感器的应用包括用于泵、雨刷器、制动器、阀、挡板、踏板和转向角的无刷直流 (BLDC) 电机中的位置测量。0.1˚的精度适用于整个温度范围和产品生命周期。此外,在介于10mT和20mT之间的低磁通密度下(此时角度误差显著增加),用于汽车和工业设计的角度传感器仍必须实现低至0.2°的角度误差。
 
此外,角度传感器应该易于集成到安全关键型设计中,例如电动助力转向 (EPS) 系统,它们对于自动停车和车道保持等自动驾驶功能而言至关重要。
 
为了满足易用性要求,Infineon的XENSIV TLE5109TLE5014角度传感器提供了单芯片和双芯片版本,并将感测和逻辑元件都集成在一个芯片上(图3)。双芯片版本更适合ASIL-D安全应用。

图3:安全关键型应用所用的双芯片角度传感器(右图)的侧视图(左图),该传感器使用上下放置来缩小空间,并通过使用低成本的铁氧体磁性材料来节省成本。(图片来源:Infineon Technologies)
 
TLE5109A16E2210XUMA1属于高精度AMR快速模拟角度传感器系列产品,误差角仅为0.1°。尽管基于AMR的角度传感器专为180°角度测量而设计,但它们也适用于具有偶数极对的电机中的360°测量,因为AMR感测元件实际上可测量双角度,即正弦和余弦(图4)。由于它们的角度误差很小,因而适用于各种磁通密度范围介于10mT到500mT以上的磁场。
 
图4:基于AMR的角度传感器专为180°角度测量而设计,但由于它能测量正弦和余弦角度,因此也可用于完整的360°角度测量。(图片来源:Infineon Technologies)
 
TLE5109角度传感器采用3.3V或5V电源供电。其他特性包括介于40µs到70µs之间的短启动时间,以确保最小的延迟并支持每分钟30,000转以上的速度。
 
TLE5014C16XUMA1是GMR传感器系列之一,可通过将所需的配置存储在板载EEPROM中进行编程,以满足广泛的应用需求(图5)。这些传感器还提供包括PWM、SENT、SPC和SPI在内的多种接口选择,从而提高灵活性和易用性。
 
图5:预先配置和预先校准的TLE5014角度传感器具有灵活的编程能力,可适应任何使用板载 EEPROM 的应用。(图片来源:Infineon Technologies)
 
TLE5014角度传感器通常从高达26伏(绝对最大值)的电源电压吸收25毫安 (mA) 电流,其单芯片版本符合ISO 26262 ASIL-C标准,双芯片版本符合ISO 26262 ASIL-D标准。
 

关键性能参数


 
为了充分实现角度传感器的功能,以减少可闻噪声并优化电机的平滑度和扭矩,设计人员应仔细考虑以下关键参数:精度、速度、延迟、轴向错位和磁铁漂移。
 
例如,尽管环境条件恶劣,但高精度读数对于汽车和工业环境至关重要。这使得热稳定性和气隙公差等因素对于角度传感器能否满足精度目标,同时不增加系统设计的成本和复杂性至关重要。
 
为了以最低的成本满足此类要求,Monolithic Power Systems的MagAlpha磁性位置传感器MA302GQ-PMA702GQ-P/Z和MA730GQ-Z可以安装在板的边缘,以用于轴端和侧轴(离轴)配置。在速度方面,凭借非接触式感测和12位分辨率绝对角度编码器,MA302传感器能够提供0rpm至60,000rpm的准确角度测量。MagAlpha MA730GQ-Z具有14位分辨率,并通过SPI链路提供数字读数(图6)。
 
图6:非接触式MagAlpha MA730GQ-Z具有14位分辨率,并通过SPI链路提供数字读数。(图片来源:Monolithic Power Systems)
 
不过,针对慢速操作(例如转速保持在200rpm以下的人机界面 (HMI) 或手动控制),该公司还提供了MagAlpha MA800,这是一种数字磁传感器,旨在取代模拟电位计或旋转开关。它与直径2mm至8mm的磁化圆柱体一起使用,具有灵活的磁铁配置和形状。
 
MA800具有较低的分辨率(8位),但具有片载非易失性存储器和可编程的磁场强度阈值。这些特性使其非常适合需要通过寄存器位以及输出信号来实现按钮读数的应用。
 

零延迟角度传感器



AK7451是一种12位角度传感器,可通过测量磁场强度来检测角速度和旋转角度。它具有平行于IC表面运行的磁铁组合,同时还提供高达20,000rpm的跟踪速度。在检测到平行于IC表面的磁场矢量后,它会输出磁铁的绝对角位置,然后输出相对角位置。
 
AK7451采用跟踪伺服系统架构,以确保零延迟旋转角度感测。零延迟角度传感器可以输出多达八极UVW绕组相位(图7),从而大幅提高了其通用性,使其可用于各种各样的电机驱动器和编码器应用。
 
图7:AK7451可让设计人员通过EEPROM来编程16种ABZ输出分辨率设置以及8种UVW输出脉冲数量设置。(图片来源:AKM Semiconductor)
 
此外,ABZ相位输出分辨率设定还从4种扩展至16种,增强了电机控制的适用性。它还使AK7451角度传感器无需安装霍尔IC,便可在直流无刷电机驱动的操作中保障转子位置检测。
 
在这里,值得一提的是,对于一些位置感测应用而言,延迟并不是关键问题。例如,在电动助力转向 (EPS) 手工滚轮角度感测中,每毫秒 (ms) 都会请求一个新的角度值。另外,区分由传感器IC和磁输入引起的误差也很重要,以便使用角度传感器IC来补偿与磁输入有关的误差。
 

总结



虽然更高的精度和更小的外形尺寸在很大程度上推动了汽车和工业应用中的角度传感器功能,但功能安全标准合规性概括了这些高精度器件的总体价值主张。但为了充分利用其功能,设计人员需要仔细考虑特定的应用要求,明确各种性能参数,例如适当的气隙、磁场强度、角速度和角度误差等。
 
如上所述,在建立这些要求后,便可使用各种各样的非接触式传感器来提供必要的精度、速度和可编程的灵活性,从而满足这些要求。



条新动态, 点击查看
laoguo

laoguo 回答了问题 • 2020-05-05 09:27 • 1 个回复 不感兴趣

为什么PNI磁传感器精度可以做到很高?

赞同来自:

PNI自成立之初,就专注于为精确磁导航和定位研究领域提供先进的产品和技术支持服务,多年来推出了一系列性能出色的产品,包括各类电子罗盘和磁元件。PNI不仅在磁导航方面拥有领先的算法开发经验,而且其MI(磁感)传感器至今仍是世界上精度最高的磁感元件。下面我们一起来... 显示全部 »
PNI自成立之初,就专注于为精确磁导航和定位研究领域提供先进的产品和技术支持服务,多年来推出了一系列性能出色的产品,包括各类电子罗盘和磁元件。PNI不仅在磁导航方面拥有领先的算法开发经验,而且其MI(磁感)传感器至今仍是世界上精度最高的磁感元件。下面我们一起来揭开,这样一款高精度的磁传感器背后工作的“秘密”。图1:PNI磁传感器元件及ASCI驱动芯片图2是PNI磁感式(MI)传感器的实际简要应用电路。这是一个典型的LR振荡电路,其中,电感元件由传感器中的高磁导率磁芯和缠绕在其四周的螺旋管组成,电阻则需要用户提供。除此之外,电路中还有一个用于状态切换的施密特触发器。图2:PNI磁传感器典型应用电路图当图中电路接通电源后,由物理规律可知,传感器处的磁场强度H由两部分组成:一部分是外界磁场强度HE;另一部分则是电流所产生的,大小与电流成正比,可表示为k0I(k0为常数)。所以,可以得到如下关系式:H=HE+k0I在图2的工作电路中,假设施密特触发器的阈值电压为VH,并且当输入电压(A点电压)为0或某个小于阈值电压的值VL时,触发器的逻辑状态降为“1”,同时输出大小为VS的电压信号。在此条件下,电路中传感器两端的电压会逐渐增加,直到A点的电压上升到VH时,触发器的逻辑状态会转换为“0”,从而使得传感器上的电压又开始慢慢减小。如图3,上半部分所示为是施密特触发器逻辑状态波形图,下半部分为A点处的实际电压变化波形图。图3:振荡电路输出波形与触发器逻辑状态变化图图4是磁性物质的磁导率μ与磁场强度H的关系。正如图2所示,电路中的偏置电阻Rb和以及触发器的参数特性均经过挑选,从而使得传感器在受到正向或负向电压驱动时,所产生的磁场强度能处于图5所示的虚线区域中。注意当没有外界磁场时,无论是正向或负向驱动,都能得到相同波形图。图4:磁导率与磁场强度关系图5:无外部磁场环境下振荡电路输出波形与磁场强度关系当将外界磁场HE(如地球磁场强度)也一起考虑进来时,图5中正向驱动和负向驱动的情况都会受到影响。由于HE的方向一定,从而导致图5中的磁场范围向同一方向发生移动。结果是一种情况下的磁导率增加,另一种情况下减小。从而导致两种情况下的电感系数不再相同,振荡电路的电压波形周期τ也随之增大或减小,如图6所示。图6:存在外部磁场情况下震荡电路输出波形与磁场强度关系然后分别通过测量在正向电压和负向电压情况下,相同数量的波形周期时间,并进行对比和计算,就能够得到外部的磁场强度HE。PNI磁传感器的优点数字输出。PNI磁传感器的ASIC芯片可直接输出与磁场大小相关的数字信号,不像其他模拟信号输出的产品,需要额外的放大器和模数转换器等硬件。高分辨率,分辨率可达10NT。其他同类的产品很难做到,或要花费相对高昂的代价才能实现。低功耗。传感器的功耗与采样率有关,如当采样率为8Hz时,传感器的功耗在1.5mW左右,300Hz时,功耗在7.5mW。而一般的MR(磁阻)传感器的功耗普遍在15mW到30mW。温度性能好,无磁滞效应。传感器的正/反向电压驱动的设计原理,从根本上杜绝了磁滞效应的影响。而传感器由于温度影响而带来的输出误差,也在正负方向上相互抵消。

基于IMU和地磁传感器的捷联惯性导航系统(1)

laoguo 发表了文章 • 0 个评论 • 634 次浏览 • 2021-07-16 11:05 • 来自相关话题

简介

随着服务机器人市场和技术的发展,导航已成为研究和应用中的一个热点。与车辆、船舶或飞机相比,服务机器人体积小,成本低,因此它们的导航系统应该具有捷联和低成本的特点。传统的稳定平台导航系统通常要采用独立的加速度计和光纤或激光陀螺仪,所有传感器都机械且刚性地安装在与正在移动的车辆隔离的稳定平台上。这导致了尺寸大、可靠性差、成本高的缺点。相反,在捷联惯导系统中,惯性传感器直接固定在车辆本体上,这意味着传感器会与车辆一起旋转。这种捷联方法消除了稳定平台惯导的缺点。然而,平台惯导的准确性通常高于SINS。平台惯导往往可以达到战略级(0.0001°/时的陀螺仪偏置,1μg的加速器偏置)或军用级(0.005°/时的陀螺仪偏置,30μg的加速器偏置),而多数SINS只能到达导航级(0.01°/时的陀螺仪偏置,50μg的加速器偏置)或战术级(10°/时的陀螺仪偏置,1mg的加速器偏置)。对于大多数服务机器人或AGV导航应用,这一精度足够了。

导航方法很多,包括机器视觉、GPS、UWB、SLAM型激光雷达等。基于IMU的惯性导航始终是导航的重要组成部分。然而,由于这种传感器的限制——例如偏置误差、轴间误差、噪声,特别是零偏不稳定性——惯性导航通常需要采用一个伙伴传感器,定期为它提供参考或校准,本文将这种情况称为传感器融合。许多传感器都可以与IMU融合,例如摄像头和里程表,但在这些传感器中,地磁传感器是一种低成本的方案,可与IMU配合获得姿态信息。

在本文中,我们使用ADI的IMU ADIS16470和地磁传感器来开发平台和算法,实现捷联惯性导航系统。但是,地磁传感器只能提供姿态信息。对于航位推算或距离测量,我们只能使用IMU中的 加速度传感器。

ADIS16470 IMU简介

ADI公司的ADIS16470是一款微型MEMS IMU,集成了3轴陀螺仪和3轴加速度计。其陀螺仪零偏稳定性为8°/时,加速计零偏稳定性为13μg 其关键参数都经过出厂校准。此外,ADIS16470的 低价格在同级产品中具有吸引力,得到了许多客户的广泛使用。在本文中,我们使用微控制器与ADIS16470通过SPI接口进行通信。

地磁传感器介绍

地磁传感器是用于测量罗盘体坐标(即坐标系)中的地磁场的传感器,可为航向提供绝对参考。其x、y和z分量值由本地地磁场投影而来。这种传感器有两个主要缺点——一是精度和分辨 率不高——例如,常用的霍尼韦尔罗盘传感器HMC5883L的分辨率仅为12位。另一个缺点是传感器容易受到周围环境的干扰,因为地磁场非常弱,强度范围为毫高斯到8高斯。

尽管有这些缺点,仍然可以在许多情况下使用,例如户外、低EMI环境等。将地磁传感器与IMU进行松耦合,就可以在大多数环境中使用这类传感器。

在本文中,我们使用PNI传感器公司的高性能电子罗盘传感器RM3100,它提供了24位分辨率。PNI使用主动激励法来提高抗噪声能力。

罗盘传感器的校准

在使用罗盘传感器之前,需要对其进行校准以消除两个主要误差。一个是失调误差,这原本是由传感器和电路的失调误差引起的。另一个是标度误差。这两种误差都容易受到周围磁环境的干扰。例如,如果有一个x轴向的外部磁场施加到传感器上,就会给出外部x轴失调误差。同时,x轴标度也将与y轴和z轴不同。

通常用于校准磁传感器的方法是在xy平面上转动传感器绕圈,然后抽取数据。一个地点的地磁场强度是一个常数值,因此绘制的数据应该是一个圆;然而,事实上,我们将看到一个椭圆形,这意味着我们需要移动椭圆并重新缩放到以零为中心的圆。

上述2D校准方法有一些缺点,并且需要用加速器来测量其倾斜度。我们使用3D球面拟合方法来校准罗盘传感器。首先,我们需要将传感器旋转到x-y-z空间中的每个方向,并在3D坐标中绘制其值。然后我们需要使用最小平方误差(MSE)方法将数据拟合为椭球面。

椭球方程可以表示为

Equation 1

其中,X、Y和Z是罗盘输出在三个方向上的地磁分量。将这些值拟合为椭球面意味着,我们需要得到一组最优系数解。我们将系数定义为:

Text Equation 1

在拟合时,我们定义向量:

Text Equation 2

所以我们需要计算最优σ,并使用公式2来找出最小值:

Equation 2

这样我们就可以得到图1所示的拟合结果。

234033-fig-01


图1. 原始罗盘数据分布(左)和使用椭球拟合后的罗盘数据(右)。

为了校准传感器,我们需要拉伸或压缩拟合的椭球面并将其移至以零为中心的球面上。我们使用矩阵奇异值分解(SVD)方法来进行这种校准。校准后的球体如图2所示。1,2

234033-fig-02


图2. 用SVD方法进行球体校准后的罗盘数据。

校准后,我们可以看到,测得的磁场强度(球半径)几乎恒定不变,如图3所示。

234033-fig-03


图3. 校准前和校准后的磁场比较。

使用ADIS16470和罗盘的姿态和航向参考系统

AHRS由三个轴上的传感器组成,提供姿态信息,包括横滚角、俯仰角和偏航角。AHRS是一个来自飞机导航的概念。我们用它来描述方向,即姿态。

在介绍我们的方法之前,有必要首先解释为什么确定姿态需要进行融合。事实上,我们的系统现在有三种传感器:陀螺仪、加速器和罗盘(地磁传感器)。

陀螺仪提供围绕各轴的旋转角速度。通过角速率积分计算,我们可以得到旋转角度。如果我们知道初始航向,通过角度就始终能够得到航向姿态。积分将累积陀螺仪的不稳定零偏,这将导致角度误差。此外,来自陀螺仪的高斯分布噪声将积分成一个布朗运动过程,并导致随机游走误差。因此,我们很难长时 间使用陀螺仪,陀螺仪需要定期校准。

加速度计提供每个轴方向的移动加速度。在静态状态下,我们可以得到每个轴与重力加速度之间的角度。由于重力加速度在方向和值上恒定不变,我们可以获得相对于重力方向的航向姿态。然而,该方法使用重力加速度作为参考,因此不能解出围绕重力加速度旋转的角度。

罗盘提供从地磁场投影的每个轴的值。我们可以从每个轴与恒为常数向量的地磁场方向之间的关系推导出角度值。如前一节所述,由于对外部磁场的抗扰性较差,罗盘需要一个低干扰的环境。

从这一解释中,我们可以看到,很难靠一个传感器来找到姿态,我们需要组合使用两个或三个传感器并把信息融合起来。本文用加速度计、陀螺仪和地磁罗盘查找姿态。这种融合也被称为磁、角速率和重力(MARG)系统。

扩展卡尔曼滤波器的设计与传感器融合

有多种方法可以将IMU和罗盘数据融合起来,例如互补滤波器、统计学ARMA滤波器,卡尔曼滤波器等。我们在本文中使用的是扩展卡尔曼滤波器。

首先,我们需要介绍本文中使用的一些定义。

坐标定义

T航向或方向是两个坐标(即坐标系)之间的关系。一个坐标总在变化,另一个坐标保持不变。对于坐标定义方法,我们使用导航坐标和体坐标。与东北地(NED)坐标系或地理方法相反,我们将测量的初始体坐标值定义为导航坐标系,此后该坐标为恒定坐标。从体坐标到导航坐标的映射(投影)矩阵定义为

Text Equation 3

姿态定义

与欧拉角或方向余弦矩阵(DCM)不同,我们在这里使用四元数,定义为

Text Equation 4

常用于导航以避免奇异性。

用卡尔曼滤波器更新姿态

我们在本文中使用的运动学方程(即状态转移方程)是非线性微分方程,因此需要使用一个EKF,用于对该微分方程进行一阶近似。对于EKF设计,我们定义

Text Equation 5

一个1×7向量作为状态变量,其中

Text Equation 6

为角速率;

Text Equation 7

为姿态四元数。

Text Equation 8

一个1×7向量作为观测变量,与状态变量具有相同的分量。

Text Equation 9

一个7×7矩阵作为状态转移矩阵,其中,A的第一部分是角速率的数字化微分方程,第二部分是数字化四元数更新方程,后者从运动学方程推导而来。

Text Equation 10

一个7×7矩阵作为观察矩阵。

Text Equation 11

为误差协方差矩阵,这是一个7×7矩阵,其中e估计向量 真实值xx之间的误差我们在测试中将初始误差设为相对较小的值。该值会自动收敛到一个小值。

R,Q被设为状态转移噪声和观测噪声的协方差矩阵。我们得到它们的初始值,

R0和Q0在保持IMU和罗盘处于静止状态的同时,通过测量陀螺仪和加速器的交流均方根值的平方得到。我们设

R0 = Q0

根据以上定义,卡尔曼滤波器将通过以下五个步骤完成:

步骤1:使用公式3计算卡尔曼增益K

Equation 3

步骤2:计算误差协方差矩阵,P:

Equation 4

步骤3:输出估算状态:

Equation 5

步骤4:更新状态:

Equation 6

步骤5:更新误差协方差矩阵P:

Equation 7

该过程可以简单地描述为图4中的框图。

234033-fig-04


图4. 用于更新姿态的卡尔曼滤波器流程图。


篇幅有限,可下载PDF原文阅读 

基于IMU和地磁传感器的捷联惯性导航系统_cn.pdf


磁力计 / 磁传感器 / 罗盘品牌列表

laoguo 发表了文章 • 0 个评论 • 711 次浏览 • 2020-06-10 19:57 • 来自相关话题

中国-矽睿科技(QST)三轴地磁传感器:QMC6310,QMC5883L,QMC783,QMC6983


    无锡美新(MEMSIC)
    明皜传感(MiraMEMS)
    江苏多维(dowaytech)
    旭化成微电子(AKM Semiconductor)
    Allegro
    Micronas
    Melexis
    爱知制钢(Aichi Steel)
    雅马哈(Yamaha)
    阿尔卑斯电气有限公司(Alps Electric)
    意法半导体(ST Microelectronics)
    Amotech
    飞思卡尔(Freescale)
    霍尼韦尔(Honeywell)
    松下(Panasonic)
    精量电子(Measurement Specialties)
    英飞凌(infineon)
    Baolab
    mCube


美国-PNI公司:

地磁传感器套件RM3100(包括专用驱动芯片13156,Sen-XY轴地磁传感器13104,Sen-Z Z轴传感器13101)


台湾-爱盛科技(isentek): http://www.isentek.com/

三轴AMR地磁传感器

        消费级产品线:IST8305,IST8306,IST8315

        工业级产品线:IST8307,IST8308,IST8310,IST8308A

AMR电流传感器:IST8110,ICSM1000(模块)

角度传感器:IST8210(180度)

PNI电子罗盘 TCM3与TCM XB的区别

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 500 次浏览 • 2021-07-22 18:38 • 来自相关话题

11096 PNI公司最早地磁传感器专用芯片停产。

回复

匿名用户 发起了问题 • 1 人关注 • 0 个回复 • 444 次浏览 • 2021-07-20 19:29 • 来自相关话题

3D MagIC(12927) 与 11096 区别比较

回复

laoguo 回复了问题 • 1 人关注 • 2 个回复 • 817 次浏览 • 2021-07-20 19:27 • 来自相关话题

pni13156与pni12927地磁传感器驱动芯片的区别

回复

金生 回复了问题 • 2 人关注 • 2 个回复 • 1218 次浏览 • 2021-05-20 17:04 • 来自相关话题

我如果想测电池的x轴方向的数据传感器怎么放置?

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 775 次浏览 • 2020-07-08 17:20 • 来自相关话题

RM3100传感器怎么布局在板子上?

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 800 次浏览 • 2020-07-08 17:17 • 来自相关话题

rm3100是包括哪些

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 761 次浏览 • 2020-07-07 17:34 • 来自相关话题

pni公司的13101传感器是起什么作用的

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 727 次浏览 • 2020-06-12 17:30 • 来自相关话题

什么是硬磁失真,什么是软磁失真?

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 658 次浏览 • 2020-05-26 10:26 • 来自相关话题

PNI两轴罗盘和三轴罗盘的区别是什么?

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 876 次浏览 • 2020-05-26 10:13 • 来自相关话题

为什么PNI磁传感器精度可以做到很高?

回复

laoguo 回复了问题 • 1 人关注 • 1 个回复 • 680 次浏览 • 2020-05-05 11:19 • 来自相关话题

基于IMU和地磁传感器的捷联惯性导航系统(2)

laoguo 发表了文章 • 1 个评论 • 492 次浏览 • 2021-07-16 12:11 • 来自相关话题

上节内容:http://www.ganwen.net.cn/?/article/30

基于MSE的传感器融合

在上一节中,观测变量是

基于IMU和地磁传感器的捷联惯性导航系统

其中没有来自罗盘的信息。由于ω是角速率,我们只能使用四 元数来导入罗盘数据q. 我们使用MSE方法获得q, 即观测变量 中的组分。

我们将各变量定义如下:

mb和ab: 体坐标系里的罗盘磁值和加速度值。

mn和an: 导航坐标系里的罗盘磁值和加速度值。

mn0和an0: 导航坐标系里的初始静态罗盘磁值和加速度值。

基于IMU和地磁传感器的捷联惯性导航系统

为从体坐标系到导航坐标系的姿态转换矩阵,用四元数表示,可以写成

基于IMU和地磁传感器的捷联惯性导航系统

其给出了导航坐标系中初始值与实时从体坐标系映射到导航坐标系的值之间的误差ε。

根据之前的定义,MSE方法可用于求取最优值。

基于IMU和地磁传感器的捷联惯性导航系统

通过求方程8的最小值:

基于IMU和地磁传感器的捷联惯性导航系统

对f(q)求导并使其等于零,

基于IMU和地磁传感器的捷联惯性导航系统

我们将获得方差意义上的最优q。我们使用高斯-牛顿方法,用一阶梯度收敛来求解以上非线性方程。

通过组合角速率,我们将得到观测变量

基于IMU和地磁传感器的捷联惯性导航系统

其中融合了卡尔曼滤波器中的罗盘数据和IMU数据。

该过程可以简单地描述为图5中的框图。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图5. 使用MSE方法的传感器融合框图。

松耦合

如前所述,我们经常遇到无法使用罗盘传感器的情况。如果磁数据受到干扰,则求解的姿态精度将比仅使用IMU时更差。因此,我们使用松耦合来判断磁传感器是否可用。当磁传感器不可用时,我们只用IMU来求解姿态;当磁传感器可用时,我们将使用融合算法找到姿态,如图6所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图6. 姿态计算流程图。

在获得新数据之后或者在求解新的姿态时(在某些系统中,采样周期与姿态解算周期不同,但我们在此处进行的是单采样周期解算),我们计算加速度的大小,如果结果不等于1g, 我们 就不会使用加速器的输出进行姿态计算。然后我们计算罗盘输出的大小并将其与初始值进行比较。如果它们彼此不相等,我们就不会在此周期中使用地磁传感器的数据。当满足两个条件时,我们会使用卡尔曼滤波器并执行MSE融合。

使用ADIS16470进行航位推算(DR)

在导航中,航位推算是计算当前位置的过程,先使用先前确定的位置,然后在解算周期中基于已知或估计的速度或加速度更新该位置。这里将使用ADIS16470里的加速度计。基于上一节解出的姿态,我们可以得到捷联系统的移动方向,然后需要计算该方向上的距离,最后确定位置。

捷联航位推算需要使用基于加速度测量的比力方程来跟踪INS的位置。比力方程可以简单描述为等式10、等式11和等式12:

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

其中ae是地球坐标系里的加速度,ab 是体坐标系里的加速度,ve是地球坐标系里的速度,se是地球坐标系里的距离,ge 是 地球坐标系里的重力加速为[0 0 1],单位为 g。需要强调的是,地球坐标系与导航坐标系不同——地球坐标系是基于NED的。该 δtt是解算周期。

用第一个等式可以得到从IMU体坐标系到地球坐标系的加速度映射,如格式

基于IMU和地磁传感器的捷联惯性导航系统

第二个等式将加速度积分或累加为速度;然而,由于测量的加速度包含了重力分量,所以需要减去重力。

与等式11类似,等式12将速度积分成距离。

传统方法存在几个问题。

● 加速度计输出总是有偏置,与重力相结合后,难以从公式10中减去,因此更准确的表达式应为:

基于IMU和地磁传感器的捷联惯性导航系统

除非是用一些专业设备来测量该偏置,例如分度头。

● 基于数值积分的实现方式,通常使用零阶保持器方法(前一个值)进行积分。但是,对于连续移动,这将带来重大的误差。例如,我们来比较以下方法:

方法1:

(零阶保持器)

方法2:

基于IMU和地磁传感器的捷联惯性导航系统

(线性插值)

在5秒内加速度为为0.5 m/s2时,位移最高将相差4m。仿真结果如图7所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图7. 速度计算中的零阶保持与一阶积分方法比较。

基于前面的讨论,基于应用,我们修改了传统比例方程中的两个地方:

X 我们不使用地球坐标作为导航坐标系。相反,正如我们在计算先前姿态时所做的那样,我们用初始姿态

基于IMU和地磁传感器的捷联惯性导航系统

作为导航坐标系。通过这种方式,偏置和重力都可以轻松取消,如公式14所示:

基于IMU和地磁传感器的捷联惯性导航系统

虽然姿态中同时包含了偏置和重力分量,但这样我们就不需要将它们分开成单独的分量,而是直接一起减去它们。

基于零阶保持器与一阶插值之间的比较,我们使用一阶方法来获得更准确的积分结果。

运动学模式和零速更新技术(ZUPT)

通过使用IMU的初始值作为导航坐标系,我们可以消除一部分加速度的偏置影响。然而,即使我们在使用设备之前能用分度头准确测量偏置,仍然很难取消,除非使用另一个精确的传感器来定期校准它。这主要是由两个原因引起的:一是偏置不稳定,这意味着我们之前测量的偏置不是现在的实际偏置。二是速度随机游走,由加速度噪声积分而来。前面提到的不良特性会使我们计算的距离显著漂移。即使我们停止移动并保持静止,从加速度积分而来的速度仍然存在,距离仍会增加。

要解决这个问题,我们需要找到一种通过使用ZUPT技术重置速度的方法。ZUPT技术与具体的应用密切相关,因此我们需要获得系统和应用的运动学特征,然后给出一些算法规则。我们发现的运动学模式越多,结果就越准确。

我们通过移动带有SINS系统的转椅来进行实验。由于我们的研究不限于特定应用,我们使用以下运动学假设:

● 对于航位推算,导航坐标系中没有z轴移动。此限制仅适用于航位推算,不适用于姿态求解。显然,我们是在二维空间中移动系统。这有助于消除z轴误差。

● 所有转弯都发生在停止后。如果在移动时发生转弯,则会因为引入额外加速而干扰姿态求解。

● 如果系统正在移动,加速度不能保持不变超过500毫秒。速度不能保持不变超过2秒。由于我们在推动或拉动转椅,因此很难手动使力精确地保持不变超过500毫秒,并且个人很难以匀速持续推动转椅2秒以上。事实上,我们正是运用这一规则来实施ZUPT。

● 加速度不能大于±1 m/s2。该规则用于一些噪音过滤,后者基于我们施加于椅子上、不会很大的拉力或推力。

如图8所示,当系统在X方向上移动时(投影到导航坐标系后),Y方向也会产生加速度;积分后,Y方向速度不会为零,这意味着即使我们只是在X方向上移动,航位推算系统仍然会给我们带来Y分量。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图8. 导航坐标系中三个方向的加速度。

基于第三条运动学假设,我们可以使用ZUPT来消除此误差。经ZUPT处理之后的积分速度如图9所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图9. 导航坐标系中三个方向的速度。

虽然我们使用了第三条假设,如前所示,误差仍然无法完全取消。误差消除取决于设定的零加速度和零速度的判断阈值。但是,大多数误差已得到修正。

虽然使用了ZUPT,但有时仍然无法达到零速。这由两个因素导致:

● 我们无法用ZUPT完全消除偏置不稳定误差和速度随机游走。

● 我们求出的姿态有一些误差,结果将导致投影(从体坐标系到导航坐标系)后的加速度误差。

以图10为例。图10中的左图是ADIS16470的原始数据(体坐标系),图10中的右图是投影到导航坐标系的加速度。可以看出,停止移动时,投影加速度不为零。由于它总是在变化,我们此处称之为基线漂移。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图10. 体坐标系(左)和导航坐标系(右)的加速度。

为了消除基线漂移,我们需要实时连续获得偏移偏置并从投影加速度中减去该值。结果如图11所示

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

Figure图11. 基线漂移消除之前(上)和之后(下)的加速度。

上图是基线漂移消除前的加速度,下图中的绿色轨迹是我们计算的基线偏移,红色轨迹是基线偏移消除后的加速度。

可以使用图12中的框图简要描述航位推算过程。我们将体坐标系加速度ab和姿态转移矩阵(来自AHRS)输入

基于IMU和地磁传感器的捷联惯性导航系统

到DR系统。完成后,我们将获得导航坐标系中的位置。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图12. 航位推算流程图

实验结果与结论

实验结果

使用SPI端口,我们将ADIS16470评估板和RM3100罗盘评估板连接到ADI公司的ADuCM4050电路板,构建出我们的系统,如图13所示。ADuCM4050 调整数据格式并进行时间同步(因为IMU和罗盘的数据速率不同)。然后使用UART将捕获的数据传输到计算机。所有计算(包括校准、AHRS和DR在MATLAB)均在MATLAB®中执行。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图13. 实验平台设置。

将评估板和计算机放在转椅上,并在实验室中推着转椅绕圈。

● AHRS输出:姿态以四元数格式和DCM格式表示,如图14所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图14. 四元数格式(左)和DCM格式(右)的姿态。

● DR输出:带XYZ位置的航位推算结果和三维图如图15所示。

采用ADIS16470和RM3100传感器实现惯性导航系统的设计

图15. 位置计算结果。

结论

本文介绍了使用ADI公司的IMU ADIS16470和地磁传感器RM3100构建捷联惯导系统的基本过程,介绍了我们使用的校准、AHRS和DR方法。在平台和实验环境等条件有限的情况下,很难进一步测试平台和算法。

有很多方法可用于改善结果,例如:

● 使用里程表或UWB距离测量方法与IMU中的加速度计融合,以在DR中获得更准确的距离值。

● 使用更复杂的运动学模型,从而在AHRS和DR中在传感器和系统层次引入更多特性,例如系统的振动、加速和减速模型、地面平整度等。这意味着为了提高导航结果的准确性,需要给出更多的边界条件。

● X 使用更精确的数值计算方法,比如用辛普森规则或三次样条插值在DR中进行积分,或者使用牛顿方法而非高斯-牛顿方法求解非线性MSE方程等。

最后但也是最重要的一点,我们在试验中发现INS与应用或运动学模型紧密相关。例如,我们在两个地方进行了实验:未铺地毯的实验室和铺有地毯的办公室。如果我们使用相同的参数集,DR结果会显示出巨大的差异。因此,无论哪种应用,例如患者跟踪、AGV导航或停车定位,或者对于同一应用中的不同条 件,我们都需要全面了解其运动学模型。


基于IMU和地磁传感器的捷联惯性导航系统(1)

laoguo 发表了文章 • 0 个评论 • 634 次浏览 • 2021-07-16 11:05 • 来自相关话题

简介

随着服务机器人市场和技术的发展,导航已成为研究和应用中的一个热点。与车辆、船舶或飞机相比,服务机器人体积小,成本低,因此它们的导航系统应该具有捷联和低成本的特点。传统的稳定平台导航系统通常要采用独立的加速度计和光纤或激光陀螺仪,所有传感器都机械且刚性地安装在与正在移动的车辆隔离的稳定平台上。这导致了尺寸大、可靠性差、成本高的缺点。相反,在捷联惯导系统中,惯性传感器直接固定在车辆本体上,这意味着传感器会与车辆一起旋转。这种捷联方法消除了稳定平台惯导的缺点。然而,平台惯导的准确性通常高于SINS。平台惯导往往可以达到战略级(0.0001°/时的陀螺仪偏置,1μg的加速器偏置)或军用级(0.005°/时的陀螺仪偏置,30μg的加速器偏置),而多数SINS只能到达导航级(0.01°/时的陀螺仪偏置,50μg的加速器偏置)或战术级(10°/时的陀螺仪偏置,1mg的加速器偏置)。对于大多数服务机器人或AGV导航应用,这一精度足够了。

导航方法很多,包括机器视觉、GPS、UWB、SLAM型激光雷达等。基于IMU的惯性导航始终是导航的重要组成部分。然而,由于这种传感器的限制——例如偏置误差、轴间误差、噪声,特别是零偏不稳定性——惯性导航通常需要采用一个伙伴传感器,定期为它提供参考或校准,本文将这种情况称为传感器融合。许多传感器都可以与IMU融合,例如摄像头和里程表,但在这些传感器中,地磁传感器是一种低成本的方案,可与IMU配合获得姿态信息。

在本文中,我们使用ADI的IMU ADIS16470和地磁传感器来开发平台和算法,实现捷联惯性导航系统。但是,地磁传感器只能提供姿态信息。对于航位推算或距离测量,我们只能使用IMU中的 加速度传感器。

ADIS16470 IMU简介

ADI公司的ADIS16470是一款微型MEMS IMU,集成了3轴陀螺仪和3轴加速度计。其陀螺仪零偏稳定性为8°/时,加速计零偏稳定性为13μg 其关键参数都经过出厂校准。此外,ADIS16470的 低价格在同级产品中具有吸引力,得到了许多客户的广泛使用。在本文中,我们使用微控制器与ADIS16470通过SPI接口进行通信。

地磁传感器介绍

地磁传感器是用于测量罗盘体坐标(即坐标系)中的地磁场的传感器,可为航向提供绝对参考。其x、y和z分量值由本地地磁场投影而来。这种传感器有两个主要缺点——一是精度和分辨 率不高——例如,常用的霍尼韦尔罗盘传感器HMC5883L的分辨率仅为12位。另一个缺点是传感器容易受到周围环境的干扰,因为地磁场非常弱,强度范围为毫高斯到8高斯。

尽管有这些缺点,仍然可以在许多情况下使用,例如户外、低EMI环境等。将地磁传感器与IMU进行松耦合,就可以在大多数环境中使用这类传感器。

在本文中,我们使用PNI传感器公司的高性能电子罗盘传感器RM3100,它提供了24位分辨率。PNI使用主动激励法来提高抗噪声能力。

罗盘传感器的校准

在使用罗盘传感器之前,需要对其进行校准以消除两个主要误差。一个是失调误差,这原本是由传感器和电路的失调误差引起的。另一个是标度误差。这两种误差都容易受到周围磁环境的干扰。例如,如果有一个x轴向的外部磁场施加到传感器上,就会给出外部x轴失调误差。同时,x轴标度也将与y轴和z轴不同。

通常用于校准磁传感器的方法是在xy平面上转动传感器绕圈,然后抽取数据。一个地点的地磁场强度是一个常数值,因此绘制的数据应该是一个圆;然而,事实上,我们将看到一个椭圆形,这意味着我们需要移动椭圆并重新缩放到以零为中心的圆。

上述2D校准方法有一些缺点,并且需要用加速器来测量其倾斜度。我们使用3D球面拟合方法来校准罗盘传感器。首先,我们需要将传感器旋转到x-y-z空间中的每个方向,并在3D坐标中绘制其值。然后我们需要使用最小平方误差(MSE)方法将数据拟合为椭球面。

椭球方程可以表示为

Equation 1

其中,X、Y和Z是罗盘输出在三个方向上的地磁分量。将这些值拟合为椭球面意味着,我们需要得到一组最优系数解。我们将系数定义为:

Text Equation 1

在拟合时,我们定义向量:

Text Equation 2

所以我们需要计算最优σ,并使用公式2来找出最小值:

Equation 2

这样我们就可以得到图1所示的拟合结果。

234033-fig-01


图1. 原始罗盘数据分布(左)和使用椭球拟合后的罗盘数据(右)。

为了校准传感器,我们需要拉伸或压缩拟合的椭球面并将其移至以零为中心的球面上。我们使用矩阵奇异值分解(SVD)方法来进行这种校准。校准后的球体如图2所示。1,2

234033-fig-02


图2. 用SVD方法进行球体校准后的罗盘数据。

校准后,我们可以看到,测得的磁场强度(球半径)几乎恒定不变,如图3所示。

234033-fig-03


图3. 校准前和校准后的磁场比较。

使用ADIS16470和罗盘的姿态和航向参考系统

AHRS由三个轴上的传感器组成,提供姿态信息,包括横滚角、俯仰角和偏航角。AHRS是一个来自飞机导航的概念。我们用它来描述方向,即姿态。

在介绍我们的方法之前,有必要首先解释为什么确定姿态需要进行融合。事实上,我们的系统现在有三种传感器:陀螺仪、加速器和罗盘(地磁传感器)。

陀螺仪提供围绕各轴的旋转角速度。通过角速率积分计算,我们可以得到旋转角度。如果我们知道初始航向,通过角度就始终能够得到航向姿态。积分将累积陀螺仪的不稳定零偏,这将导致角度误差。此外,来自陀螺仪的高斯分布噪声将积分成一个布朗运动过程,并导致随机游走误差。因此,我们很难长时 间使用陀螺仪,陀螺仪需要定期校准。

加速度计提供每个轴方向的移动加速度。在静态状态下,我们可以得到每个轴与重力加速度之间的角度。由于重力加速度在方向和值上恒定不变,我们可以获得相对于重力方向的航向姿态。然而,该方法使用重力加速度作为参考,因此不能解出围绕重力加速度旋转的角度。

罗盘提供从地磁场投影的每个轴的值。我们可以从每个轴与恒为常数向量的地磁场方向之间的关系推导出角度值。如前一节所述,由于对外部磁场的抗扰性较差,罗盘需要一个低干扰的环境。

从这一解释中,我们可以看到,很难靠一个传感器来找到姿态,我们需要组合使用两个或三个传感器并把信息融合起来。本文用加速度计、陀螺仪和地磁罗盘查找姿态。这种融合也被称为磁、角速率和重力(MARG)系统。

扩展卡尔曼滤波器的设计与传感器融合

有多种方法可以将IMU和罗盘数据融合起来,例如互补滤波器、统计学ARMA滤波器,卡尔曼滤波器等。我们在本文中使用的是扩展卡尔曼滤波器。

首先,我们需要介绍本文中使用的一些定义。

坐标定义

T航向或方向是两个坐标(即坐标系)之间的关系。一个坐标总在变化,另一个坐标保持不变。对于坐标定义方法,我们使用导航坐标和体坐标。与东北地(NED)坐标系或地理方法相反,我们将测量的初始体坐标值定义为导航坐标系,此后该坐标为恒定坐标。从体坐标到导航坐标的映射(投影)矩阵定义为

Text Equation 3

姿态定义

与欧拉角或方向余弦矩阵(DCM)不同,我们在这里使用四元数,定义为

Text Equation 4

常用于导航以避免奇异性。

用卡尔曼滤波器更新姿态

我们在本文中使用的运动学方程(即状态转移方程)是非线性微分方程,因此需要使用一个EKF,用于对该微分方程进行一阶近似。对于EKF设计,我们定义

Text Equation 5

一个1×7向量作为状态变量,其中

Text Equation 6

为角速率;

Text Equation 7

为姿态四元数。

Text Equation 8

一个1×7向量作为观测变量,与状态变量具有相同的分量。

Text Equation 9

一个7×7矩阵作为状态转移矩阵,其中,A的第一部分是角速率的数字化微分方程,第二部分是数字化四元数更新方程,后者从运动学方程推导而来。

Text Equation 10

一个7×7矩阵作为观察矩阵。

Text Equation 11

为误差协方差矩阵,这是一个7×7矩阵,其中e估计向量 真实值xx之间的误差我们在测试中将初始误差设为相对较小的值。该值会自动收敛到一个小值。

R,Q被设为状态转移噪声和观测噪声的协方差矩阵。我们得到它们的初始值,

R0和Q0在保持IMU和罗盘处于静止状态的同时,通过测量陀螺仪和加速器的交流均方根值的平方得到。我们设

R0 = Q0

根据以上定义,卡尔曼滤波器将通过以下五个步骤完成:

步骤1:使用公式3计算卡尔曼增益K

Equation 3

步骤2:计算误差协方差矩阵,P:

Equation 4

步骤3:输出估算状态:

Equation 5

步骤4:更新状态:

Equation 6

步骤5:更新误差协方差矩阵P:

Equation 7

该过程可以简单地描述为图4中的框图。

234033-fig-04


图4. 用于更新姿态的卡尔曼滤波器流程图。


篇幅有限,可下载PDF原文阅读 

基于IMU和地磁传感器的捷联惯性导航系统_cn.pdf


美国PNI电子罗盘选型表

laoguo 发表了文章 • 0 个评论 • 749 次浏览 • 2020-08-05 19:22 • 来自相关话题

PNI电子罗盘选型表


Prime(PNI三轴电子倾角补偿电子罗盘)


PRIME是一款超高性价比的3轴电子罗盘模块,在任何GPS信号不佳或GPS无信号的情况下PNI的CompassPoint PRIME提供俯仰,滚转和罗盘航向。


TCM(PNI TCM系列电子罗盘)


PNI TCM电子罗盘拥有多种系列,包括TCM2.5、TCM2.6、TCM3、TCM5、TCMXB、TCMMB等,TCM系列电子罗盘能够提供无与伦比的成本效益和性能,TCM系列电子罗盘由PNI专利技术的磁传感技术和三轴加速度传感器组成。 PRIME是一款超高性价比的3轴电子罗盘模块,在任何GPS信号不佳或GPS无信号的情况下PNI的CompassPoint PRIME提供俯仰,滚转和罗盘航向。


SeaTRAX(PNI三轴电子罗盘SeaTRAX系列)


SeaTRAX模块是一款高性能、适用于海上地震拖揽系统的低价位三轴电子罗盘。我们知道,通常磁航向测量传感器由于其价格昂贵,很难大量应用,但是PNI的SeaTRAX系列磁感应罗盘模块,在满足严格的拖揽模块规格的情况下,提供了非常合理的价格。


TRAX2(AHRS姿态检测系统TRAX模块)


PIN的Trax AHRS姿态检测模块,在静态和经过或通过磁性失真区域时,能够提供了无与伦比的航向精度。PNI将其专利技术设计的磁传感器和陀螺与加速度传感器集成到Trax AHRS姿态检测模块。TRAX AHRS姿态检测模块采用了PNI专利的卡尔曼滤波算法,巧妙地过滤了由于不稳定运动和磁场变化引起的误差。虽然TRAX面向于商业用途,但它提供的航向信息,比成本贵它两倍的传统AHRS(航姿检测系统)传感器系统更可靠。


TargetPoint(美国PNI三轴电子罗盘TargetPoint DMC系列模块)


美国PNI公司TargetPoint DMC模块提供无与伦比的准确性和可靠性,即使在恶劣的环境下,也能拥有完美的表现性能。TargetPoint三轴罗盘将PNI专利技术的磁传感器和三轴MEMS加速度传感器结合在一起,提供了绝佳的成本效益和性能。TargetPoint电子罗盘模块成为远目标定位器、激光测距仪等需要高可靠性、高性能等应用的理想选择。


磁传感器应用方面的设计专家,极大的提升整个传感器系统的性能,精通于各种复杂的磁场问题解决,在消费类、军用、工业科技类市场的磁传感器及传感器系统供应商的领导者。