The RRT algorithm requires a cost-to-go function in order to determine
the Nearest Neighbour as outlined in Section 2. While performing
the RRT-based search, a cost-to-go function is designed
to minimise turn radius (distance travelled), and also drop in altitude
associated with turning.