diff options
Diffstat (limited to 'vrt/lib')
| -rw-r--r-- | vrt/lib/expanded_if_context_section.cc | 47 |
1 files changed, 44 insertions, 3 deletions
diff --git a/vrt/lib/expanded_if_context_section.cc b/vrt/lib/expanded_if_context_section.cc index 7a8c92dd8..52e15439e 100644 --- a/vrt/lib/expanded_if_context_section.cc +++ b/vrt/lib/expanded_if_context_section.cc @@ -34,6 +34,7 @@ namespace vrt { context_indicator = 0; ref_point_id = 0; + bandwidth = 0; if_ref_freq = 0; rf_ref_freq = 0; rf_ref_freq_offset = 0; @@ -65,12 +66,17 @@ namespace vrt struct unpack_info { const uint32_t *p; - size_t nwords; + const size_t nwords; size_t i; unpack_info(const uint32_t *p_, size_t nwords_) : p(p_), nwords(nwords_), i(0) {} + bool consumed_all() + { + return nwords - i == 0; + } + bool ensure(size_t n) { return (nwords - i) >= n; @@ -138,6 +144,27 @@ namespace vrt return true; } + bool get_nwords(uint32_t *x, unsigned int nw) + { + if (!ensure(nw)) + return false; + + for (unsigned int j = 0; j < nw; j++) + x[j] = ntohl(p[i++]); + + return true; + } + + bool get_formatted_gps(vrt_formatted_gps_t &x) + { + return get_nwords((uint32_t *) &x, 11); + } + + bool get_ephemeris(vrt_ephemeris_t &x) + { + return get_nwords((uint32_t *) &x, 13); + } + }; @@ -217,8 +244,21 @@ namespace vrt if (!u.get_uint32(e->payload_fmt.word0) || !u.get_uint32(e->payload_fmt.word1)) return false; - // FIXME formatted_gps, formatted_ins - // FIXME ecef_ephemeris, rel_ephemeris + if (cif & CI_FORMATTED_GPS) + if (!u.get_formatted_gps(e->formatted_gps)) + return false; + + if (cif & CI_FORMATTED_INS) + if (!u.get_formatted_gps(e->formatted_ins)) + return false; + + if (cif & CI_ECEF_EPHEMERIS) + if (!u.get_ephemeris(e->ecef_ephemeris)) + return false; + + if (cif & CI_REL_EPHEMERIS) + if (!u.get_ephemeris(e->rel_ephemeris)) + return false; if (cif & CI_EPHEMERIS_REF_ID) if (!u.get_int32(e->ephemeris_ref_id)) @@ -227,6 +267,7 @@ namespace vrt // FIXME gps_ascii // FIXME cntx_assoc_lists + //return u.consumed_all(); return true; } |