From 721cfb36d13b503c0c544e43f84d2bc260c672dc Mon Sep 17 00:00:00 2001
From: "D. Berge" <dberge@aaltronav.eu>
Date: Fri, 6 May 2022 15:02:32 +0200
Subject: [PATCH] Use timestamp from message payload if it has one.

Fixes #221.
---
 lib/www/server/udp/server.js | 7 +++++--
 1 file changed, 5 insertions(+), 2 deletions(-)

diff --git a/lib/www/server/udp/server.js b/lib/www/server/udp/server.js
index be5fc8c..a650e0c 100755
--- a/lib/www/server/udp/server.js
+++ b/lib/www/server/udp/server.js
@@ -74,8 +74,11 @@ function parseMessages (buffer, formats = [ "hydronav", "labo", "smartsource" ])
 						}
 						// else unknown
 					}
-					if (header.tstamp && header._received) {
-						header._latency = header._received - header.tstamp;
+					if (header.tstamp) {
+						navData.tstamp = header.tstamp;
+						if (header._received) {
+							header._latency = header._received - header.tstamp;
+						}
 					}
 					navData.payload.push(header);
 				}