First of all, let me talk about my overall program design see the diagram, which includes three modules are the actuator module, electromagnet module and serial communication module. The steering gear module is also the most important module, has been successfully made, three steering gear interpolation completed in space to walk any line segment, fixed-point handling and drilling functions.