rrlp-ephemeris: Add support for filling ReferenceTime IE

Signed-off-by: Sylvain Munaut <tnt@246tNt.com>

1 files changed, 5 insertions, 4 deletions

diff --git a/rrlp.c b/rrlp.c
index 5e55d1d..e60c3ab 100644
--- a/rrlp.c
+++ b/rrlp.c
@@ -430,16 +430,17 @@ _rrlp_add_reference_time(
 {
 	struct ReferenceTime *rrlp_reftime;
 
-	/* FIXME: Check if info is in gps_ad */
+	if (!(gps_ad->fields & GPS_FIELD_REFTIME))
+		return -EINVAL;
 
 	rrlp_reftime = calloc(1, sizeof(*rrlp_reftime));
 	if (!rrlp_reftime)
 		return -ENOMEM;
 	rrlp_gps_ad->controlHeader.referenceTime = rrlp_reftime;
 
-	/* FIXME */
-//	rrlp_reftime.gpsTime.gpsTOW23b = g_gps_tow / 80;	/* 23 bits */
-//	rrlp_reftime.gpsTime.gpsWeek   = g_gps_week & 0x3ff;	/* 10 bits */
+	rrlp_reftime->gpsTime.gpsWeek   = gps_ad->ref_time.wn & 0x3ff; /* 10b */
+	rrlp_reftime->gpsTime.gpsTOW23b =
+		((int)floor(gps_ad->ref_time.tow / 0.08)) & 0x7fffff;  /* 23b */
 
 	return 0;
 }