Complete the test set

[Yuki-cpp]

Original opw kinematics repo provides more tests and we should do so here too:
We should add:

• More robot ik vs fk tests
• Tests against k (kinematics crate)