Motion Planning with Environment Uncertainty