add orocos-kdl and smart_arm_planner