Merge pull request #127 from retro-wertz/fix_rtps_rtpt