Helicopter controls redone

terrain avoidance and rotation