FAST-LIO, Then Bayesian ICP, Then GTSFM