[C++][Geom parser] Removed boolean root_joint_added while parsing. Geom parser...

[C++][Geom parser] Removed boolean root_joint_added while parsing. Geom parser modified consequently to look for parent of link in pinocchio model  now instead of urdf::tree parent joint.