An Adaptive 6-DOF Tracking Method by Hybrid Sensing for Ultrasonic Endoscopes

Sensors

Chengyang Du²  Xiaodong Chen¹  Yi Wang²  Junwei Li² 

[1]Key Laboratory of Opto-Electronics Information Technology of Ministry of Education, College of Precision Instrument and Opto-Electronics Engineering, Tianjin University, Tianjin 300072, China

关键词: ultrasonic endoscope;    orientation;    position;    hybrid sensing;    disturbances;   

DOI  :  10.3390/s140609961

来源: mdpi

【 摘 要 】

In this paper, a novel hybrid sensing method for tracking an ultrasonic endoscope within the gastrointestinal (GI) track is presented, and the prototype of the tracking system is also developed. We implement 6-DOF localization by sensing integration and information fusion. On the hardware level, a tri-axis gyroscope and accelerometer, and a magnetic angular rate and gravity (MARG) sensor array are attached at the end of endoscopes, and three symmetric cylindrical coils are placed around patients' abdomens. On the algorithm level, an adaptive fast quaternion convergence (AFQC) algorithm is introduced to determine the orientation by fusing inertial/magnetic measurements, in which the effects of magnetic disturbance and acceleration are estimated to gain an adaptive convergence output. A simplified electro-magnetic tracking (SEMT) algorithm for dimensional position is also implemented, which can easily integrate the AFQC's results and magnetic measurements. Subsequently, the average position error is under 0.3 cm by reasonable setting, and the average orientation error is 1° without noise. If magnetic disturbance or acceleration exists, the average orientation error can be controlled to less than 3.5°.

【 授权许可】

CC BY   
© 2014 by the authors; licensee MDPI, Basel, Switzerland.