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

    公开(公告)号:CN117643502A

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

    申请号:CN202311661557.5

    申请日:2023-12-06

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

    一种基于天线阵列的单基站UWB/惯性融合导航方法

    公开(公告)号:CN116164738A

    公开(公告)日:2023-05-26

    申请号:CN202310117520.X

    申请日:2023-02-15

    Abstract: 本发明公开了一种基于天线阵列的单基站UWB/惯性融合导航方法,属于组合导航领域。本发明采集k时刻UWB基站与标签间的距离数据、UWB基站阵列天线接收到的载波相位数据、加速度计数据以及陀螺仪数据;判断导航系统是否初始化,若已经初始化,利用阵列天线接收到的载波相位数据解算标签在UWB坐标系下的方位角、俯仰角信息,利用惯性传感器数据进行相邻UWB测量帧之间的预积分;联合UWB测距、测角误差和惯性预积分误差对载体导航信息进行优化求解;输出载体的导航信息。本发明克服了多基站UWB/惯性融合方法在基站安装部署、时间同步等方面的不足,并通过紧耦合的方式对载体位姿进行全局优化求解,提高了导航精度。

Patent Agency Ranking