Optimal motion planning of peg-in-hole task based on mixed logical dynamical system theory | IEEE Conference Publication | IEEE Xplore