Contains the code with everything including altitude hold, collission avoidance etc working extremely fine