我目前正在开发EKF,以估计四轴飞行器的位置和方向。我的状态向量由3D位置,3D速度,3个欧拉角和角速度向量组成。

现在,我正在研究加速度计的测量方程。

如果我理解正确,那么加速度计将测量“适当的加速度”,而不是坐标加速度,即,它可以测量身体在自由落体坐标系下的加速度。

如果是这种情况,并且假设作用在身体上的唯一力是螺旋桨施加的向上推力,则\ vec {T} $和地球的重力$ m \ vec {g} $,那么我知道,加速度计所能测量的唯一加速度是$ \ vec {T} $引起的加速度(因为自由落体框架无法测量由$ m \ vec {g} $引起的加速度,因为它也在被它加速)。

如果也是这种情况,那么我注意到向量$ \ vec {T} $在身体坐标系(即固定在身体质心且始终与身体方向对齐的坐标系)中表示时,不依赖于任何f各州。例如,如果组装螺旋桨使得$ \ vec {T} $始终垂直于螺旋桨所在的平面,则将车身框架中的$ \ vec {T} $指定为$(0,0,\ alpha)^ T $,其中$ \ alpha $是推力的大小。

这促使我得出以下结论:(由于测得的加速度不取决于状态),我无法使用加速度计测量来获取有关我的任何状态(??)的更多信息。这个结论对我而言似乎是自相矛盾的,这就是为什么我在这里提出这个结论。有人可以在我的推理中指出错误,还是阐明为什么这不是自相矛盾?

评论

评论不作进一步讨论;此对话已移至聊天。

#1 楼

我遇到了同样的难题。一开始我就有一个线索,即由于气动阻力,重力信息包含在加速度计的测量中。然后我找到了论文《加速度传感器反馈在Quadrotor控制中的真正作用》,证明了这一想法。

我的仿真也揭示了稳定过程。只要四旋翼飞机产生的推力不抵消重力,并因此具有非零速度,IMU测得的加速度与由于气动阻力而由推力引起的加速度或多或少有所不同,并倾向于重力矢量的倒数。这种差异使控制器意识到不稳定性并尝试进行纠正。校正后,推力变得更接近重力的倒数,并且抵抗空气阻力的能力降低,这导致阻力对加速度计测量的影响更大。

请注意,空气阻力是如此低速时,四旋翼飞机对重力的了解很少,因此主要取决于陀螺仪以及人工控制或其他速度/位置信息。

#2 楼

如果无人机没有坠落(在天空中保持高度),并且没有在任何特定方向上加速,则加速度计应显示为:

$$
a = \ left [\开始{array} {}
g_x \\
g_y \\
g_z
\ end {array} \ right]
$$

其中$ g_N $是沿每个轴的重力分量。如果无人机竖立且静止,并且加速度计的方向使得z轴指向上方,则加速度计将显示为:

$$
a = \ left [\ begin { array} {}
0 \\
0 \\
g
\ end {array} \ right]
$$

,如果无人机倾斜且没有加速,则重力矢量将出现在不与重力正交的轴上的部分中。

Madgwick过滤器(它的作用非常棒)利用此来确定加速度计的方向。对加速度计进行了归一化,每个轴上的加速度分量给出了方向。

给出方向,减去重力,剩下沿每个轴的加速度。将这些加速度进行两次积分,就可以得到位置。

如果在不与重力成一条直线的特定方向上加速,当然会出现问题,因为对加速度进行归一化将导致“重力”。向量”向运动轴倾斜。但是,通常可以通过将陀螺仪测量结果与方向估算值结合在一起来克服。

同样重要的是要记住,这些都是估算值。除非您具有位置测量或方向测量设备,否则您将永远无法获得测量结果。最好的办法是生成姿态估计,因为无法纠正任何累积的误差。

由于陀螺仪的漂移,陀螺仪的读数通常非常准确,作为短期方位估计值,而作为长期方位估计值则很差。加速度计的重力方向结果由于受传感器运动的影响,通常会导致短期方向测量结果较差,但长期测量结果却非常准确。

因此,在加速度计和陀螺仪之间,您应该能够获得非常好的定向估计值(我是否提到Madgwick过滤器真的很好?不要因为重新发明轮子而自杀;该过滤器是开源的!)。同样,一旦有了方向,就减去重力矢量,只剩下由设备运动引起的加速度。

加速度计也容易受到漂移的影响,因此在任何重要的时间段内,您都不会从加速度计获得任何高精度的位置估计值。

评论


$ \ begingroup $
评论不用于扩展讨论;此对话已移至聊天。
$ \ endgroup $
– Mark Booth♦
16 Dec 2'在17:17

$ \ begingroup $
在堆栈交换中,注释不用于扩展讨论,因为使用Robotics Chat进行讨论。评论有助于改善问题和答案,而且分散了注意力,因此我们尝试将其降至最低。评论应被视为短暂评论,任何不再积极有助于改善问题或答案的评论都可以随时删除以整理帖子。
$ \ endgroup $
– Mark Booth♦
16年2月2日在17:18

#3 楼

加速度计通过增加重力来测量运动加速度。因此,要使加速度测量为0,车辆将需要以$ g $向下加速。要从加速度测量中获得惯性加速度,只需在IMU静止时减去IMU测量的加速度即可。

因此,假设无人机的坐标系与惯性坐标系一致

\ begin {equation}
\ ddot r = z_ {acc} -g
\ end {equation}

其中$ \ ddot r $是无人机在惯性空间中的加速度,$ z_ {accel} $是由IMU测量的加速度矢量, $ g $是车辆相对于惯性系没有加速时经历的加速度矢量。

一旦车辆不再处于水平状态,而是几乎相同,就需要进行转换。

评论


$ \ begingroup $
谢谢您的宝贵时间,但您既未解决我的论点,也未解释悖论。
$ \ endgroup $
– JLagana
16-11-30在21:56

$ \ begingroup $
“仅当IMU静止时,一个人就需要减去IMU测得的加速度”,不幸的是,因为方向可以改变,例如,框架可以倒置并以2G向上加速。看起来好像是直立和静止的。
$ \ endgroup $
–章鱼
16-11-30在23:20