Added timestamp to the mavlink message we forward