adding kdl ik solver tests back in
Merge pull request #34 from ros-planning/add_kdl_test

adding kdl ik solver tests back in