Kinematics Modeling and Analysis of MOTOMAN-HP20 Robot