Reorganizing and adding forward kinematics and jacobian benchmarks.