Research on 3D Simulation System and Algorithm for Robot Teleoperation