Vision-based six-dimensional peg-in-hole for practical connector insertion