forward and inverse kinematics compsci 184 5985777