Fix CMake file to correctly find debug versions of urdfdom libraries