Streamlined registration
Merge remote-tracking branch 'cmsaunders/master'
implement first fit_position