A Marginalized MAP Approach and EM Optimization for Pair-Wise Registration