Added support for frame indices obtained using findFrameInd or findBodyInd again. Acrobot/test/testKinematics passes now, but I'd like to add some more tests that also include the Jacobian and Jacobian_dot_times_v soon.