Merge pull request #19 from ipa-goa/master

cam3d topic fixes