Created function to navigate with pitch and roll. Added a function call in main to test navigation.