Added forest to to make quadrotor take a swerving path and changed toler...

...ances in runDircolWObs for speed. Added a function to create individual trees and cleaned up forest creation.