Moved MSCKF code into its own folder