超声机器人辅助穿刺的避碰和稳定图像控制

Collision Avoidance and Stable Image Control for Ultrasound Robot-assisted Puncture

  • 摘要: 为解决7自由度超声机器人辅助穿刺任务中,零空间避碰反应对超声成像稳定性造成的干扰问题,提出了一种避碰和稳定图像控制方法。首先,建立多点接触条件下的碰撞外力和碰撞定位估计模型,提出一种新的融合外力和外力矩的碰撞阈值判断方法,以区分零空间运动能够避免和无法避免的碰撞情况。其次,设计了一种双尺度视觉伺服控制器,将超声图像时间尺度的稳定性评价和空间尺度的特征块变位引入机器人控制闭环。该控制器能够动态调整探头位置以稳定超声图像。最后,在7自由度超声机器人辅助穿刺平台上进行了避碰和图像稳定实验。实验结果表明,所提方法在机器人运动状态下,碰撞外力估计误差范围在−4.33 N, 5.2 N之内,并能够有效判断碰撞情况,避免机器人受到的外力上升到较大值,从而保证了物理人机交互安全。与力/位混合控制方法相比,所提方法在零空间避碰过程中,图像稳定性评价的平均值提高了35.6%,最大值提高48.5%,并且能够恢复偏离期望状态的超声图像。这些结果验证了所提方法的有效性。

     

    Abstract: To address the issue of interference with ultrasound imaging stability caused by null-space collision avoidance reactions in the 7-DOF ultrasound robot-assisted puncture task, we propose a collision avoidance and image stabilization control method. Firstly, we establish a collision force and collision location estimation model under multi-point contact conditions, and propose a new collision threshold judgment method integrating external force and external torque to distinguish between collision situations that could and could not be avoided by null-space motion. Secondly, we design a dual-scale visual servo controller, incorporating the stability evaluation of the ultrasound image on the temporal scale and the displacement of feature blocks on the spatial scale into the robot's control loop. This controller is capable of dynamically adjusting the probe position to stabilize the ultrasound image. Finally, we conduct collision avoidance and image stabilization experiments on a 7-DOF ultrasound robot-assisted puncture platform. The experimental results show that the proposed method has an external force estimation error range of −4.33 N, 5.2 N during robot motion, and can effectively determine the collision situation to prevent the external force on the robot from rising to a large value, thereby ensuring the safety of physical human-robot interaction. Compared with the force/position hybrid control method, the proposed method achieves a 35.6% increase in the average value and a 48.5% increase in the maximum value of image stability evaluation during null-space collision avoidance. Moreover, it is capable of recovering the ultrasound images that have deviated from the desired state. These results validate the effectiveness of the proposed method.

     

/

返回文章
返回