物体姿态测量方法、测量装置、电子设备及存储介质

摘要

本发明提供一种物体姿态测量方法，其包括计算待测量物体的当前状态变量矩阵以及当前状态变量协方差矩阵；计算待测量物体的第一预测状态变量矩阵以及第一预测状态变量协方差矩阵；通过第二传感器，获取待测量物体在待测量物体坐标系中的第二预测位置坐标以及第二预测姿态；计算待测量物体的融合预测状态变量矩阵以及融合预测状态变量协方差矩阵；以及使用待测量物体的融合预测状态变量矩阵以及待测量物体的融合预测状态变量协方差矩阵，获取待测量物体的预测位置坐标以及预测姿态。本发明还提供一种物体姿态测量装置，本发明的物体姿态测量方法及物体姿态测量装置提高了获取的被测物体的姿态位置的准确性。