A Compensation Method for Magnetic Localization on Capsule Robot in Medical Application

摘要

Aiming at the magnetic positioning accuracy of capsule robot and the magnetic coupling between capsule robot and external driving magnetic field, according to the requirements of capsule robot for position and attitude information, a magnetic positioning compensation method of capsule robot based on magnetic driving system is proposed. This method deduces the error formula according to the magnetic dipole model, optimizes the formula, reduces the number of unknowns, optimizes the calculation process and improves the positioning accuracy. At the same time, a compensation is added to solve the magnetic coupling problem between the external driving magnetic field three-axis Helmholtz coil and the capsule robot. Finally, several groups of experiments verify the effectiveness of the algorithm.