use rostime instead of systemtime
this is important for simulation and might be important for synchronisation
Removed unused old `getTimeStamp()` function