More bug Fixes

-Fixed spelling error of 'pitch'
-Fixed scope error of lastStatus
-Fixed declaration error of queues
-Fixed string formatting error of gps data