Add trees

[Leopold Palomo-Avellaneda]

Currently TRAC-IK doesn't handle trees, but the nonlinear optimizer part should be able to easily (so long as there is a forward kinematics solution). So, please, add it. It could very useful to solve grasping problems.