Flight code for MIT CSAIL Robot Locomotion Group flying-through-forests project