一种多目标体自适应位姿测量算法

本发明涉及一种多目标体自适应位姿测量算法，属于在轨多目标体身份智能识别与位姿测量领域；在目标体坐标系上任意取4个点，将A1、A2、A3、A4的坐标表示为矩阵形式、、、；将目标体坐标系到母体坐标系的偏差表示为矩阵形式T；结合连续旋转矩阵W，将目标体坐标系下4个点A1、A2、A3、A4转换至母体坐标系中，对应点分别为D1、D2、D3、D4；计算D1、D2、D3、D4对应的坐标值；通过对设定测量过程中的随机测量误差的校准修正和温度的校准修正，得到最终精确的测量值；本发明实现了多目标体同时识别与测量，并不受光照影响。