Text this: Forward kinematics for 6-UPS parallel robot using extra displacement sensor