Applied Robotic Systems Lab. , Dept. of Mechanical Eng., Shizuoka University