Liu Xu, Zhang Yongshun, Wang Qiancheng
State Key Laboratory of High-Performance Precision Manufacturing, Dalian University of Technology, Dalian 116024, China.
Micromachines (Basel). 2025 Apr 20;16(4):485. doi: 10.3390/mi16040485.
Posture detection is essential for capsule robots to be manipulated in a relatively closed gastrointestinal (GI) tract and to fulfill some medical operations. In this paper, a posture detection technique for a magnetic-actuated dual-hemisphere capsule robot (DHCR) is proposed. In this method, the DHCR realizes fixed-point posture adjustment based on tracking effects, and feature points are recognized and matched with the help of the ORB algorithm on the GI image acquired by a vision sensor. The system model is derived from the dynamic model and feature point information. Then, the posture is optimized by using the adaptive extended Kalman filter (AEKF) algorithm. As a result, the posture detection method based on the tracking effects and the ORB-AEKF algorithm is formed. The effectiveness and superiority of the proposed method are verified through experiments, which provide a good foundation for the subsequent, accurate closed-loop control of the DHCR.
姿态检测对于胶囊机器人在相对封闭的胃肠道中进行操作并完成一些医疗手术至关重要。本文提出了一种用于磁驱动双半球胶囊机器人(DHCR)的姿态检测技术。在该方法中,DHCR基于跟踪效果实现定点姿态调整,并借助视觉传感器采集的胃肠道图像上的ORB算法识别和匹配特征点。系统模型由动态模型和特征点信息推导得出。然后,使用自适应扩展卡尔曼滤波器(AEKF)算法对姿态进行优化。结果,形成了基于跟踪效果和ORB-AEKF算法的姿态检测方法。通过实验验证了所提方法的有效性和优越性,为后续对DHCR进行精确的闭环控制奠定了良好基础。