Added more save to flash functionality and SYNC to the flash structure
Fixed small error in euler2quat
Small gain change
Small fix for the starting guess calculation