Added a semicolon
Merge branch 'master' of https://github.com/ljhffmn/smd_uav_nav
Pulling updates from upstream
Removed unused variables
Fixed build. Made some lines more readable
Added some comments