Created a test program for the KDL search solver.

Steps through joint space, trying to solve IK.
Merge branch 'grasp-controller' of github.com:evenator/cwru-ros-pkg into grasp-controller