MAV main logic

Wrote a bunch of TODOs describing the main logic of the program.