Quad forest

adds an example using the minDistanceConstraint to plan an obstacle-free path with the Quadrotor through a forest (most of the time :)
A little bit of duplicated code between this line and line 59. What are all the magic numbers?