Path Planning for A Quadruped Robot in 3D Complex Environment : Verification for Trajectory Following Gait