General redesign of KDL::CoDyCo::TreeGraph data structure using indeces instead of maps, change joints into junctions to avoid confusion with upstream KDL concept, added junctions serialization