Multi-Sensor Attitude Computation for Endoscope in Magnetic Interference Environment*

Sen WANG,Xiaodong CHEN,Chengyang DU,Yi WANG,Daoyin YU
DOI: https://doi.org/10.3969/j.issn.1004-1699.2013.08.015
2013-01-01
Abstract:In clinical endoscopy examination,doctors' limited pathology experience can lead to huge subjective error and affect the final diagnosis. Although EMT( Electro-magnetic Tracing) technology could be effective in solving this problem by scientifically tracking the micro endoscopic probe,the precision could decline badly when it is disrupted by ferromagnetism medical instruments and magnetic distortion occurs. In this article, an improved attitude convergence algorithm based on multi-sensor fusion technology is proposed, the system combines inertial measurement with EMT technology,applies quaternion differential equation and two-vector error convergence model to get the stable attitude output;The convergence model is constructed by FQA ( Factored Quaternion Algorithm ) method converging the drift error caused by 3-axis MEMS gyroscope. We also fuse a threshold criterion in case of the hard-over magnetic distortion in order to ensure the overall accuracy and robustness. The preliminary experiment shows that multisensory system possesses good accuracy with angular drift less than 1oand could maintain high anti-interference stability.
What problem does this paper attempt to address?