Quad forest

adds an example using the minDistanceConstraint to plan an obstacle-free path with the Quadrotor through a forest (most of the time :)
fixed