test against forward kinematics

[liquidcronos]

the current testing regime validates the models and therefore inverse and forward kinematics against a known model.

However, this method does not evaluate the precision of the inverse solver itself.

For this a seperate test should be set up where the inverse solution of a robot is tested against its forward solution