Added code to keep drone steady in the air, average of last two records. Added calculations for block to hold sonars in .m file