Added antenna on drone - works. Added queues to store antenna data - untested. Added average sonar values and triggers - untested. Missing decicion making