Simplified 7dof kdl chain test

see #2