Fixed NVIC_priority, added navigation task, defining navagation structure
initialized nav struct