orocos_kdl_diamondback_examples