Autonomous compliant assembly motion in the presence of uncertainty