Break out MCMC into a basic function(s) in its own file

Move the sensing and actuation MCMC code into separate file. Make this measurement agnostic, but it may require a flag to tell what the input data is (a sensing measurement or actuation measurement).