Kinematics now passing tests with basic chains.  Ran into issues with
IK.  Seems that it cannot solve problems with very bad initial
conditions.