Path Planning in U Shape Environment