状态推定装置及状态推定方法与流程

摘要: 本公开涉及对于移动体的包括位置、速度、姿势中的至少一个在内的状态进行推定的状态推定装置。背景技术:1、以往提出了各种使用摄像机和惯性测量装置来推定搭载它们的车辆...
状态推定装置及状态推定方法与流程

本公开涉及对于移动体的包括位置、速度、姿势中的至少一个在内的状态进行推定的状态推定装置。

背景技术:

1、以往提出了各种使用摄像机和惯性测量装置来推定搭载它们的车辆等移动体的包含位置、速度、姿势中的至少一个在内的状态的技术(例如,参照专利文献1等)。惯性测量装置是检测三维惯性运动的装置,将正交三轴方向的平移运动及旋转运动作为惯性数据输出。

2、现有技术文献

3、专利文献

4、专利文献1:日本特开2023-183773号公报

技术实现思路

1、在这种技术中,追求进一步提高推定精度。本公开是鉴于上述例示的情况等而完成的。

2、根据本公开的一个方面,状态推定装置推定移动体的包括位置、速度、姿势中的至少一个在内的状态,所述状态推定装置具备:图像数据取得部,从摄像装置取得图像数据;第一推定部,基于所取得的所述图像数据,计算与所述状态的推定值对应的第一推定值;惯性数据取得部,从惯性测量装置取得惯性数据;第二推定部,基于所取得的所述惯性数据,计算与所述状态的推定值对应的第二推定值;科里奥利力(哥氏力)计算部,基于所取得的所述惯性数据,计算与科里奥利力相当的科里奥利项;以及最终推定部,基于所述第一推定值、所述第二推定值以及所述科里奥利项,计算作为最终的所述状态的推定值的最终推定值。

3、根据本公开的另一个方面,状态推定方法推定移动体的包括位置、速度、姿势中的至少一个在内的状态,在所述状态推定方法中,从摄像装置取得图像数据,基于所取得的所述图像数据,计算与所述状态的推定值对应的第一推定值,从惯性测量装置取得惯性数据,基于所取得的所述惯性数据,计算与所述状态的推定值对应的第二推定值,基于所取得的所述惯性数据,计算与科里奥利力相当的科里奥利项,基于所述第一推定值、所述第二推定值以及所述科里奥利项,计算作为最终的所述状态的推定值的最终推定值。

1.一种状态推定装置,

2.根据权利要求1所述的状态推定装置,

3.根据权利要求1或2所述的状态推定装置,

4.根据权利要求1或2所述的状态推定装置,

5.一种状态推定方法,推定移动体的包含位置、速度、姿势中的至少一个在内的状态,

6.根据权利要求5所述的状态推定方法,

7.根据权利要求5或6所述的状态推定方法,

8.根据权利要求5或6所述的状态推定方法,

9.一种状态推定程序产品,包含用于使处理器执行的指令,所述状态推定程序产品被存储于存储介质以推定移动体的包含位置、速度、姿势中的至少一个在内的状态,