基于最优视觉伺服的输尿管软镜手术机器人的肾结石自动追踪系统及方法

本发明公开了基于最优视觉伺服的输尿管软镜手术机器人的肾结石自动追踪系统及方法，系统包括：目标识别模块、特征提取模块、姿态求解模块和姿态调整模块；目标识别模块用于获取输尿管腔道以及肾结石的图像数据，并对图像数据进行处理，得到结石目标区域；特征提取模块用于对结石目标区域进行特征提取，得到实际图像位姿的实际图像特征和实际交互矩阵，还用于计算期望图像位姿的期望图像特征和期望交互矩阵；姿态求解模块用于基于实际图像特征、实际交互矩阵、期望图像特征和期望交互矩阵，利用最优控制算法与控制障碍函数计算机器人各关节的运动姿态最优解；姿态调整模块用于基于运动姿态最优解控制机器人的姿态。