Trajectory Planning utilizing Characteristics of Force Control for Peg-in-Hole Task