Caches kinematic solutions from the KDL library for fast lookup