The algorithm possesses important value for the analysis and design of the control structure and control algorithm in telepresence telerobot system based on virtual reality technology, especially for the design of human-machine interface in the system.