Trajectory Planning and Simulation for Live-Working Robot