finished the kdl wrapper package. Added an example for the PR2.