引用本文: | 夏睿灿,裴海龙.基于混合运动模型的相对状态估计[J].控制理论与应用,2024,41(7):1207~1215.[点击复制] |
XIA Rui-can,PEI Hai-long.Relative state estimation based on hybrid kinematic model[J].Control Theory and Technology,2024,41(7):1207~1215.[点击复制] |
|
基于混合运动模型的相对状态估计 |
Relative state estimation based on hybrid kinematic model |
摘要点击 366 全文点击 125 投稿时间:2023-09-09 修订日期:2024-06-23 |
查看全文 查看/发表评论 下载PDF阅读器 |
DOI编号 DOI: 10.7641/CTA.2024.30613 |
2024,41(7):1207-1215 |
中文关键词 相对状态估计 多机器人协同 虚拟现实 扩展卡尔曼滤波器 传感器融合 |
英文关键词 relative state estimation multi-robot collaboration virtual reality extended Kalman filter sensor fusion |
基金项目 国家重点研发计划项目(2023YFB4704900), 航空科学基金项目(20220056060001), 国家自然科学基金重大科研仪器研制项目(61527810), 中国高 校产学研创新基金新一代信息技术创新项目(2022IT046), 中央高校基本科研业务费专项资金资助. |
|
中文摘要 |
相对状态的精确估计通常依赖参考平台准确的角加速度, 在航天场景由外力矩计算, 而在日常环境中由于未知阻力普遍存在, 准确的外力矩难以获取, 角加速度一般由角速度差分近似, 导致相对状态估计精度下降. 对此,本文构建一种仅依赖惯性测量的相对运动模型, 称为混合运动模型, 其将恒定加速度模型与向量运动学结合, 在独立于力矩和惯性状态的情况下, 精确预测相对状态. 此外, 本文设计扩展卡尔曼滤波器(EKF), 将该运动模型与视觉相对观测结合, 实现高精度相对状态估计, 并以仿真和实际数据评估其性能. 仿真实验从轨迹动态特性和相对观测丢失的角度对比该EKF和目前先进的方法, 结果证明本文提出的方案具有较高的精度和稳定性. 实际实验利用本方法实现虚拟现实应用中的六自由度手柄视觉跟踪, 验证其具备先进的毫米级定位精度, 演示链接见https://www.bilibili.com/video/BV1mv4y1d7iD/. |
英文摘要 |
The accurate estimation of relative state typically relies on the precise angular acceleration of a reference platform, which is calculated by applied torque in aerospace scenarios. However, since unknown resistances are common in daily environments, the precise applied torque is almost inaccessible and the angular acceleration is generally approximated through differential angular velocity, resulting in decreased accuracy of relative state estimation. For this issue, this paper introduces a novel relative motion model called the hybrid kinematic model that solely relies on inertial measurements. By incorporating the uniformly accelerated linear motion model with vector kinematics, it accurately predicts relative states independent of the torque and inertia states. Besides, an extended Kalman filter (EKF) is introduced to seamlessly integrate the kinematic model with visual relative observations, thereby achieving precise estimation of relative states. The effectiveness of this approach is assessed using both synthetic and real data. Simulation experiments compare the EKF with advanced methods in terms of trajectory dynamics and relative observations loss, demonstrating that the proposed solution offers superior accuracy and stability. In practical experiments, this method is utilized to implement visual tracking of a sixdegree-of-freedom controller in virtual reality applications, validating its exceptional millimeter-level positioning accuracy. The demonstration can be found at https://www.bilibili.com/video/BV1mv4y1d7iD/. |
|
|
|
|
|