Added grips forward kinematics