Revert "Trimmed the branch to only the tools/rosgraph sub directory"

This reverts commit 126746a0dac14f94298587148994cf9c2742b9ae.
Rebase from 'upstream' @ version '1.9.40'
Trimmed the branch to only the tools/rosgraph sub directory