Motion Planning For Humanoid Robots door