KDL is up and running in tests. test_kdl_planning_main.cpp gives an example of controlling the robot using the controllers in control.{h,cpp} following an iteratively replanned trajectory generated using Jacobian pseudoinverse control. The controllers send finite-differenced 0.1 timestep joint positions, velocities, and accelerations. The current setup has the thumb moving to a point in cartesian space.