一种基于平行四边形集员估计的手术机器人轨迹定位方法

    公开(公告)号:CN117643502A

    公开(公告)日:2024-03-05

    申请号:CN202311661557.5

    申请日:2023-12-06

    Abstract: 本发明公开了一种基于平行四边形集员估计的手术机器人轨迹定位方法,属于多传感器融合领域。标定NDI传感器、手术机器人及器械,采集k时刻双NDI机器人末端位置信息、标记球位置信息;建立平行四边形包络的传感器有界噪声模型、机器人轨迹模型、观测模型;判断传感器信息是否丢失,若未丢失则通过平行四边形交集融合方程进行交集求解,若丢失则维持原包络集合信息进行迭代;此后对融合集合进行优化,求解最小面积平行四边形包络集合;输出平行四边形包络集合、状态估计值和集合面积。本发明克服了术中遮挡等原因带来的定位信息丢失问题,并通过平行四边形包络方法实现了术中光学定位传感器在有界噪声下的准确建模,提高了术中机器人轨迹定位精度。

Patent Agency Ranking