Humanoid Moving through obstacles in 3D-World