Cleaned interface, added forward (position) kinematics solver, moved serialization code to TreeSerialSolver base class