MAV comments

Commented and organized the code