3-D Modeling and Planning