do not use visual and collision group and remove visual and collision if there is no vertices
fix problem of root coordinates
fix debug message
Merge branch 'hydro-devel-fix-visual-and-collision' of https://github.com/YoheiKakiuchi/robot_model into hydro-devel-fix-visual-and-collision