Implementation of urdf parser for hpp-model