Colorectal cancer is a serious threat to human health. Colonoscopy is the most effective procedure for the inspection of colorectal cancer. However, traditional colonoscopy may cause pain, which can lead to the patient’s fear of colonoscopy. The use of active-motion colonoscopy robots is expected to replace traditional colonoscopy procedures for colorectal cancer screening, without causing pain to patients. This paper proposes an inchworm-like soft colonoscopy robot based on a rubber spring. The motion mechanism of the robot consists of two anchoring units and an elongation unit. The elongation unit of the robot is driven by 3 cables during contraction and by its inherent elasticity during extension. The balloon is selected as the anchoring mechanism of the robot. It has soft contact with the colon and will not damage the colon wall, which means no discomfort is caused. The elastic force test of the rubber spring shows that the elongation unit of the robot has sufficient restorative force to drive the robot to move forward and backward. The influence of the balloon’s expansion size on the dexterity of the robot head is analyzed, and the functions of the balloons are expounded. The balloon can not only assist the robot in its locomotion but also assist the robot to perform a better inspection. The robot can move successfully in a horizontal, straight, and inclined isolated pig colon, showing great clinical application potential.

A traveling wave ultrasonic motor (TWUM) with a spherical rotor was designed and fabricated for a haptic interface. The mechanical characteristics testbed was set up to test the performance of the motor under the modulation of frequency and phase difference, as well as for conducting haptic interaction, and the phase difference modulation based on certain frequency was adopted as the driving mode for the proposed motor. Due to the complexity and uncertainty of the contact mechanics of the stator and rotor, the direct torque control effect of the TWUM is not ideal for the force feedback. In this paper, the impedance control method was adopted to realize the force interaction based on positional proportional–integral–derivative (PID) control. The virtual linear spring and virtual wall experiments are conducted to verify the effect of the proposed method. Results show that the position-based impedance control method has a better effect than direct torque control for the haptic interaction based on an ultrasonic motor (USM).