General Refactoring, added comments, fixed typos.
Merge branch 'master' of https://github.com/nearengine/cse-capstone-drone