Read ROS time when publishing the message instead of using the handle loop time

[rsiryani]

Even if it's less accurate timing, we should always read the ROS system time when we parse a new message. This will avoid duplicated timestamps in published messages.

It's clearly less accurate (absolute timing) than the current implementation but ROS is not designed for real time nor accurate applications anyway...