Posture Dynamic Modeling and Stability Analysis of a Magnetic Driven Dual-Spin Spherical Capsule Robot

摘要

In order to realize the intervention operation in the unstructured and ample environments such as stomach and colon, a dual-spin spherical capsule robot (DSCR) driven by pure magnetic torque generated by the universal rotating magnetic field (URMF) is proposed. The coupled magnetic torque, the viscoelastic friction torque, and the gravity torque were analyzed. Furthermore, the posture dynamic model describing the electric-magnetic-mechanical-liquid coupling dynamic behavior of the DSCR in the gastrointestinal (GI) tract was established. This model is a second-order periodic variable coefficient dynamics equation, which should be regarded as an extension of the Lagrange case for the dual-spin body system under the fixed-point motion, since the external torques were applied. Based on the Floquet-Lyapunov theory, the stability domain of the DSCR for the asymptotically stable motion and periodic motion were obtained by investigating the influence of the angular velocity of the URMF, the magnetic induction intensity, and the centroid deviation. Research results show that the DSCR can realize three kinds of motion, which are asymptotically stable motion, periodic motion, and chaotic motion, according to the distribution of the system characteristic multipliers. Moreover, the posture stability of the DSCR can be improved by increasing the angular velocity of the URMF and reducing the magnetic induction intensity.