整体思路 状态估计的本质是最大后验估计，联合概率密度函数一步步转化到标量函数的和，最后线性化迭代求解。 \[\begin{align} P(X|Z) &\propto P(X|Z)P(Z) \\ &= P(Z|X)P(X) \\ &= P(X) \prod P(z_{i}|x_{\{j\}}) \end{align}\] 利用负对数将乘积转化为加法，我们称之为 损失函数，每一个 $h$ 称之为残差函数，而残差函数的输入是流形，但输出一般已经在欧式空间上了，因此可以使用最原始的加减符号： \[\begin{align}...
state estimate back end
IMU Preintegration
从因子图的角度来看，IMU 预积分解决的问题是：约束的表达式与状态变量的值有关，也就是当状态变量更新后， 约束的表达式变化了，此时需要重新计算约束表达式里的一些参数，而不是能够重复利用固定的约束表达式。 而预计分则可以让原本会变的约束表达式变成固定的表达式，与状态变量无关。 预积分整体的推导思路 从两个最基本的方程组出发，一个是动力学方程组，另一个是最原始的测量方程组，之后利用匀速旋转和加速度的假设，进行普通的积分，然后将状态的增量都变换到相邻两帧中的第一帧机体坐标系下，再经过一系列的移项构造，使得方程右侧的参数可从上到下依次计算得出，且与状态无关，从而保证了状态在优化后发生值的变动，不会导致预计分方程右侧需要重新计算。 首先从最基本的动力学方程出发 \[\dot{R} = R [\omega] \\ \dot{v} = a \\ \dot{p} = v\] 其中，$R$...
Search Plan in Project XI35
八架无人机，分为三组，需要在一个矩形拒止区域内搜索 0.5m*0.5m 大小的数字标识，数字对应于自身的组别。 策略 尽量少转弯，以节约电量、降低里程计崩溃概率。因此是沿着长边飞行。 有如下三种策略： 无论自己看到，还是别的队伍看到自己所属的地标，立刻飞过去降落 从知道自身地标位置的队伍视角看最贪心，里程计漂移最少 只有自己看到才立刻飞过去，别队看到则记录，待本列搜索区域搜索完成后才前往自身地标 都搜索完本列才去 第二种属于折中，具体考虑这种策略。假设三个数字标识均匀分布。 全覆盖，用时短，目前部署的贪心不保证全覆盖 三种响应 未到边界就降落 到边界已知目标位置 到边界未知位置 三个数字标识的相对位置可简化为九宫格，一共有999=729种可能的布局 都是情况1最好，如下表示： 111:333=27 特定三条带上...
Total views. cowboys. Hits