Unifying scene registration and trajectory optimization for learning from demonstrations with application to manipulation of deformable objects.