Quadruped Walking Control base on Square-shaped COG Trajectory