Guidance algorithm for complex-shape peg-in-hole strategy based on geometrical information and force control. (17th April 2016)