Fill stamp of the RobotStatus message Fix: #97

Just edited on a github didn't test it.