Added roscpp benchmark nodes

Andrea Zoppi