A compliant motion control for insertion of complex shaped objects using contact