debug and substitute stamp value to header/stamp
Merge pull request #155 from aginika/add-rostime-for-tracking-debug

debug and substitute stamp value to header/stamp