Update build_urdfdom