Footstep Planning for Autonomous Walking Over Rough Terrain