Fixed NVIC_priority, added navigation task, defining navagation structure
initialized nav struct
deleted unused nav_init function
Merge pull request #125 from ming6842/add_OS_for_test

update flight control