Survey of Robot 3D Path Planning Algorithms

Figure 11

Basic optimization problem steps.