针对几何、质量特性参数均未知的空间碎片,提出一种基于扩展卡尔曼滤波(EKF)的相对位姿估计算法。该算法以单目相机获得的目标图像特征视线信息作为测量输入,以目标姿态、姿态角速度、惯量比、相对位置、相对速度和特征位置作为滤波状态。对算法进行可观性分析,给出两个可以保证算法可观性的条件。分别针对不同条件进行数值仿真,仿真结果表明新算法能够对几何和质量参数未知的空间碎片进行有效的相对位姿估计。
科研之友
微信
新浪微博
Facebook
分享链接
