openpilot v0.9.6 release

date: 2024-01-12T10:13:37
master commit: ba792d576a49a0899b88a753fa1c52956bedf9e6

system/ubloxd/.gitignore

@@ -0,0 +1,2 @@
+ubloxd
+tests/test_glonass_runner

system/ubloxd/SConscript

@@ -0,0 +1,20 @@
+Import('env', 'common', 'cereal', 'messaging')
+
+loc_libs = [cereal, messaging, 'zmq', common, 'capnp', 'kj', 'kaitai', 'pthread']
+
+if GetOption('kaitai'):
+  generated = Dir('generated').srcnode().abspath
+  cmd = f"kaitai-struct-compiler --target cpp_stl --outdir {generated} $SOURCES"
+  env.Command(['generated/ubx.cpp', 'generated/ubx.h'], 'ubx.ksy', cmd)
+  env.Command(['generated/gps.cpp', 'generated/gps.h'], 'gps.ksy', cmd)
+  glonass = env.Command(['generated/glonass.cpp', 'generated/glonass.h'], 'glonass.ksy', cmd)
+
+  # kaitai issue: https://github.com/kaitai-io/kaitai_struct/issues/910
+  patch = env.Command(None, 'glonass_fix.patch', 'git apply $SOURCES')
+  env.Depends(patch, glonass)
+
+glonass_obj = env.Object('generated/glonass.cpp')
+env.Program("ubloxd", ["ubloxd.cc", "ublox_msg.cc", "generated/ubx.cpp", "generated/gps.cpp",  glonass_obj], LIBS=loc_libs)
+
+if GetOption('extras'):
+  env.Program("tests/test_glonass_runner", ['tests/test_glonass_runner.cc', 'tests/test_glonass_kaitai.cc', glonass_obj], LIBS=[loc_libs])

system/ubloxd/generated/glonass.cpp

@@ -0,0 +1,353 @@
+// This is a generated file! Please edit source .ksy file and use kaitai-struct-compiler to rebuild
+
+#include "glonass.h"
+
+glonass_t::glonass_t(kaitai::kstream* p__io, kaitai::kstruct* p__parent, glonass_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = this;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void glonass_t::_read() {
+    m_idle_chip = m__io->read_bits_int_be(1);
+    m_string_number = m__io->read_bits_int_be(4);
+    //m__io->align_to_byte();
+    switch (string_number()) {
+    case 4: {
+        m_data = new string_4_t(m__io, this, m__root);
+        break;
+    }
+    case 1: {
+        m_data = new string_1_t(m__io, this, m__root);
+        break;
+    }
+    case 3: {
+        m_data = new string_3_t(m__io, this, m__root);
+        break;
+    }
+    case 5: {
+        m_data = new string_5_t(m__io, this, m__root);
+        break;
+    }
+    case 2: {
+        m_data = new string_2_t(m__io, this, m__root);
+        break;
+    }
+    default: {
+        m_data = new string_non_immediate_t(m__io, this, m__root);
+        break;
+    }
+    }
+    m_hamming_code = m__io->read_bits_int_be(8);
+    m_pad_1 = m__io->read_bits_int_be(11);
+    m_superframe_number = m__io->read_bits_int_be(16);
+    m_pad_2 = m__io->read_bits_int_be(8);
+    m_frame_number = m__io->read_bits_int_be(8);
+}
+
+glonass_t::~glonass_t() {
+    _clean_up();
+}
+
+void glonass_t::_clean_up() {
+    if (m_data) {
+        delete m_data; m_data = 0;
+    }
+}
+
+glonass_t::string_4_t::string_4_t(kaitai::kstream* p__io, glonass_t* p__parent, glonass_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    f_tau_n = false;
+    f_delta_tau_n = false;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void glonass_t::string_4_t::_read() {
+    m_tau_n_sign = m__io->read_bits_int_be(1);
+    m_tau_n_value = m__io->read_bits_int_be(21);
+    m_delta_tau_n_sign = m__io->read_bits_int_be(1);
+    m_delta_tau_n_value = m__io->read_bits_int_be(4);
+    m_e_n = m__io->read_bits_int_be(5);
+    m_not_used_1 = m__io->read_bits_int_be(14);
+    m_p4 = m__io->read_bits_int_be(1);
+    m_f_t = m__io->read_bits_int_be(4);
+    m_not_used_2 = m__io->read_bits_int_be(3);
+    m_n_t = m__io->read_bits_int_be(11);
+    m_n = m__io->read_bits_int_be(5);
+    m_m = m__io->read_bits_int_be(2);
+}
+
+glonass_t::string_4_t::~string_4_t() {
+    _clean_up();
+}
+
+void glonass_t::string_4_t::_clean_up() {
+}
+
+int32_t glonass_t::string_4_t::tau_n() {
+    if (f_tau_n)
+        return m_tau_n;
+    m_tau_n = ((tau_n_sign()) ? ((tau_n_value() * -1)) : (tau_n_value()));
+    f_tau_n = true;
+    return m_tau_n;
+}
+
+int32_t glonass_t::string_4_t::delta_tau_n() {
+    if (f_delta_tau_n)
+        return m_delta_tau_n;
+    m_delta_tau_n = ((delta_tau_n_sign()) ? ((delta_tau_n_value() * -1)) : (delta_tau_n_value()));
+    f_delta_tau_n = true;
+    return m_delta_tau_n;
+}
+
+glonass_t::string_non_immediate_t::string_non_immediate_t(kaitai::kstream* p__io, glonass_t* p__parent, glonass_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void glonass_t::string_non_immediate_t::_read() {
+    m_data_1 = m__io->read_bits_int_be(64);
+    m_data_2 = m__io->read_bits_int_be(8);
+}
+
+glonass_t::string_non_immediate_t::~string_non_immediate_t() {
+    _clean_up();
+}
+
+void glonass_t::string_non_immediate_t::_clean_up() {
+}
+
+glonass_t::string_5_t::string_5_t(kaitai::kstream* p__io, glonass_t* p__parent, glonass_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void glonass_t::string_5_t::_read() {
+    m_n_a = m__io->read_bits_int_be(11);
+    m_tau_c = m__io->read_bits_int_be(32);
+    m_not_used = m__io->read_bits_int_be(1);
+    m_n_4 = m__io->read_bits_int_be(5);
+    m_tau_gps = m__io->read_bits_int_be(22);
+    m_l_n = m__io->read_bits_int_be(1);
+}
+
+glonass_t::string_5_t::~string_5_t() {
+    _clean_up();
+}
+
+void glonass_t::string_5_t::_clean_up() {
+}
+
+glonass_t::string_1_t::string_1_t(kaitai::kstream* p__io, glonass_t* p__parent, glonass_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    f_x_vel = false;
+    f_x_accel = false;
+    f_x = false;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void glonass_t::string_1_t::_read() {
+    m_not_used = m__io->read_bits_int_be(2);
+    m_p1 = m__io->read_bits_int_be(2);
+    m_t_k = m__io->read_bits_int_be(12);
+    m_x_vel_sign = m__io->read_bits_int_be(1);
+    m_x_vel_value = m__io->read_bits_int_be(23);
+    m_x_accel_sign = m__io->read_bits_int_be(1);
+    m_x_accel_value = m__io->read_bits_int_be(4);
+    m_x_sign = m__io->read_bits_int_be(1);
+    m_x_value = m__io->read_bits_int_be(26);
+}
+
+glonass_t::string_1_t::~string_1_t() {
+    _clean_up();
+}
+
+void glonass_t::string_1_t::_clean_up() {
+}
+
+int32_t glonass_t::string_1_t::x_vel() {
+    if (f_x_vel)
+        return m_x_vel;
+    m_x_vel = ((x_vel_sign()) ? ((x_vel_value() * -1)) : (x_vel_value()));
+    f_x_vel = true;
+    return m_x_vel;
+}
+
+int32_t glonass_t::string_1_t::x_accel() {
+    if (f_x_accel)
+        return m_x_accel;
+    m_x_accel = ((x_accel_sign()) ? ((x_accel_value() * -1)) : (x_accel_value()));
+    f_x_accel = true;
+    return m_x_accel;
+}
+
+int32_t glonass_t::string_1_t::x() {
+    if (f_x)
+        return m_x;
+    m_x = ((x_sign()) ? ((x_value() * -1)) : (x_value()));
+    f_x = true;
+    return m_x;
+}
+
+glonass_t::string_2_t::string_2_t(kaitai::kstream* p__io, glonass_t* p__parent, glonass_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    f_y_vel = false;
+    f_y_accel = false;
+    f_y = false;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void glonass_t::string_2_t::_read() {
+    m_b_n = m__io->read_bits_int_be(3);
+    m_p2 = m__io->read_bits_int_be(1);
+    m_t_b = m__io->read_bits_int_be(7);
+    m_not_used = m__io->read_bits_int_be(5);
+    m_y_vel_sign = m__io->read_bits_int_be(1);
+    m_y_vel_value = m__io->read_bits_int_be(23);
+    m_y_accel_sign = m__io->read_bits_int_be(1);
+    m_y_accel_value = m__io->read_bits_int_be(4);
+    m_y_sign = m__io->read_bits_int_be(1);
+    m_y_value = m__io->read_bits_int_be(26);
+}
+
+glonass_t::string_2_t::~string_2_t() {
+    _clean_up();
+}
+
+void glonass_t::string_2_t::_clean_up() {
+}
+
+int32_t glonass_t::string_2_t::y_vel() {
+    if (f_y_vel)
+        return m_y_vel;
+    m_y_vel = ((y_vel_sign()) ? ((y_vel_value() * -1)) : (y_vel_value()));
+    f_y_vel = true;
+    return m_y_vel;
+}
+
+int32_t glonass_t::string_2_t::y_accel() {
+    if (f_y_accel)
+        return m_y_accel;
+    m_y_accel = ((y_accel_sign()) ? ((y_accel_value() * -1)) : (y_accel_value()));
+    f_y_accel = true;
+    return m_y_accel;
+}
+
+int32_t glonass_t::string_2_t::y() {
+    if (f_y)
+        return m_y;
+    m_y = ((y_sign()) ? ((y_value() * -1)) : (y_value()));
+    f_y = true;
+    return m_y;
+}
+
+glonass_t::string_3_t::string_3_t(kaitai::kstream* p__io, glonass_t* p__parent, glonass_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    f_gamma_n = false;
+    f_z_vel = false;
+    f_z_accel = false;
+    f_z = false;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void glonass_t::string_3_t::_read() {
+    m_p3 = m__io->read_bits_int_be(1);
+    m_gamma_n_sign = m__io->read_bits_int_be(1);
+    m_gamma_n_value = m__io->read_bits_int_be(10);
+    m_not_used = m__io->read_bits_int_be(1);
+    m_p = m__io->read_bits_int_be(2);
+    m_l_n = m__io->read_bits_int_be(1);
+    m_z_vel_sign = m__io->read_bits_int_be(1);
+    m_z_vel_value = m__io->read_bits_int_be(23);
+    m_z_accel_sign = m__io->read_bits_int_be(1);
+    m_z_accel_value = m__io->read_bits_int_be(4);
+    m_z_sign = m__io->read_bits_int_be(1);
+    m_z_value = m__io->read_bits_int_be(26);
+}
+
+glonass_t::string_3_t::~string_3_t() {
+    _clean_up();
+}
+
+void glonass_t::string_3_t::_clean_up() {
+}
+
+int32_t glonass_t::string_3_t::gamma_n() {
+    if (f_gamma_n)
+        return m_gamma_n;
+    m_gamma_n = ((gamma_n_sign()) ? ((gamma_n_value() * -1)) : (gamma_n_value()));
+    f_gamma_n = true;
+    return m_gamma_n;
+}
+
+int32_t glonass_t::string_3_t::z_vel() {
+    if (f_z_vel)
+        return m_z_vel;
+    m_z_vel = ((z_vel_sign()) ? ((z_vel_value() * -1)) : (z_vel_value()));
+    f_z_vel = true;
+    return m_z_vel;
+}
+
+int32_t glonass_t::string_3_t::z_accel() {
+    if (f_z_accel)
+        return m_z_accel;
+    m_z_accel = ((z_accel_sign()) ? ((z_accel_value() * -1)) : (z_accel_value()));
+    f_z_accel = true;
+    return m_z_accel;
+}
+
+int32_t glonass_t::string_3_t::z() {
+    if (f_z)
+        return m_z;
+    m_z = ((z_sign()) ? ((z_value() * -1)) : (z_value()));
+    f_z = true;
+    return m_z;
+}

system/ubloxd/generated/glonass.h

@@ -0,0 +1,375 @@
+#ifndef GLONASS_H_
+#define GLONASS_H_
+
+// This is a generated file! Please edit source .ksy file and use kaitai-struct-compiler to rebuild
+
+#include "kaitai/kaitaistruct.h"
+#include <stdint.h>
+
+#if KAITAI_STRUCT_VERSION < 9000L
+#error "Incompatible Kaitai Struct C++/STL API: version 0.9 or later is required"
+#endif
+
+class glonass_t : public kaitai::kstruct {
+
+public:
+    class string_4_t;
+    class string_non_immediate_t;
+    class string_5_t;
+    class string_1_t;
+    class string_2_t;
+    class string_3_t;
+
+    glonass_t(kaitai::kstream* p__io, kaitai::kstruct* p__parent = 0, glonass_t* p__root = 0);
+
+private:
+    void _read();
+    void _clean_up();
+
+public:
+    ~glonass_t();
+
+    class string_4_t : public kaitai::kstruct {
+
+    public:
+
+        string_4_t(kaitai::kstream* p__io, glonass_t* p__parent = 0, glonass_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~string_4_t();
+
+    private:
+        bool f_tau_n;
+        int32_t m_tau_n;
+
+    public:
+        int32_t tau_n();
+
+    private:
+        bool f_delta_tau_n;
+        int32_t m_delta_tau_n;
+
+    public:
+        int32_t delta_tau_n();
+
+    private:
+        bool m_tau_n_sign;
+        uint64_t m_tau_n_value;
+        bool m_delta_tau_n_sign;
+        uint64_t m_delta_tau_n_value;
+        uint64_t m_e_n;
+        uint64_t m_not_used_1;
+        bool m_p4;
+        uint64_t m_f_t;
+        uint64_t m_not_used_2;
+        uint64_t m_n_t;
+        uint64_t m_n;
+        uint64_t m_m;
+        glonass_t* m__root;
+        glonass_t* m__parent;
+
+    public:
+        bool tau_n_sign() const { return m_tau_n_sign; }
+        uint64_t tau_n_value() const { return m_tau_n_value; }
+        bool delta_tau_n_sign() const { return m_delta_tau_n_sign; }
+        uint64_t delta_tau_n_value() const { return m_delta_tau_n_value; }
+        uint64_t e_n() const { return m_e_n; }
+        uint64_t not_used_1() const { return m_not_used_1; }
+        bool p4() const { return m_p4; }
+        uint64_t f_t() const { return m_f_t; }
+        uint64_t not_used_2() const { return m_not_used_2; }
+        uint64_t n_t() const { return m_n_t; }
+        uint64_t n() const { return m_n; }
+        uint64_t m() const { return m_m; }
+        glonass_t* _root() const { return m__root; }
+        glonass_t* _parent() const { return m__parent; }
+    };
+
+    class string_non_immediate_t : public kaitai::kstruct {
+
+    public:
+
+        string_non_immediate_t(kaitai::kstream* p__io, glonass_t* p__parent = 0, glonass_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~string_non_immediate_t();
+
+    private:
+        uint64_t m_data_1;
+        uint64_t m_data_2;
+        glonass_t* m__root;
+        glonass_t* m__parent;
+
+    public:
+        uint64_t data_1() const { return m_data_1; }
+        uint64_t data_2() const { return m_data_2; }
+        glonass_t* _root() const { return m__root; }
+        glonass_t* _parent() const { return m__parent; }
+    };
+
+    class string_5_t : public kaitai::kstruct {
+
+    public:
+
+        string_5_t(kaitai::kstream* p__io, glonass_t* p__parent = 0, glonass_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~string_5_t();
+
+    private:
+        uint64_t m_n_a;
+        uint64_t m_tau_c;
+        bool m_not_used;
+        uint64_t m_n_4;
+        uint64_t m_tau_gps;
+        bool m_l_n;
+        glonass_t* m__root;
+        glonass_t* m__parent;
+
+    public:
+        uint64_t n_a() const { return m_n_a; }
+        uint64_t tau_c() const { return m_tau_c; }
+        bool not_used() const { return m_not_used; }
+        uint64_t n_4() const { return m_n_4; }
+        uint64_t tau_gps() const { return m_tau_gps; }
+        bool l_n() const { return m_l_n; }
+        glonass_t* _root() const { return m__root; }
+        glonass_t* _parent() const { return m__parent; }
+    };
+
+    class string_1_t : public kaitai::kstruct {
+
+    public:
+
+        string_1_t(kaitai::kstream* p__io, glonass_t* p__parent = 0, glonass_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~string_1_t();
+
+    private:
+        bool f_x_vel;
+        int32_t m_x_vel;
+
+    public:
+        int32_t x_vel();
+
+    private:
+        bool f_x_accel;
+        int32_t m_x_accel;
+
+    public:
+        int32_t x_accel();
+
+    private:
+        bool f_x;
+        int32_t m_x;
+
+    public:
+        int32_t x();
+
+    private:
+        uint64_t m_not_used;
+        uint64_t m_p1;
+        uint64_t m_t_k;
+        bool m_x_vel_sign;
+        uint64_t m_x_vel_value;
+        bool m_x_accel_sign;
+        uint64_t m_x_accel_value;
+        bool m_x_sign;
+        uint64_t m_x_value;
+        glonass_t* m__root;
+        glonass_t* m__parent;
+
+    public:
+        uint64_t not_used() const { return m_not_used; }
+        uint64_t p1() const { return m_p1; }
+        uint64_t t_k() const { return m_t_k; }
+        bool x_vel_sign() const { return m_x_vel_sign; }
+        uint64_t x_vel_value() const { return m_x_vel_value; }
+        bool x_accel_sign() const { return m_x_accel_sign; }
+        uint64_t x_accel_value() const { return m_x_accel_value; }
+        bool x_sign() const { return m_x_sign; }
+        uint64_t x_value() const { return m_x_value; }
+        glonass_t* _root() const { return m__root; }
+        glonass_t* _parent() const { return m__parent; }
+    };
+
+    class string_2_t : public kaitai::kstruct {
+
+    public:
+
+        string_2_t(kaitai::kstream* p__io, glonass_t* p__parent = 0, glonass_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~string_2_t();
+
+    private:
+        bool f_y_vel;
+        int32_t m_y_vel;
+
+    public:
+        int32_t y_vel();
+
+    private:
+        bool f_y_accel;
+        int32_t m_y_accel;
+
+    public:
+        int32_t y_accel();
+
+    private:
+        bool f_y;
+        int32_t m_y;
+
+    public:
+        int32_t y();
+
+    private:
+        uint64_t m_b_n;
+        bool m_p2;
+        uint64_t m_t_b;
+        uint64_t m_not_used;
+        bool m_y_vel_sign;
+        uint64_t m_y_vel_value;
+        bool m_y_accel_sign;
+        uint64_t m_y_accel_value;
+        bool m_y_sign;
+        uint64_t m_y_value;
+        glonass_t* m__root;
+        glonass_t* m__parent;
+
+    public:
+        uint64_t b_n() const { return m_b_n; }
+        bool p2() const { return m_p2; }
+        uint64_t t_b() const { return m_t_b; }
+        uint64_t not_used() const { return m_not_used; }
+        bool y_vel_sign() const { return m_y_vel_sign; }
+        uint64_t y_vel_value() const { return m_y_vel_value; }
+        bool y_accel_sign() const { return m_y_accel_sign; }
+        uint64_t y_accel_value() const { return m_y_accel_value; }
+        bool y_sign() const { return m_y_sign; }
+        uint64_t y_value() const { return m_y_value; }
+        glonass_t* _root() const { return m__root; }
+        glonass_t* _parent() const { return m__parent; }
+    };
+
+    class string_3_t : public kaitai::kstruct {
+
+    public:
+
+        string_3_t(kaitai::kstream* p__io, glonass_t* p__parent = 0, glonass_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~string_3_t();
+
+    private:
+        bool f_gamma_n;
+        int32_t m_gamma_n;
+
+    public:
+        int32_t gamma_n();
+
+    private:
+        bool f_z_vel;
+        int32_t m_z_vel;
+
+    public:
+        int32_t z_vel();
+
+    private:
+        bool f_z_accel;
+        int32_t m_z_accel;
+
+    public:
+        int32_t z_accel();
+
+    private:
+        bool f_z;
+        int32_t m_z;
+
+    public:
+        int32_t z();
+
+    private:
+        bool m_p3;
+        bool m_gamma_n_sign;
+        uint64_t m_gamma_n_value;
+        bool m_not_used;
+        uint64_t m_p;
+        bool m_l_n;
+        bool m_z_vel_sign;
+        uint64_t m_z_vel_value;
+        bool m_z_accel_sign;
+        uint64_t m_z_accel_value;
+        bool m_z_sign;
+        uint64_t m_z_value;
+        glonass_t* m__root;
+        glonass_t* m__parent;
+
+    public:
+        bool p3() const { return m_p3; }
+        bool gamma_n_sign() const { return m_gamma_n_sign; }
+        uint64_t gamma_n_value() const { return m_gamma_n_value; }
+        bool not_used() const { return m_not_used; }
+        uint64_t p() const { return m_p; }
+        bool l_n() const { return m_l_n; }
+        bool z_vel_sign() const { return m_z_vel_sign; }
+        uint64_t z_vel_value() const { return m_z_vel_value; }
+        bool z_accel_sign() const { return m_z_accel_sign; }
+        uint64_t z_accel_value() const { return m_z_accel_value; }
+        bool z_sign() const { return m_z_sign; }
+        uint64_t z_value() const { return m_z_value; }
+        glonass_t* _root() const { return m__root; }
+        glonass_t* _parent() const { return m__parent; }
+    };
+
+private:
+    bool m_idle_chip;
+    uint64_t m_string_number;
+    kaitai::kstruct* m_data;
+    uint64_t m_hamming_code;
+    uint64_t m_pad_1;
+    uint64_t m_superframe_number;
+    uint64_t m_pad_2;
+    uint64_t m_frame_number;
+    glonass_t* m__root;
+    kaitai::kstruct* m__parent;
+
+public:
+    bool idle_chip() const { return m_idle_chip; }
+    uint64_t string_number() const { return m_string_number; }
+    kaitai::kstruct* data() const { return m_data; }
+    uint64_t hamming_code() const { return m_hamming_code; }
+    uint64_t pad_1() const { return m_pad_1; }
+    uint64_t superframe_number() const { return m_superframe_number; }
+    uint64_t pad_2() const { return m_pad_2; }
+    uint64_t frame_number() const { return m_frame_number; }
+    glonass_t* _root() const { return m__root; }
+    kaitai::kstruct* _parent() const { return m__parent; }
+};
+
+#endif  // GLONASS_H_

system/ubloxd/generated/gps.cpp

@@ -0,0 +1,325 @@
+// This is a generated file! Please edit source .ksy file and use kaitai-struct-compiler to rebuild
+
+#include "gps.h"
+#include "kaitai/exceptions.h"
+
+gps_t::gps_t(kaitai::kstream* p__io, kaitai::kstruct* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = this;
+    m_tlm = 0;
+    m_how = 0;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::_read() {
+    m_tlm = new tlm_t(m__io, this, m__root);
+    m_how = new how_t(m__io, this, m__root);
+    n_body = true;
+    switch (how()->subframe_id()) {
+    case 1: {
+        n_body = false;
+        m_body = new subframe_1_t(m__io, this, m__root);
+        break;
+    }
+    case 2: {
+        n_body = false;
+        m_body = new subframe_2_t(m__io, this, m__root);
+        break;
+    }
+    case 3: {
+        n_body = false;
+        m_body = new subframe_3_t(m__io, this, m__root);
+        break;
+    }
+    case 4: {
+        n_body = false;
+        m_body = new subframe_4_t(m__io, this, m__root);
+        break;
+    }
+    }
+}
+
+gps_t::~gps_t() {
+    _clean_up();
+}
+
+void gps_t::_clean_up() {
+    if (m_tlm) {
+        delete m_tlm; m_tlm = 0;
+    }
+    if (m_how) {
+        delete m_how; m_how = 0;
+    }
+    if (!n_body) {
+        if (m_body) {
+            delete m_body; m_body = 0;
+        }
+    }
+}
+
+gps_t::subframe_1_t::subframe_1_t(kaitai::kstream* p__io, gps_t* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    f_af_0 = false;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::subframe_1_t::_read() {
+    m_week_no = m__io->read_bits_int_be(10);
+    m_code = m__io->read_bits_int_be(2);
+    m_sv_accuracy = m__io->read_bits_int_be(4);
+    m_sv_health = m__io->read_bits_int_be(6);
+    m_iodc_msb = m__io->read_bits_int_be(2);
+    m_l2_p_data_flag = m__io->read_bits_int_be(1);
+    m_reserved1 = m__io->read_bits_int_be(23);
+    m_reserved2 = m__io->read_bits_int_be(24);
+    m_reserved3 = m__io->read_bits_int_be(24);
+    m_reserved4 = m__io->read_bits_int_be(16);
+    m__io->align_to_byte();
+    m_t_gd = m__io->read_s1();
+    m_iodc_lsb = m__io->read_u1();
+    m_t_oc = m__io->read_u2be();
+    m_af_2 = m__io->read_s1();
+    m_af_1 = m__io->read_s2be();
+    m_af_0_sign = m__io->read_bits_int_be(1);
+    m_af_0_value = m__io->read_bits_int_be(21);
+    m_reserved5 = m__io->read_bits_int_be(2);
+}
+
+gps_t::subframe_1_t::~subframe_1_t() {
+    _clean_up();
+}
+
+void gps_t::subframe_1_t::_clean_up() {
+}
+
+int32_t gps_t::subframe_1_t::af_0() {
+    if (f_af_0)
+        return m_af_0;
+    m_af_0 = ((af_0_sign()) ? ((af_0_value() - (1 << 21))) : (af_0_value()));
+    f_af_0 = true;
+    return m_af_0;
+}
+
+gps_t::subframe_3_t::subframe_3_t(kaitai::kstream* p__io, gps_t* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    f_omega_dot = false;
+    f_idot = false;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::subframe_3_t::_read() {
+    m_c_ic = m__io->read_s2be();
+    m_omega_0 = m__io->read_s4be();
+    m_c_is = m__io->read_s2be();
+    m_i_0 = m__io->read_s4be();
+    m_c_rc = m__io->read_s2be();
+    m_omega = m__io->read_s4be();
+    m_omega_dot_sign = m__io->read_bits_int_be(1);
+    m_omega_dot_value = m__io->read_bits_int_be(23);
+    m__io->align_to_byte();
+    m_iode = m__io->read_u1();
+    m_idot_sign = m__io->read_bits_int_be(1);
+    m_idot_value = m__io->read_bits_int_be(13);
+    m_reserved = m__io->read_bits_int_be(2);
+}
+
+gps_t::subframe_3_t::~subframe_3_t() {
+    _clean_up();
+}
+
+void gps_t::subframe_3_t::_clean_up() {
+}
+
+int32_t gps_t::subframe_3_t::omega_dot() {
+    if (f_omega_dot)
+        return m_omega_dot;
+    m_omega_dot = ((omega_dot_sign()) ? ((omega_dot_value() - (1 << 23))) : (omega_dot_value()));
+    f_omega_dot = true;
+    return m_omega_dot;
+}
+
+int32_t gps_t::subframe_3_t::idot() {
+    if (f_idot)
+        return m_idot;
+    m_idot = ((idot_sign()) ? ((idot_value() - (1 << 13))) : (idot_value()));
+    f_idot = true;
+    return m_idot;
+}
+
+gps_t::subframe_4_t::subframe_4_t(kaitai::kstream* p__io, gps_t* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::subframe_4_t::_read() {
+    m_data_id = m__io->read_bits_int_be(2);
+    m_page_id = m__io->read_bits_int_be(6);
+    m__io->align_to_byte();
+    n_body = true;
+    switch (page_id()) {
+    case 56: {
+        n_body = false;
+        m_body = new ionosphere_data_t(m__io, this, m__root);
+        break;
+    }
+    }
+}
+
+gps_t::subframe_4_t::~subframe_4_t() {
+    _clean_up();
+}
+
+void gps_t::subframe_4_t::_clean_up() {
+    if (!n_body) {
+        if (m_body) {
+            delete m_body; m_body = 0;
+        }
+    }
+}
+
+gps_t::subframe_4_t::ionosphere_data_t::ionosphere_data_t(kaitai::kstream* p__io, gps_t::subframe_4_t* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::subframe_4_t::ionosphere_data_t::_read() {
+    m_a0 = m__io->read_s1();
+    m_a1 = m__io->read_s1();
+    m_a2 = m__io->read_s1();
+    m_a3 = m__io->read_s1();
+    m_b0 = m__io->read_s1();
+    m_b1 = m__io->read_s1();
+    m_b2 = m__io->read_s1();
+    m_b3 = m__io->read_s1();
+}
+
+gps_t::subframe_4_t::ionosphere_data_t::~ionosphere_data_t() {
+    _clean_up();
+}
+
+void gps_t::subframe_4_t::ionosphere_data_t::_clean_up() {
+}
+
+gps_t::how_t::how_t(kaitai::kstream* p__io, gps_t* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::how_t::_read() {
+    m_tow_count = m__io->read_bits_int_be(17);
+    m_alert = m__io->read_bits_int_be(1);
+    m_anti_spoof = m__io->read_bits_int_be(1);
+    m_subframe_id = m__io->read_bits_int_be(3);
+    m_reserved = m__io->read_bits_int_be(2);
+}
+
+gps_t::how_t::~how_t() {
+    _clean_up();
+}
+
+void gps_t::how_t::_clean_up() {
+}
+
+gps_t::tlm_t::tlm_t(kaitai::kstream* p__io, gps_t* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::tlm_t::_read() {
+    m_preamble = m__io->read_bytes(1);
+    if (!(preamble() == std::string("\x8B", 1))) {
+        throw kaitai::validation_not_equal_error<std::string>(std::string("\x8B", 1), preamble(), _io(), std::string("/types/tlm/seq/0"));
+    }
+    m_tlm = m__io->read_bits_int_be(14);
+    m_integrity_status = m__io->read_bits_int_be(1);
+    m_reserved = m__io->read_bits_int_be(1);
+}
+
+gps_t::tlm_t::~tlm_t() {
+    _clean_up();
+}
+
+void gps_t::tlm_t::_clean_up() {
+}
+
+gps_t::subframe_2_t::subframe_2_t(kaitai::kstream* p__io, gps_t* p__parent, gps_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void gps_t::subframe_2_t::_read() {
+    m_iode = m__io->read_u1();
+    m_c_rs = m__io->read_s2be();
+    m_delta_n = m__io->read_s2be();
+    m_m_0 = m__io->read_s4be();
+    m_c_uc = m__io->read_s2be();
+    m_e = m__io->read_s4be();
+    m_c_us = m__io->read_s2be();
+    m_sqrt_a = m__io->read_u4be();
+    m_t_oe = m__io->read_u2be();
+    m_fit_interval_flag = m__io->read_bits_int_be(1);
+    m_aoda = m__io->read_bits_int_be(5);
+    m_reserved = m__io->read_bits_int_be(2);
+}
+
+gps_t::subframe_2_t::~subframe_2_t() {
+    _clean_up();
+}
+
+void gps_t::subframe_2_t::_clean_up() {
+}

system/ubloxd/generated/gps.h

@@ -0,0 +1,359 @@
+#ifndef GPS_H_
+#define GPS_H_
+
+// This is a generated file! Please edit source .ksy file and use kaitai-struct-compiler to rebuild
+
+#include "kaitai/kaitaistruct.h"
+#include <stdint.h>
+
+#if KAITAI_STRUCT_VERSION < 9000L
+#error "Incompatible Kaitai Struct C++/STL API: version 0.9 or later is required"
+#endif
+
+class gps_t : public kaitai::kstruct {
+
+public:
+    class subframe_1_t;
+    class subframe_3_t;
+    class subframe_4_t;
+    class how_t;
+    class tlm_t;
+    class subframe_2_t;
+
+    gps_t(kaitai::kstream* p__io, kaitai::kstruct* p__parent = 0, gps_t* p__root = 0);
+
+private:
+    void _read();
+    void _clean_up();
+
+public:
+    ~gps_t();
+
+    class subframe_1_t : public kaitai::kstruct {
+
+    public:
+
+        subframe_1_t(kaitai::kstream* p__io, gps_t* p__parent = 0, gps_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~subframe_1_t();
+
+    private:
+        bool f_af_0;
+        int32_t m_af_0;
+
+    public:
+        int32_t af_0();
+
+    private:
+        uint64_t m_week_no;
+        uint64_t m_code;
+        uint64_t m_sv_accuracy;
+        uint64_t m_sv_health;
+        uint64_t m_iodc_msb;
+        bool m_l2_p_data_flag;
+        uint64_t m_reserved1;
+        uint64_t m_reserved2;
+        uint64_t m_reserved3;
+        uint64_t m_reserved4;
+        int8_t m_t_gd;
+        uint8_t m_iodc_lsb;
+        uint16_t m_t_oc;
+        int8_t m_af_2;
+        int16_t m_af_1;
+        bool m_af_0_sign;
+        uint64_t m_af_0_value;
+        uint64_t m_reserved5;
+        gps_t* m__root;
+        gps_t* m__parent;
+
+    public:
+        uint64_t week_no() const { return m_week_no; }
+        uint64_t code() const { return m_code; }
+        uint64_t sv_accuracy() const { return m_sv_accuracy; }
+        uint64_t sv_health() const { return m_sv_health; }
+        uint64_t iodc_msb() const { return m_iodc_msb; }
+        bool l2_p_data_flag() const { return m_l2_p_data_flag; }
+        uint64_t reserved1() const { return m_reserved1; }
+        uint64_t reserved2() const { return m_reserved2; }
+        uint64_t reserved3() const { return m_reserved3; }
+        uint64_t reserved4() const { return m_reserved4; }
+        int8_t t_gd() const { return m_t_gd; }
+        uint8_t iodc_lsb() const { return m_iodc_lsb; }
+        uint16_t t_oc() const { return m_t_oc; }
+        int8_t af_2() const { return m_af_2; }
+        int16_t af_1() const { return m_af_1; }
+        bool af_0_sign() const { return m_af_0_sign; }
+        uint64_t af_0_value() const { return m_af_0_value; }
+        uint64_t reserved5() const { return m_reserved5; }
+        gps_t* _root() const { return m__root; }
+        gps_t* _parent() const { return m__parent; }
+    };
+
+    class subframe_3_t : public kaitai::kstruct {
+
+    public:
+
+        subframe_3_t(kaitai::kstream* p__io, gps_t* p__parent = 0, gps_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~subframe_3_t();
+
+    private:
+        bool f_omega_dot;
+        int32_t m_omega_dot;
+
+    public:
+        int32_t omega_dot();
+
+    private:
+        bool f_idot;
+        int32_t m_idot;
+
+    public:
+        int32_t idot();
+
+    private:
+        int16_t m_c_ic;
+        int32_t m_omega_0;
+        int16_t m_c_is;
+        int32_t m_i_0;
+        int16_t m_c_rc;
+        int32_t m_omega;
+        bool m_omega_dot_sign;
+        uint64_t m_omega_dot_value;
+        uint8_t m_iode;
+        bool m_idot_sign;
+        uint64_t m_idot_value;
+        uint64_t m_reserved;
+        gps_t* m__root;
+        gps_t* m__parent;
+
+    public:
+        int16_t c_ic() const { return m_c_ic; }
+        int32_t omega_0() const { return m_omega_0; }
+        int16_t c_is() const { return m_c_is; }
+        int32_t i_0() const { return m_i_0; }
+        int16_t c_rc() const { return m_c_rc; }
+        int32_t omega() const { return m_omega; }
+        bool omega_dot_sign() const { return m_omega_dot_sign; }
+        uint64_t omega_dot_value() const { return m_omega_dot_value; }
+        uint8_t iode() const { return m_iode; }
+        bool idot_sign() const { return m_idot_sign; }
+        uint64_t idot_value() const { return m_idot_value; }
+        uint64_t reserved() const { return m_reserved; }
+        gps_t* _root() const { return m__root; }
+        gps_t* _parent() const { return m__parent; }
+    };
+
+    class subframe_4_t : public kaitai::kstruct {
+
+    public:
+        class ionosphere_data_t;
+
+        subframe_4_t(kaitai::kstream* p__io, gps_t* p__parent = 0, gps_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~subframe_4_t();
+
+        class ionosphere_data_t : public kaitai::kstruct {
+
+        public:
+
+            ionosphere_data_t(kaitai::kstream* p__io, gps_t::subframe_4_t* p__parent = 0, gps_t* p__root = 0);
+
+        private:
+            void _read();
+            void _clean_up();
+
+        public:
+            ~ionosphere_data_t();
+
+        private:
+            int8_t m_a0;
+            int8_t m_a1;
+            int8_t m_a2;
+            int8_t m_a3;
+            int8_t m_b0;
+            int8_t m_b1;
+            int8_t m_b2;
+            int8_t m_b3;
+            gps_t* m__root;
+            gps_t::subframe_4_t* m__parent;
+
+        public:
+            int8_t a0() const { return m_a0; }
+            int8_t a1() const { return m_a1; }
+            int8_t a2() const { return m_a2; }
+            int8_t a3() const { return m_a3; }
+            int8_t b0() const { return m_b0; }
+            int8_t b1() const { return m_b1; }
+            int8_t b2() const { return m_b2; }
+            int8_t b3() const { return m_b3; }
+            gps_t* _root() const { return m__root; }
+            gps_t::subframe_4_t* _parent() const { return m__parent; }
+        };
+
+    private:
+        uint64_t m_data_id;
+        uint64_t m_page_id;
+        ionosphere_data_t* m_body;
+        bool n_body;
+
+    public:
+        bool _is_null_body() { body(); return n_body; };
+
+    private:
+        gps_t* m__root;
+        gps_t* m__parent;
+
+    public:
+        uint64_t data_id() const { return m_data_id; }
+        uint64_t page_id() const { return m_page_id; }
+        ionosphere_data_t* body() const { return m_body; }
+        gps_t* _root() const { return m__root; }
+        gps_t* _parent() const { return m__parent; }
+    };
+
+    class how_t : public kaitai::kstruct {
+
+    public:
+
+        how_t(kaitai::kstream* p__io, gps_t* p__parent = 0, gps_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~how_t();
+
+    private:
+        uint64_t m_tow_count;
+        bool m_alert;
+        bool m_anti_spoof;
+        uint64_t m_subframe_id;
+        uint64_t m_reserved;
+        gps_t* m__root;
+        gps_t* m__parent;
+
+    public:
+        uint64_t tow_count() const { return m_tow_count; }
+        bool alert() const { return m_alert; }
+        bool anti_spoof() const { return m_anti_spoof; }
+        uint64_t subframe_id() const { return m_subframe_id; }
+        uint64_t reserved() const { return m_reserved; }
+        gps_t* _root() const { return m__root; }
+        gps_t* _parent() const { return m__parent; }
+    };
+
+    class tlm_t : public kaitai::kstruct {
+
+    public:
+
+        tlm_t(kaitai::kstream* p__io, gps_t* p__parent = 0, gps_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~tlm_t();
+
+    private:
+        std::string m_preamble;
+        uint64_t m_tlm;
+        bool m_integrity_status;
+        bool m_reserved;
+        gps_t* m__root;
+        gps_t* m__parent;
+
+    public:
+        std::string preamble() const { return m_preamble; }
+        uint64_t tlm() const { return m_tlm; }
+        bool integrity_status() const { return m_integrity_status; }
+        bool reserved() const { return m_reserved; }
+        gps_t* _root() const { return m__root; }
+        gps_t* _parent() const { return m__parent; }
+    };
+
+    class subframe_2_t : public kaitai::kstruct {
+
+    public:
+
+        subframe_2_t(kaitai::kstream* p__io, gps_t* p__parent = 0, gps_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~subframe_2_t();
+
+    private:
+        uint8_t m_iode;
+        int16_t m_c_rs;
+        int16_t m_delta_n;
+        int32_t m_m_0;
+        int16_t m_c_uc;
+        int32_t m_e;
+        int16_t m_c_us;
+        uint32_t m_sqrt_a;
+        uint16_t m_t_oe;
+        bool m_fit_interval_flag;
+        uint64_t m_aoda;
+        uint64_t m_reserved;
+        gps_t* m__root;
+        gps_t* m__parent;
+
+    public:
+        uint8_t iode() const { return m_iode; }
+        int16_t c_rs() const { return m_c_rs; }
+        int16_t delta_n() const { return m_delta_n; }
+        int32_t m_0() const { return m_m_0; }
+        int16_t c_uc() const { return m_c_uc; }
+        int32_t e() const { return m_e; }
+        int16_t c_us() const { return m_c_us; }
+        uint32_t sqrt_a() const { return m_sqrt_a; }
+        uint16_t t_oe() const { return m_t_oe; }
+        bool fit_interval_flag() const { return m_fit_interval_flag; }
+        uint64_t aoda() const { return m_aoda; }
+        uint64_t reserved() const { return m_reserved; }
+        gps_t* _root() const { return m__root; }
+        gps_t* _parent() const { return m__parent; }
+    };
+
+private:
+    tlm_t* m_tlm;
+    how_t* m_how;
+    kaitai::kstruct* m_body;
+    bool n_body;
+
+public:
+    bool _is_null_body() { body(); return n_body; };
+
+private:
+    gps_t* m__root;
+    kaitai::kstruct* m__parent;
+
+public:
+    tlm_t* tlm() const { return m_tlm; }
+    how_t* how() const { return m_how; }
+    kaitai::kstruct* body() const { return m_body; }
+    gps_t* _root() const { return m__root; }
+    kaitai::kstruct* _parent() const { return m__parent; }
+};
+
+#endif  // GPS_H_

system/ubloxd/generated/ubx.cpp

@@ -0,0 +1,424 @@
+// This is a generated file! Please edit source .ksy file and use kaitai-struct-compiler to rebuild
+
+#include "ubx.h"
+#include "kaitai/exceptions.h"
+
+ubx_t::ubx_t(kaitai::kstream* p__io, kaitai::kstruct* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = this;
+    f_checksum = false;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::_read() {
+    m_magic = m__io->read_bytes(2);
+    if (!(magic() == std::string("\xB5\x62", 2))) {
+        throw kaitai::validation_not_equal_error<std::string>(std::string("\xB5\x62", 2), magic(), _io(), std::string("/seq/0"));
+    }
+    m_msg_type = m__io->read_u2be();
+    m_length = m__io->read_u2le();
+    n_body = true;
+    switch (msg_type()) {
+    case 2569: {
+        n_body = false;
+        m_body = new mon_hw_t(m__io, this, m__root);
+        break;
+    }
+    case 533: {
+        n_body = false;
+        m_body = new rxm_rawx_t(m__io, this, m__root);
+        break;
+    }
+    case 531: {
+        n_body = false;
+        m_body = new rxm_sfrbx_t(m__io, this, m__root);
+        break;
+    }
+    case 309: {
+        n_body = false;
+        m_body = new nav_sat_t(m__io, this, m__root);
+        break;
+    }
+    case 2571: {
+        n_body = false;
+        m_body = new mon_hw2_t(m__io, this, m__root);
+        break;
+    }
+    case 263: {
+        n_body = false;
+        m_body = new nav_pvt_t(m__io, this, m__root);
+        break;
+    }
+    }
+}
+
+ubx_t::~ubx_t() {
+    _clean_up();
+}
+
+void ubx_t::_clean_up() {
+    if (!n_body) {
+        if (m_body) {
+            delete m_body; m_body = 0;
+        }
+    }
+    if (f_checksum) {
+    }
+}
+
+ubx_t::rxm_rawx_t::rxm_rawx_t(kaitai::kstream* p__io, ubx_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    m_meas = 0;
+    m__raw_meas = 0;
+    m__io__raw_meas = 0;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::rxm_rawx_t::_read() {
+    m_rcv_tow = m__io->read_f8le();
+    m_week = m__io->read_u2le();
+    m_leap_s = m__io->read_s1();
+    m_num_meas = m__io->read_u1();
+    m_rec_stat = m__io->read_u1();
+    m_reserved1 = m__io->read_bytes(3);
+    m__raw_meas = new std::vector<std::string>();
+    m__io__raw_meas = new std::vector<kaitai::kstream*>();
+    m_meas = new std::vector<measurement_t*>();
+    const int l_meas = num_meas();
+    for (int i = 0; i < l_meas; i++) {
+        m__raw_meas->push_back(m__io->read_bytes(32));
+        kaitai::kstream* io__raw_meas = new kaitai::kstream(m__raw_meas->at(m__raw_meas->size() - 1));
+        m__io__raw_meas->push_back(io__raw_meas);
+        m_meas->push_back(new measurement_t(io__raw_meas, this, m__root));
+    }
+}
+
+ubx_t::rxm_rawx_t::~rxm_rawx_t() {
+    _clean_up();
+}
+
+void ubx_t::rxm_rawx_t::_clean_up() {
+    if (m__raw_meas) {
+        delete m__raw_meas; m__raw_meas = 0;
+    }
+    if (m__io__raw_meas) {
+        for (std::vector<kaitai::kstream*>::iterator it = m__io__raw_meas->begin(); it != m__io__raw_meas->end(); ++it) {
+            delete *it;
+        }
+        delete m__io__raw_meas; m__io__raw_meas = 0;
+    }
+    if (m_meas) {
+        for (std::vector<measurement_t*>::iterator it = m_meas->begin(); it != m_meas->end(); ++it) {
+            delete *it;
+        }
+        delete m_meas; m_meas = 0;
+    }
+}
+
+ubx_t::rxm_rawx_t::measurement_t::measurement_t(kaitai::kstream* p__io, ubx_t::rxm_rawx_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::rxm_rawx_t::measurement_t::_read() {
+    m_pr_mes = m__io->read_f8le();
+    m_cp_mes = m__io->read_f8le();
+    m_do_mes = m__io->read_f4le();
+    m_gnss_id = static_cast<ubx_t::gnss_type_t>(m__io->read_u1());
+    m_sv_id = m__io->read_u1();
+    m_reserved2 = m__io->read_bytes(1);
+    m_freq_id = m__io->read_u1();
+    m_lock_time = m__io->read_u2le();
+    m_cno = m__io->read_u1();
+    m_pr_stdev = m__io->read_u1();
+    m_cp_stdev = m__io->read_u1();
+    m_do_stdev = m__io->read_u1();
+    m_trk_stat = m__io->read_u1();
+    m_reserved3 = m__io->read_bytes(1);
+}
+
+ubx_t::rxm_rawx_t::measurement_t::~measurement_t() {
+    _clean_up();
+}
+
+void ubx_t::rxm_rawx_t::measurement_t::_clean_up() {
+}
+
+ubx_t::rxm_sfrbx_t::rxm_sfrbx_t(kaitai::kstream* p__io, ubx_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    m_body = 0;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::rxm_sfrbx_t::_read() {
+    m_gnss_id = static_cast<ubx_t::gnss_type_t>(m__io->read_u1());
+    m_sv_id = m__io->read_u1();
+    m_reserved1 = m__io->read_bytes(1);
+    m_freq_id = m__io->read_u1();
+    m_num_words = m__io->read_u1();
+    m_reserved2 = m__io->read_bytes(1);
+    m_version = m__io->read_u1();
+    m_reserved3 = m__io->read_bytes(1);
+    m_body = new std::vector<uint32_t>();
+    const int l_body = num_words();
+    for (int i = 0; i < l_body; i++) {
+        m_body->push_back(m__io->read_u4le());
+    }
+}
+
+ubx_t::rxm_sfrbx_t::~rxm_sfrbx_t() {
+    _clean_up();
+}
+
+void ubx_t::rxm_sfrbx_t::_clean_up() {
+    if (m_body) {
+        delete m_body; m_body = 0;
+    }
+}
+
+ubx_t::nav_sat_t::nav_sat_t(kaitai::kstream* p__io, ubx_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+    m_svs = 0;
+    m__raw_svs = 0;
+    m__io__raw_svs = 0;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::nav_sat_t::_read() {
+    m_itow = m__io->read_u4le();
+    m_version = m__io->read_u1();
+    m_num_svs = m__io->read_u1();
+    m_reserved = m__io->read_bytes(2);
+    m__raw_svs = new std::vector<std::string>();
+    m__io__raw_svs = new std::vector<kaitai::kstream*>();
+    m_svs = new std::vector<nav_t*>();
+    const int l_svs = num_svs();
+    for (int i = 0; i < l_svs; i++) {
+        m__raw_svs->push_back(m__io->read_bytes(12));
+        kaitai::kstream* io__raw_svs = new kaitai::kstream(m__raw_svs->at(m__raw_svs->size() - 1));
+        m__io__raw_svs->push_back(io__raw_svs);
+        m_svs->push_back(new nav_t(io__raw_svs, this, m__root));
+    }
+}
+
+ubx_t::nav_sat_t::~nav_sat_t() {
+    _clean_up();
+}
+
+void ubx_t::nav_sat_t::_clean_up() {
+    if (m__raw_svs) {
+        delete m__raw_svs; m__raw_svs = 0;
+    }
+    if (m__io__raw_svs) {
+        for (std::vector<kaitai::kstream*>::iterator it = m__io__raw_svs->begin(); it != m__io__raw_svs->end(); ++it) {
+            delete *it;
+        }
+        delete m__io__raw_svs; m__io__raw_svs = 0;
+    }
+    if (m_svs) {
+        for (std::vector<nav_t*>::iterator it = m_svs->begin(); it != m_svs->end(); ++it) {
+            delete *it;
+        }
+        delete m_svs; m_svs = 0;
+    }
+}
+
+ubx_t::nav_sat_t::nav_t::nav_t(kaitai::kstream* p__io, ubx_t::nav_sat_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::nav_sat_t::nav_t::_read() {
+    m_gnss_id = static_cast<ubx_t::gnss_type_t>(m__io->read_u1());
+    m_sv_id = m__io->read_u1();
+    m_cno = m__io->read_u1();
+    m_elev = m__io->read_s1();
+    m_azim = m__io->read_s2le();
+    m_pr_res = m__io->read_s2le();
+    m_flags = m__io->read_u4le();
+}
+
+ubx_t::nav_sat_t::nav_t::~nav_t() {
+    _clean_up();
+}
+
+void ubx_t::nav_sat_t::nav_t::_clean_up() {
+}
+
+ubx_t::nav_pvt_t::nav_pvt_t(kaitai::kstream* p__io, ubx_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::nav_pvt_t::_read() {
+    m_i_tow = m__io->read_u4le();
+    m_year = m__io->read_u2le();
+    m_month = m__io->read_u1();
+    m_day = m__io->read_u1();
+    m_hour = m__io->read_u1();
+    m_min = m__io->read_u1();
+    m_sec = m__io->read_u1();
+    m_valid = m__io->read_u1();
+    m_t_acc = m__io->read_u4le();
+    m_nano = m__io->read_s4le();
+    m_fix_type = m__io->read_u1();
+    m_flags = m__io->read_u1();
+    m_flags2 = m__io->read_u1();
+    m_num_sv = m__io->read_u1();
+    m_lon = m__io->read_s4le();
+    m_lat = m__io->read_s4le();
+    m_height = m__io->read_s4le();
+    m_h_msl = m__io->read_s4le();
+    m_h_acc = m__io->read_u4le();
+    m_v_acc = m__io->read_u4le();
+    m_vel_n = m__io->read_s4le();
+    m_vel_e = m__io->read_s4le();
+    m_vel_d = m__io->read_s4le();
+    m_g_speed = m__io->read_s4le();
+    m_head_mot = m__io->read_s4le();
+    m_s_acc = m__io->read_s4le();
+    m_head_acc = m__io->read_u4le();
+    m_p_dop = m__io->read_u2le();
+    m_flags3 = m__io->read_u1();
+    m_reserved1 = m__io->read_bytes(5);
+    m_head_veh = m__io->read_s4le();
+    m_mag_dec = m__io->read_s2le();
+    m_mag_acc = m__io->read_u2le();
+}
+
+ubx_t::nav_pvt_t::~nav_pvt_t() {
+    _clean_up();
+}
+
+void ubx_t::nav_pvt_t::_clean_up() {
+}
+
+ubx_t::mon_hw2_t::mon_hw2_t(kaitai::kstream* p__io, ubx_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::mon_hw2_t::_read() {
+    m_ofs_i = m__io->read_s1();
+    m_mag_i = m__io->read_u1();
+    m_ofs_q = m__io->read_s1();
+    m_mag_q = m__io->read_u1();
+    m_cfg_source = static_cast<ubx_t::mon_hw2_t::config_source_t>(m__io->read_u1());
+    m_reserved1 = m__io->read_bytes(3);
+    m_low_lev_cfg = m__io->read_u4le();
+    m_reserved2 = m__io->read_bytes(8);
+    m_post_status = m__io->read_u4le();
+    m_reserved3 = m__io->read_bytes(4);
+}
+
+ubx_t::mon_hw2_t::~mon_hw2_t() {
+    _clean_up();
+}
+
+void ubx_t::mon_hw2_t::_clean_up() {
+}
+
+ubx_t::mon_hw_t::mon_hw_t(kaitai::kstream* p__io, ubx_t* p__parent, ubx_t* p__root) : kaitai::kstruct(p__io) {
+    m__parent = p__parent;
+    m__root = p__root;
+
+    try {
+        _read();
+    } catch(...) {
+        _clean_up();
+        throw;
+    }
+}
+
+void ubx_t::mon_hw_t::_read() {
+    m_pin_sel = m__io->read_u4le();
+    m_pin_bank = m__io->read_u4le();
+    m_pin_dir = m__io->read_u4le();
+    m_pin_val = m__io->read_u4le();
+    m_noise_per_ms = m__io->read_u2le();
+    m_agc_cnt = m__io->read_u2le();
+    m_a_status = static_cast<ubx_t::mon_hw_t::antenna_status_t>(m__io->read_u1());
+    m_a_power = static_cast<ubx_t::mon_hw_t::antenna_power_t>(m__io->read_u1());
+    m_flags = m__io->read_u1();
+    m_reserved1 = m__io->read_bytes(1);
+    m_used_mask = m__io->read_u4le();
+    m_vp = m__io->read_bytes(17);
+    m_jam_ind = m__io->read_u1();
+    m_reserved2 = m__io->read_bytes(2);
+    m_pin_irq = m__io->read_u4le();
+    m_pull_h = m__io->read_u4le();
+    m_pull_l = m__io->read_u4le();
+}
+
+ubx_t::mon_hw_t::~mon_hw_t() {
+    _clean_up();
+}
+
+void ubx_t::mon_hw_t::_clean_up() {
+}
+
+uint16_t ubx_t::checksum() {
+    if (f_checksum)
+        return m_checksum;
+    std::streampos _pos = m__io->pos();
+    m__io->seek((length() + 6));
+    m_checksum = m__io->read_u2le();
+    m__io->seek(_pos);
+    f_checksum = true;
+    return m_checksum;
+}

system/ubloxd/generated/ubx.h

@@ -0,0 +1,484 @@
+#ifndef UBX_H_
+#define UBX_H_
+
+// This is a generated file! Please edit source .ksy file and use kaitai-struct-compiler to rebuild
+
+#include "kaitai/kaitaistruct.h"
+#include <stdint.h>
+#include <vector>
+
+#if KAITAI_STRUCT_VERSION < 9000L
+#error "Incompatible Kaitai Struct C++/STL API: version 0.9 or later is required"
+#endif
+
+class ubx_t : public kaitai::kstruct {
+
+public:
+    class rxm_rawx_t;
+    class rxm_sfrbx_t;
+    class nav_sat_t;
+    class nav_pvt_t;
+    class mon_hw2_t;
+    class mon_hw_t;
+
+    enum gnss_type_t {
+        GNSS_TYPE_GPS = 0,
+        GNSS_TYPE_SBAS = 1,
+        GNSS_TYPE_GALILEO = 2,
+        GNSS_TYPE_BEIDOU = 3,
+        GNSS_TYPE_IMES = 4,
+        GNSS_TYPE_QZSS = 5,
+        GNSS_TYPE_GLONASS = 6
+    };
+
+    ubx_t(kaitai::kstream* p__io, kaitai::kstruct* p__parent = 0, ubx_t* p__root = 0);
+
+private:
+    void _read();
+    void _clean_up();
+
+public:
+    ~ubx_t();
+
+    class rxm_rawx_t : public kaitai::kstruct {
+
+    public:
+        class measurement_t;
+
+        rxm_rawx_t(kaitai::kstream* p__io, ubx_t* p__parent = 0, ubx_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~rxm_rawx_t();
+
+        class measurement_t : public kaitai::kstruct {
+
+        public:
+
+            measurement_t(kaitai::kstream* p__io, ubx_t::rxm_rawx_t* p__parent = 0, ubx_t* p__root = 0);
+
+        private:
+            void _read();
+            void _clean_up();
+
+        public:
+            ~measurement_t();
+
+        private:
+            double m_pr_mes;
+            double m_cp_mes;
+            float m_do_mes;
+            gnss_type_t m_gnss_id;
+            uint8_t m_sv_id;
+            std::string m_reserved2;
+            uint8_t m_freq_id;
+            uint16_t m_lock_time;
+            uint8_t m_cno;
+            uint8_t m_pr_stdev;
+            uint8_t m_cp_stdev;
+            uint8_t m_do_stdev;
+            uint8_t m_trk_stat;
+            std::string m_reserved3;
+            ubx_t* m__root;
+            ubx_t::rxm_rawx_t* m__parent;
+
+        public:
+            double pr_mes() const { return m_pr_mes; }
+            double cp_mes() const { return m_cp_mes; }
+            float do_mes() const { return m_do_mes; }
+            gnss_type_t gnss_id() const { return m_gnss_id; }
+            uint8_t sv_id() const { return m_sv_id; }
+            std::string reserved2() const { return m_reserved2; }
+            uint8_t freq_id() const { return m_freq_id; }
+            uint16_t lock_time() const { return m_lock_time; }
+            uint8_t cno() const { return m_cno; }
+            uint8_t pr_stdev() const { return m_pr_stdev; }
+            uint8_t cp_stdev() const { return m_cp_stdev; }
+            uint8_t do_stdev() const { return m_do_stdev; }
+            uint8_t trk_stat() const { return m_trk_stat; }
+            std::string reserved3() const { return m_reserved3; }
+            ubx_t* _root() const { return m__root; }
+            ubx_t::rxm_rawx_t* _parent() const { return m__parent; }
+        };
+
+    private:
+        double m_rcv_tow;
+        uint16_t m_week;
+        int8_t m_leap_s;
+        uint8_t m_num_meas;
+        uint8_t m_rec_stat;
+        std::string m_reserved1;
+        std::vector<measurement_t*>* m_meas;
+        ubx_t* m__root;
+        ubx_t* m__parent;
+        std::vector<std::string>* m__raw_meas;
+        std::vector<kaitai::kstream*>* m__io__raw_meas;
+
+    public:
+        double rcv_tow() const { return m_rcv_tow; }
+        uint16_t week() const { return m_week; }
+        int8_t leap_s() const { return m_leap_s; }
+        uint8_t num_meas() const { return m_num_meas; }
+        uint8_t rec_stat() const { return m_rec_stat; }
+        std::string reserved1() const { return m_reserved1; }
+        std::vector<measurement_t*>* meas() const { return m_meas; }
+        ubx_t* _root() const { return m__root; }
+        ubx_t* _parent() const { return m__parent; }
+        std::vector<std::string>* _raw_meas() const { return m__raw_meas; }
+        std::vector<kaitai::kstream*>* _io__raw_meas() const { return m__io__raw_meas; }
+    };
+
+    class rxm_sfrbx_t : public kaitai::kstruct {
+
+    public:
+
+        rxm_sfrbx_t(kaitai::kstream* p__io, ubx_t* p__parent = 0, ubx_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~rxm_sfrbx_t();
+
+    private:
+        gnss_type_t m_gnss_id;
+        uint8_t m_sv_id;
+        std::string m_reserved1;
+        uint8_t m_freq_id;
+        uint8_t m_num_words;
+        std::string m_reserved2;
+        uint8_t m_version;
+        std::string m_reserved3;
+        std::vector<uint32_t>* m_body;
+        ubx_t* m__root;
+        ubx_t* m__parent;
+
+    public:
+        gnss_type_t gnss_id() const { return m_gnss_id; }
+        uint8_t sv_id() const { return m_sv_id; }
+        std::string reserved1() const { return m_reserved1; }
+        uint8_t freq_id() const { return m_freq_id; }
+        uint8_t num_words() const { return m_num_words; }
+        std::string reserved2() const { return m_reserved2; }
+        uint8_t version() const { return m_version; }
+        std::string reserved3() const { return m_reserved3; }
+        std::vector<uint32_t>* body() const { return m_body; }
+        ubx_t* _root() const { return m__root; }
+        ubx_t* _parent() const { return m__parent; }
+    };
+
+    class nav_sat_t : public kaitai::kstruct {
+
+    public:
+        class nav_t;
+
+        nav_sat_t(kaitai::kstream* p__io, ubx_t* p__parent = 0, ubx_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~nav_sat_t();
+
+        class nav_t : public kaitai::kstruct {
+
+        public:
+
+            nav_t(kaitai::kstream* p__io, ubx_t::nav_sat_t* p__parent = 0, ubx_t* p__root = 0);
+
+        private:
+            void _read();
+            void _clean_up();
+
+        public:
+            ~nav_t();
+
+        private:
+            gnss_type_t m_gnss_id;
+            uint8_t m_sv_id;
+            uint8_t m_cno;
+            int8_t m_elev;
+            int16_t m_azim;
+            int16_t m_pr_res;
+            uint32_t m_flags;
+            ubx_t* m__root;
+            ubx_t::nav_sat_t* m__parent;
+
+        public:
+            gnss_type_t gnss_id() const { return m_gnss_id; }
+            uint8_t sv_id() const { return m_sv_id; }
+            uint8_t cno() const { return m_cno; }
+            int8_t elev() const { return m_elev; }
+            int16_t azim() const { return m_azim; }
+            int16_t pr_res() const { return m_pr_res; }
+            uint32_t flags() const { return m_flags; }
+            ubx_t* _root() const { return m__root; }
+            ubx_t::nav_sat_t* _parent() const { return m__parent; }
+        };
+
+    private:
+        uint32_t m_itow;
+        uint8_t m_version;
+        uint8_t m_num_svs;
+        std::string m_reserved;
+        std::vector<nav_t*>* m_svs;
+        ubx_t* m__root;
+        ubx_t* m__parent;
+        std::vector<std::string>* m__raw_svs;
+        std::vector<kaitai::kstream*>* m__io__raw_svs;
+
+    public:
+        uint32_t itow() const { return m_itow; }
+        uint8_t version() const { return m_version; }
+        uint8_t num_svs() const { return m_num_svs; }
+        std::string reserved() const { return m_reserved; }
+        std::vector<nav_t*>* svs() const { return m_svs; }
+        ubx_t* _root() const { return m__root; }
+        ubx_t* _parent() const { return m__parent; }
+        std::vector<std::string>* _raw_svs() const { return m__raw_svs; }
+        std::vector<kaitai::kstream*>* _io__raw_svs() const { return m__io__raw_svs; }
+    };
+
+    class nav_pvt_t : public kaitai::kstruct {
+
+    public:
+
+        nav_pvt_t(kaitai::kstream* p__io, ubx_t* p__parent = 0, ubx_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~nav_pvt_t();
+
+    private:
+        uint32_t m_i_tow;
+        uint16_t m_year;
+        uint8_t m_month;
+        uint8_t m_day;
+        uint8_t m_hour;
+        uint8_t m_min;
+        uint8_t m_sec;
+        uint8_t m_valid;
+        uint32_t m_t_acc;
+        int32_t m_nano;
+        uint8_t m_fix_type;
+        uint8_t m_flags;
+        uint8_t m_flags2;
+        uint8_t m_num_sv;
+        int32_t m_lon;
+        int32_t m_lat;
+        int32_t m_height;
+        int32_t m_h_msl;
+        uint32_t m_h_acc;
+        uint32_t m_v_acc;
+        int32_t m_vel_n;
+        int32_t m_vel_e;
+        int32_t m_vel_d;
+        int32_t m_g_speed;
+        int32_t m_head_mot;
+        int32_t m_s_acc;
+        uint32_t m_head_acc;
+        uint16_t m_p_dop;
+        uint8_t m_flags3;
+        std::string m_reserved1;
+        int32_t m_head_veh;
+        int16_t m_mag_dec;
+        uint16_t m_mag_acc;
+        ubx_t* m__root;
+        ubx_t* m__parent;
+
+    public:
+        uint32_t i_tow() const { return m_i_tow; }
+        uint16_t year() const { return m_year; }
+        uint8_t month() const { return m_month; }
+        uint8_t day() const { return m_day; }
+        uint8_t hour() const { return m_hour; }
+        uint8_t min() const { return m_min; }
+        uint8_t sec() const { return m_sec; }
+        uint8_t valid() const { return m_valid; }
+        uint32_t t_acc() const { return m_t_acc; }
+        int32_t nano() const { return m_nano; }
+        uint8_t fix_type() const { return m_fix_type; }
+        uint8_t flags() const { return m_flags; }
+        uint8_t flags2() const { return m_flags2; }
+        uint8_t num_sv() const { return m_num_sv; }
+        int32_t lon() const { return m_lon; }
+        int32_t lat() const { return m_lat; }
+        int32_t height() const { return m_height; }
+        int32_t h_msl() const { return m_h_msl; }
+        uint32_t h_acc() const { return m_h_acc; }
+        uint32_t v_acc() const { return m_v_acc; }
+        int32_t vel_n() const { return m_vel_n; }
+        int32_t vel_e() const { return m_vel_e; }
+        int32_t vel_d() const { return m_vel_d; }
+        int32_t g_speed() const { return m_g_speed; }
+        int32_t head_mot() const { return m_head_mot; }
+        int32_t s_acc() const { return m_s_acc; }
+        uint32_t head_acc() const { return m_head_acc; }
+        uint16_t p_dop() const { return m_p_dop; }
+        uint8_t flags3() const { return m_flags3; }
+        std::string reserved1() const { return m_reserved1; }
+        int32_t head_veh() const { return m_head_veh; }
+        int16_t mag_dec() const { return m_mag_dec; }
+        uint16_t mag_acc() const { return m_mag_acc; }
+        ubx_t* _root() const { return m__root; }
+        ubx_t* _parent() const { return m__parent; }
+    };
+
+    class mon_hw2_t : public kaitai::kstruct {
+
+    public:
+
+        enum config_source_t {
+            CONFIG_SOURCE_FLASH = 102,
+            CONFIG_SOURCE_OTP = 111,
+            CONFIG_SOURCE_CONFIG_PINS = 112,
+            CONFIG_SOURCE_ROM = 113
+        };
+
+        mon_hw2_t(kaitai::kstream* p__io, ubx_t* p__parent = 0, ubx_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~mon_hw2_t();
+
+    private:
+        int8_t m_ofs_i;
+        uint8_t m_mag_i;
+        int8_t m_ofs_q;
+        uint8_t m_mag_q;
+        config_source_t m_cfg_source;
+        std::string m_reserved1;
+        uint32_t m_low_lev_cfg;
+        std::string m_reserved2;
+        uint32_t m_post_status;
+        std::string m_reserved3;
+        ubx_t* m__root;
+        ubx_t* m__parent;
+
+    public:
+        int8_t ofs_i() const { return m_ofs_i; }
+        uint8_t mag_i() const { return m_mag_i; }
+        int8_t ofs_q() const { return m_ofs_q; }
+        uint8_t mag_q() const { return m_mag_q; }
+        config_source_t cfg_source() const { return m_cfg_source; }
+        std::string reserved1() const { return m_reserved1; }
+        uint32_t low_lev_cfg() const { return m_low_lev_cfg; }
+        std::string reserved2() const { return m_reserved2; }
+        uint32_t post_status() const { return m_post_status; }
+        std::string reserved3() const { return m_reserved3; }
+        ubx_t* _root() const { return m__root; }
+        ubx_t* _parent() const { return m__parent; }
+    };
+
+    class mon_hw_t : public kaitai::kstruct {
+
+    public:
+
+        enum antenna_status_t {
+            ANTENNA_STATUS_INIT = 0,
+            ANTENNA_STATUS_DONTKNOW = 1,
+            ANTENNA_STATUS_OK = 2,
+            ANTENNA_STATUS_SHORT = 3,
+            ANTENNA_STATUS_OPEN = 4
+        };
+
+        enum antenna_power_t {
+            ANTENNA_POWER_FALSE = 0,
+            ANTENNA_POWER_TRUE = 1,
+            ANTENNA_POWER_DONTKNOW = 2
+        };
+
+        mon_hw_t(kaitai::kstream* p__io, ubx_t* p__parent = 0, ubx_t* p__root = 0);
+
+    private:
+        void _read();
+        void _clean_up();
+
+    public:
+        ~mon_hw_t();
+
+    private:
+        uint32_t m_pin_sel;
+        uint32_t m_pin_bank;
+        uint32_t m_pin_dir;
+        uint32_t m_pin_val;
+        uint16_t m_noise_per_ms;
+        uint16_t m_agc_cnt;
+        antenna_status_t m_a_status;
+        antenna_power_t m_a_power;
+        uint8_t m_flags;
+        std::string m_reserved1;
+        uint32_t m_used_mask;
+        std::string m_vp;
+        uint8_t m_jam_ind;
+        std::string m_reserved2;
+        uint32_t m_pin_irq;
+        uint32_t m_pull_h;
+        uint32_t m_pull_l;
+        ubx_t* m__root;
+        ubx_t* m__parent;
+
+    public:
+        uint32_t pin_sel() const { return m_pin_sel; }
+        uint32_t pin_bank() const { return m_pin_bank; }
+        uint32_t pin_dir() const { return m_pin_dir; }
+        uint32_t pin_val() const { return m_pin_val; }
+        uint16_t noise_per_ms() const { return m_noise_per_ms; }
+        uint16_t agc_cnt() const { return m_agc_cnt; }
+        antenna_status_t a_status() const { return m_a_status; }
+        antenna_power_t a_power() const { return m_a_power; }
+        uint8_t flags() const { return m_flags; }
+        std::string reserved1() const { return m_reserved1; }
+        uint32_t used_mask() const { return m_used_mask; }
+        std::string vp() const { return m_vp; }
+        uint8_t jam_ind() const { return m_jam_ind; }
+        std::string reserved2() const { return m_reserved2; }
+        uint32_t pin_irq() const { return m_pin_irq; }
+        uint32_t pull_h() const { return m_pull_h; }
+        uint32_t pull_l() const { return m_pull_l; }
+        ubx_t* _root() const { return m__root; }
+        ubx_t* _parent() const { return m__parent; }
+    };
+
+private:
+    bool f_checksum;
+    uint16_t m_checksum;
+
+public:
+    uint16_t checksum();
+
+private:
+    std::string m_magic;
+    uint16_t m_msg_type;
+    uint16_t m_length;
+    kaitai::kstruct* m_body;
+    bool n_body;
+
+public:
+    bool _is_null_body() { body(); return n_body; };
+
+private:
+    ubx_t* m__root;
+    kaitai::kstruct* m__parent;
+
+public:
+    std::string magic() const { return m_magic; }
+    uint16_t msg_type() const { return m_msg_type; }
+    uint16_t length() const { return m_length; }
+    kaitai::kstruct* body() const { return m_body; }
+    ubx_t* _root() const { return m__root; }
+    kaitai::kstruct* _parent() const { return m__parent; }
+};
+
+#endif  // UBX_H_

system/ubloxd/ublox_msg.cc

@@ -0,0 +1,524 @@
+#include "system/ubloxd/ublox_msg.h"
+
+#include <unistd.h>
+
+#include <algorithm>
+#include <cassert>
+#include <chrono>
+#include <cmath>
+#include <cstdio>
+#include <cstdlib>
+#include <ctime>
+#include <unordered_map>
+#include <utility>
+
+#include "common/swaglog.h"
+
+const double gpsPi = 3.1415926535898;
+#define UBLOX_MSG_SIZE(hdr) (*(uint16_t *)&hdr[4])
+
+inline static bool bit_to_bool(uint8_t val, int shifts) {
+  return (bool)(val & (1 << shifts));
+}
+
+inline int UbloxMsgParser::needed_bytes() {
+  // Msg header incomplete?
+  if (bytes_in_parse_buf < ublox::UBLOX_HEADER_SIZE)
+    return ublox::UBLOX_HEADER_SIZE + ublox::UBLOX_CHECKSUM_SIZE - bytes_in_parse_buf;
+  uint16_t needed = UBLOX_MSG_SIZE(msg_parse_buf) + ublox::UBLOX_HEADER_SIZE + ublox::UBLOX_CHECKSUM_SIZE;
+  // too much data
+  if (needed < (uint16_t)bytes_in_parse_buf)
+    return -1;
+  return needed - (uint16_t)bytes_in_parse_buf;
+}
+
+inline bool UbloxMsgParser::valid_cheksum() {
+  uint8_t ck_a = 0, ck_b = 0;
+  for (int i = 2; i < bytes_in_parse_buf - ublox::UBLOX_CHECKSUM_SIZE; i++) {
+    ck_a = (ck_a + msg_parse_buf[i]) & 0xFF;
+    ck_b = (ck_b + ck_a) & 0xFF;
+  }
+  if (ck_a != msg_parse_buf[bytes_in_parse_buf - 2]) {
+    LOGD("Checksum a mismatch: %02X, %02X", ck_a, msg_parse_buf[6]);
+    return false;
+  }
+  if (ck_b != msg_parse_buf[bytes_in_parse_buf - 1]) {
+    LOGD("Checksum b mismatch: %02X, %02X", ck_b, msg_parse_buf[7]);
+    return false;
+  }
+  return true;
+}
+
+inline bool UbloxMsgParser::valid() {
+  return bytes_in_parse_buf >= ublox::UBLOX_HEADER_SIZE + ublox::UBLOX_CHECKSUM_SIZE &&
+         needed_bytes() == 0 && valid_cheksum();
+}
+
+inline bool UbloxMsgParser::valid_so_far() {
+  if (bytes_in_parse_buf > 0 && msg_parse_buf[0] != ublox::PREAMBLE1) {
+    return false;
+  }
+  if (bytes_in_parse_buf > 1 && msg_parse_buf[1] != ublox::PREAMBLE2) {
+    return false;
+  }
+  if (needed_bytes() == 0 && !valid()) {
+    return false;
+  }
+  return true;
+}
+
+bool UbloxMsgParser::add_data(float log_time, const uint8_t *incoming_data, uint32_t incoming_data_len, size_t &bytes_consumed) {
+  last_log_time = log_time;
+  int needed = needed_bytes();
+  if (needed > 0) {
+    bytes_consumed = std::min((uint32_t)needed, incoming_data_len);
+    // Add data to buffer
+    memcpy(msg_parse_buf + bytes_in_parse_buf, incoming_data, bytes_consumed);
+    bytes_in_parse_buf += bytes_consumed;
+  } else {
+    bytes_consumed = incoming_data_len;
+  }
+
+  // Validate msg format, detect invalid header and invalid checksum.
+  while (!valid_so_far() && bytes_in_parse_buf != 0) {
+    // Corrupted msg, drop a byte.
+    bytes_in_parse_buf -= 1;
+    if (bytes_in_parse_buf > 0)
+      memmove(&msg_parse_buf[0], &msg_parse_buf[1], bytes_in_parse_buf);
+  }
+
+  // There is redundant data at the end of buffer, reset the buffer.
+  if (needed_bytes() == -1) {
+    bytes_in_parse_buf = 0;
+  }
+  return valid();
+}
+
+
+std::pair<std::string, kj::Array<capnp::word>> UbloxMsgParser::gen_msg() {
+  std::string dat = data();
+  kaitai::kstream stream(dat);
+
+  ubx_t ubx_message(&stream);
+  auto body = ubx_message.body();
+
+  switch (ubx_message.msg_type()) {
+  case 0x0107:
+    return {"gpsLocationExternal", gen_nav_pvt(static_cast<ubx_t::nav_pvt_t*>(body))};
+  case 0x0213: // UBX-RXM-SFRB (Broadcast Navigation Data Subframe)
+    return {"ubloxGnss", gen_rxm_sfrbx(static_cast<ubx_t::rxm_sfrbx_t*>(body))};
+  case 0x0215: // UBX-RXM-RAW (Multi-GNSS Raw Measurement Data)
+    return {"ubloxGnss", gen_rxm_rawx(static_cast<ubx_t::rxm_rawx_t*>(body))};
+  case 0x0a09:
+    return {"ubloxGnss", gen_mon_hw(static_cast<ubx_t::mon_hw_t*>(body))};
+  case 0x0a0b:
+    return {"ubloxGnss", gen_mon_hw2(static_cast<ubx_t::mon_hw2_t*>(body))};
+  case 0x0135:
+    return {"ubloxGnss", gen_nav_sat(static_cast<ubx_t::nav_sat_t*>(body))};
+  default:
+    LOGE("Unknown message type %x", ubx_message.msg_type());
+    return {"ubloxGnss", kj::Array<capnp::word>()};
+  }
+}
+
+
+kj::Array<capnp::word> UbloxMsgParser::gen_nav_pvt(ubx_t::nav_pvt_t *msg) {
+  MessageBuilder msg_builder;
+  auto gpsLoc = msg_builder.initEvent().initGpsLocationExternal();
+  gpsLoc.setSource(cereal::GpsLocationData::SensorSource::UBLOX);
+  gpsLoc.setFlags(msg->flags());
+  gpsLoc.setLatitude(msg->lat() * 1e-07);
+  gpsLoc.setLongitude(msg->lon() * 1e-07);
+  gpsLoc.setAltitude(msg->height() * 1e-03);
+  gpsLoc.setSpeed(msg->g_speed() * 1e-03);
+  gpsLoc.setBearingDeg(msg->head_mot() * 1e-5);
+  gpsLoc.setAccuracy(msg->h_acc() * 1e-03);
+  std::tm timeinfo = std::tm();
+  timeinfo.tm_year = msg->year() - 1900;
+  timeinfo.tm_mon = msg->month() - 1;
+  timeinfo.tm_mday = msg->day();
+  timeinfo.tm_hour = msg->hour();
+  timeinfo.tm_min = msg->min();
+  timeinfo.tm_sec = msg->sec();
+
+  std::time_t utc_tt = timegm(&timeinfo);
+  gpsLoc.setUnixTimestampMillis(utc_tt * 1e+03 + msg->nano() * 1e-06);
+  float f[] = { msg->vel_n() * 1e-03f, msg->vel_e() * 1e-03f, msg->vel_d() * 1e-03f };
+  gpsLoc.setVNED(f);
+  gpsLoc.setVerticalAccuracy(msg->v_acc() * 1e-03);
+  gpsLoc.setSpeedAccuracy(msg->s_acc() * 1e-03);
+  gpsLoc.setBearingAccuracyDeg(msg->head_acc() * 1e-05);
+  return capnp::messageToFlatArray(msg_builder);
+}
+
+kj::Array<capnp::word> UbloxMsgParser::parse_gps_ephemeris(ubx_t::rxm_sfrbx_t *msg) {
+  // GPS subframes are packed into 10x 4 bytes, each containing 3 actual bytes
+  // We will first need to separate the data from the padding and parity
+  auto body = *msg->body();
+  assert(body.size() == 10);
+
+  std::string subframe_data;
+  subframe_data.reserve(30);
+  for (uint32_t word : body) {
+    word = word >> 6; // TODO: Verify parity
+    subframe_data.push_back(word >> 16);
+    subframe_data.push_back(word >> 8);
+    subframe_data.push_back(word >> 0);
+  }
+
+  // Collect subframes in map and parse when we have all the parts
+  {
+    kaitai::kstream stream(subframe_data);
+    gps_t subframe(&stream);
+
+    int subframe_id = subframe.how()->subframe_id();
+    if (subframe_id > 3 || subframe_id < 1) {
+      // dont parse almanac subframes
+      return kj::Array<capnp::word>();
+    }
+    gps_subframes[msg->sv_id()][subframe_id] = subframe_data;
+  }
+
+  // publish if subframes 1-3 have been collected
+  if (gps_subframes[msg->sv_id()].size() == 3) {
+    MessageBuilder msg_builder;
+    auto eph = msg_builder.initEvent().initUbloxGnss().initEphemeris();
+    eph.setSvId(msg->sv_id());
+
+    int iode_s2 = 0;
+    int iode_s3 = 0;
+    int iodc_lsb = 0;
+    int week;
+
+    // Subframe 1
+    {
+      kaitai::kstream stream(gps_subframes[msg->sv_id()][1]);
+      gps_t subframe(&stream);
+      gps_t::subframe_1_t* subframe_1 = static_cast<gps_t::subframe_1_t*>(subframe.body());
+
+      // Each message is incremented to be greater or equal than week 1877 (2015-12-27).
+      //  To skip this use the current_time argument
+      week = subframe_1->week_no();
+      week += 1024;
+      if (week < 1877) {
+        week += 1024;
+      }
+      //eph.setGpsWeek(subframe_1->week_no());
+      eph.setTgd(subframe_1->t_gd() * pow(2, -31));
+      eph.setToc(subframe_1->t_oc() * pow(2, 4));
+      eph.setAf2(subframe_1->af_2() * pow(2, -55));
+      eph.setAf1(subframe_1->af_1() * pow(2, -43));
+      eph.setAf0(subframe_1->af_0() * pow(2, -31));
+      eph.setSvHealth(subframe_1->sv_health());
+      eph.setTowCount(subframe.how()->tow_count());
+      iodc_lsb = subframe_1->iodc_lsb();
+    }
+
+    // Subframe 2
+    {
+      kaitai::kstream stream(gps_subframes[msg->sv_id()][2]);
+      gps_t subframe(&stream);
+      gps_t::subframe_2_t* subframe_2 = static_cast<gps_t::subframe_2_t*>(subframe.body());
+
+      // GPS week refers to current week, the ephemeris can be valid for the next
+      // if toe equals 0, this can be verified by the TOW count if it is within the
+      // last 2 hours of the week (gps ephemeris valid for 4hours)
+      if (subframe_2->t_oe() == 0 and subframe.how()->tow_count()*6 >= (SECS_IN_WEEK - 2*SECS_IN_HR)){
+        week += 1;
+      }
+      eph.setCrs(subframe_2->c_rs() * pow(2, -5));
+      eph.setDeltaN(subframe_2->delta_n() * pow(2, -43) * gpsPi);
+      eph.setM0(subframe_2->m_0() * pow(2, -31) * gpsPi);
+      eph.setCuc(subframe_2->c_uc() * pow(2, -29));
+      eph.setEcc(subframe_2->e() * pow(2, -33));
+      eph.setCus(subframe_2->c_us() * pow(2, -29));
+      eph.setA(pow(subframe_2->sqrt_a() * pow(2, -19), 2.0));
+      eph.setToe(subframe_2->t_oe() * pow(2, 4));
+      iode_s2 = subframe_2->iode();
+    }
+
+    // Subframe 3
+    {
+      kaitai::kstream stream(gps_subframes[msg->sv_id()][3]);
+      gps_t subframe(&stream);
+      gps_t::subframe_3_t* subframe_3 = static_cast<gps_t::subframe_3_t*>(subframe.body());
+
+      eph.setCic(subframe_3->c_ic() * pow(2, -29));
+      eph.setOmega0(subframe_3->omega_0() * pow(2, -31) * gpsPi);
+      eph.setCis(subframe_3->c_is() * pow(2, -29));
+      eph.setI0(subframe_3->i_0() * pow(2, -31) * gpsPi);
+      eph.setCrc(subframe_3->c_rc() * pow(2, -5));
+      eph.setOmega(subframe_3->omega() * pow(2, -31) * gpsPi);
+      eph.setOmegaDot(subframe_3->omega_dot() * pow(2, -43) * gpsPi);
+      eph.setIode(subframe_3->iode());
+      eph.setIDot(subframe_3->idot() * pow(2, -43) * gpsPi);
+      iode_s3 = subframe_3->iode();
+    }
+
+    eph.setToeWeek(week);
+    eph.setTocWeek(week);
+
+    gps_subframes[msg->sv_id()].clear();
+    if (iodc_lsb != iode_s2 || iodc_lsb != iode_s3) {
+      // data set cutover, reject ephemeris
+      return kj::Array<capnp::word>();
+    }
+    return capnp::messageToFlatArray(msg_builder);
+  }
+  return kj::Array<capnp::word>();
+}
+
+kj::Array<capnp::word> UbloxMsgParser::parse_glonass_ephemeris(ubx_t::rxm_sfrbx_t *msg) {
+  // This parser assumes that no 2 satellites of the same frequency
+  // can be in view at the same time
+  auto body = *msg->body();
+  assert(body.size() == 4);
+  {
+    std::string string_data;
+    string_data.reserve(16);
+    for (uint32_t word : body) {
+      for (int i = 3; i >= 0; i--)
+        string_data.push_back(word >> 8*i);
+    }
+
+    kaitai::kstream stream(string_data);
+    glonass_t gl_string(&stream);
+    int string_number = gl_string.string_number();
+    if (string_number < 1 || string_number > 5 || gl_string.idle_chip()) {
+      // dont parse non immediate data, idle_chip == 0
+      return kj::Array<capnp::word>();
+    }
+
+    // Check if new string either has same superframe_id or log transmission times make sense
+    bool superframe_unknown = false;
+    bool needs_clear = false;
+    for (int i = 1; i <= 5; i++) {
+      if (glonass_strings[msg->freq_id()].find(i) == glonass_strings[msg->freq_id()].end())
+        continue;
+      if (glonass_string_superframes[msg->freq_id()][i] == 0 || gl_string.superframe_number() == 0) {
+        superframe_unknown = true;
+      } else if (glonass_string_superframes[msg->freq_id()][i] != gl_string.superframe_number()) {
+        needs_clear = true;
+      }
+      // Check if string times add up to being from the same frame
+      // If superframe is known this is redundant
+      // Strings are sent 2s apart and frames are 30s apart
+      if (superframe_unknown &&
+          std::abs((glonass_string_times[msg->freq_id()][i] - 2.0 * i) - (last_log_time - 2.0 * string_number)) > 10)
+        needs_clear = true;
+    }
+    if (needs_clear) {
+      glonass_strings[msg->freq_id()].clear();
+      glonass_string_superframes[msg->freq_id()].clear();
+      glonass_string_times[msg->freq_id()].clear();
+    }
+    glonass_strings[msg->freq_id()][string_number] = string_data;
+    glonass_string_superframes[msg->freq_id()][string_number] = gl_string.superframe_number();
+    glonass_string_times[msg->freq_id()][string_number] = last_log_time;
+  }
+  if (msg->sv_id() == 255) {
+    // data can be decoded before identifying the SV number, in this case 255
+    // is returned, which means "unknown"  (ublox p32)
+    return kj::Array<capnp::word>();
+  }
+
+  // publish if strings 1-5 have been collected
+  if (glonass_strings[msg->freq_id()].size() != 5) {
+    return kj::Array<capnp::word>();
+  }
+
+  MessageBuilder msg_builder;
+  auto eph = msg_builder.initEvent().initUbloxGnss().initGlonassEphemeris();
+  eph.setSvId(msg->sv_id());
+  eph.setFreqNum(msg->freq_id() - 7);
+
+  uint16_t current_day = 0;
+  uint16_t tk = 0;
+
+  // string number 1
+  {
+    kaitai::kstream stream(glonass_strings[msg->freq_id()][1]);
+    glonass_t gl_stream(&stream);
+    glonass_t::string_1_t* data = static_cast<glonass_t::string_1_t*>(gl_stream.data());
+
+    eph.setP1(data->p1());
+    tk = data->t_k();
+    eph.setTkDEPRECATED(tk);
+    eph.setXVel(data->x_vel() * pow(2, -20));
+    eph.setXAccel(data->x_accel() * pow(2, -30));
+    eph.setX(data->x() * pow(2, -11));
+  }
+
+  // string number 2
+  {
+    kaitai::kstream stream(glonass_strings[msg->freq_id()][2]);
+    glonass_t gl_stream(&stream);
+    glonass_t::string_2_t* data = static_cast<glonass_t::string_2_t*>(gl_stream.data());
+
+    eph.setSvHealth(data->b_n()>>2); // MSB indicates health
+    eph.setP2(data->p2());
+    eph.setTb(data->t_b());
+    eph.setYVel(data->y_vel() * pow(2, -20));
+    eph.setYAccel(data->y_accel() * pow(2, -30));
+    eph.setY(data->y() * pow(2, -11));
+  }
+
+  // string number 3
+  {
+    kaitai::kstream stream(glonass_strings[msg->freq_id()][3]);
+    glonass_t gl_stream(&stream);
+    glonass_t::string_3_t* data = static_cast<glonass_t::string_3_t*>(gl_stream.data());
+
+    eph.setP3(data->p3());
+    eph.setGammaN(data->gamma_n() * pow(2, -40));
+    eph.setSvHealth(eph.getSvHealth() | data->l_n());
+    eph.setZVel(data->z_vel() * pow(2, -20));
+    eph.setZAccel(data->z_accel() * pow(2, -30));
+    eph.setZ(data->z() * pow(2, -11));
+  }
+
+  // string number 4
+  {
+    kaitai::kstream stream(glonass_strings[msg->freq_id()][4]);
+    glonass_t gl_stream(&stream);
+    glonass_t::string_4_t* data = static_cast<glonass_t::string_4_t*>(gl_stream.data());
+
+    current_day = data->n_t();
+    eph.setNt(current_day);
+    eph.setTauN(data->tau_n() * pow(2, -30));
+    eph.setDeltaTauN(data->delta_tau_n() * pow(2, -30));
+    eph.setAge(data->e_n());
+    eph.setP4(data->p4());
+    eph.setSvURA(glonass_URA_lookup.at(data->f_t()));
+    if (msg->sv_id() != data->n()) {
+      LOGE("SV_ID != SLOT_NUMBER: %d %" PRIu64, msg->sv_id(), data->n());
+    }
+    eph.setSvType(data->m());
+  }
+
+  // string number 5
+  {
+    kaitai::kstream stream(glonass_strings[msg->freq_id()][5]);
+    glonass_t gl_stream(&stream);
+    glonass_t::string_5_t* data = static_cast<glonass_t::string_5_t*>(gl_stream.data());
+
+    // string5 parsing is only needed to get the year, this can be removed and
+    // the year can be fetched later in laika (note rollovers and leap year)
+    eph.setN4(data->n_4());
+    int tk_seconds = SECS_IN_HR * ((tk>>7) & 0x1F) + SECS_IN_MIN * ((tk>>1) & 0x3F) + (tk & 0x1) * 30;
+    eph.setTkSeconds(tk_seconds);
+  }
+
+  glonass_strings[msg->freq_id()].clear();
+  return capnp::messageToFlatArray(msg_builder);
+}
+
+
+kj::Array<capnp::word> UbloxMsgParser::gen_rxm_sfrbx(ubx_t::rxm_sfrbx_t *msg) {
+  switch (msg->gnss_id()) {
+    case ubx_t::gnss_type_t::GNSS_TYPE_GPS:
+      return parse_gps_ephemeris(msg);
+    case ubx_t::gnss_type_t::GNSS_TYPE_GLONASS:
+      return parse_glonass_ephemeris(msg);
+    default:
+      return kj::Array<capnp::word>();
+  }
+}
+
+kj::Array<capnp::word> UbloxMsgParser::gen_rxm_rawx(ubx_t::rxm_rawx_t *msg) {
+  MessageBuilder msg_builder;
+  auto mr = msg_builder.initEvent().initUbloxGnss().initMeasurementReport();
+  mr.setRcvTow(msg->rcv_tow());
+  mr.setGpsWeek(msg->week());
+  mr.setLeapSeconds(msg->leap_s());
+  mr.setGpsWeek(msg->week());
+
+  auto mb = mr.initMeasurements(msg->num_meas());
+  auto measurements = *msg->meas();
+  for (int8_t i = 0; i < msg->num_meas(); i++) {
+    mb[i].setSvId(measurements[i]->sv_id());
+    mb[i].setPseudorange(measurements[i]->pr_mes());
+    mb[i].setCarrierCycles(measurements[i]->cp_mes());
+    mb[i].setDoppler(measurements[i]->do_mes());
+    mb[i].setGnssId(measurements[i]->gnss_id());
+    mb[i].setGlonassFrequencyIndex(measurements[i]->freq_id());
+    mb[i].setLocktime(measurements[i]->lock_time());
+    mb[i].setCno(measurements[i]->cno());
+    mb[i].setPseudorangeStdev(0.01 * (pow(2, (measurements[i]->pr_stdev() & 15)))); // weird scaling, might be wrong
+    mb[i].setCarrierPhaseStdev(0.004 * (measurements[i]->cp_stdev() & 15));
+    mb[i].setDopplerStdev(0.002 * (pow(2, (measurements[i]->do_stdev() & 15)))); // weird scaling, might be wrong
+
+    auto ts = mb[i].initTrackingStatus();
+    auto trk_stat = measurements[i]->trk_stat();
+    ts.setPseudorangeValid(bit_to_bool(trk_stat, 0));
+    ts.setCarrierPhaseValid(bit_to_bool(trk_stat, 1));
+    ts.setHalfCycleValid(bit_to_bool(trk_stat, 2));
+    ts.setHalfCycleSubtracted(bit_to_bool(trk_stat, 3));
+  }
+
+  mr.setNumMeas(msg->num_meas());
+  auto rs = mr.initReceiverStatus();
+  rs.setLeapSecValid(bit_to_bool(msg->rec_stat(), 0));
+  rs.setClkReset(bit_to_bool(msg->rec_stat(), 2));
+  return capnp::messageToFlatArray(msg_builder);
+}
+
+kj::Array<capnp::word> UbloxMsgParser::gen_nav_sat(ubx_t::nav_sat_t *msg) {
+  MessageBuilder msg_builder;
+  auto sr = msg_builder.initEvent().initUbloxGnss().initSatReport();
+  sr.setITow(msg->itow());
+
+  auto svs = sr.initSvs(msg->num_svs());
+  auto svs_data = *msg->svs();
+  for (int8_t i = 0; i < msg->num_svs(); i++) {
+    svs[i].setSvId(svs_data[i]->sv_id());
+    svs[i].setGnssId(svs_data[i]->gnss_id());
+    svs[i].setFlagsBitfield(svs_data[i]->flags());
+  }
+
+  return capnp::messageToFlatArray(msg_builder);
+}
+
+kj::Array<capnp::word> UbloxMsgParser::gen_mon_hw(ubx_t::mon_hw_t *msg) {
+  MessageBuilder msg_builder;
+  auto hwStatus = msg_builder.initEvent().initUbloxGnss().initHwStatus();
+  hwStatus.setNoisePerMS(msg->noise_per_ms());
+  hwStatus.setFlags(msg->flags());
+  hwStatus.setAgcCnt(msg->agc_cnt());
+  hwStatus.setAStatus((cereal::UbloxGnss::HwStatus::AntennaSupervisorState) msg->a_status());
+  hwStatus.setAPower((cereal::UbloxGnss::HwStatus::AntennaPowerStatus) msg->a_power());
+  hwStatus.setJamInd(msg->jam_ind());
+  return capnp::messageToFlatArray(msg_builder);
+}
+
+kj::Array<capnp::word> UbloxMsgParser::gen_mon_hw2(ubx_t::mon_hw2_t *msg) {
+  MessageBuilder msg_builder;
+  auto hwStatus = msg_builder.initEvent().initUbloxGnss().initHwStatus2();
+  hwStatus.setOfsI(msg->ofs_i());
+  hwStatus.setMagI(msg->mag_i());
+  hwStatus.setOfsQ(msg->ofs_q());
+  hwStatus.setMagQ(msg->mag_q());
+
+  switch (msg->cfg_source()) {
+    case ubx_t::mon_hw2_t::config_source_t::CONFIG_SOURCE_ROM:
+      hwStatus.setCfgSource(cereal::UbloxGnss::HwStatus2::ConfigSource::ROM);
+      break;
+    case ubx_t::mon_hw2_t::config_source_t::CONFIG_SOURCE_OTP:
+      hwStatus.setCfgSource(cereal::UbloxGnss::HwStatus2::ConfigSource::OTP);
+      break;
+    case ubx_t::mon_hw2_t::config_source_t::CONFIG_SOURCE_CONFIG_PINS:
+      hwStatus.setCfgSource(cereal::UbloxGnss::HwStatus2::ConfigSource::CONFIGPINS);
+      break;
+    case ubx_t::mon_hw2_t::config_source_t::CONFIG_SOURCE_FLASH:
+      hwStatus.setCfgSource(cereal::UbloxGnss::HwStatus2::ConfigSource::FLASH);
+      break;
+    default:
+      hwStatus.setCfgSource(cereal::UbloxGnss::HwStatus2::ConfigSource::UNDEFINED);
+      break;
+  }
+
+  hwStatus.setLowLevCfg(msg->low_lev_cfg());
+  hwStatus.setPostStatus(msg->post_status());
+
+  return capnp::messageToFlatArray(msg_builder);
+}

system/ubloxd/ublox_msg.h

@@ -0,0 +1,131 @@
+#pragma once
+
+#include <cassert>
+#include <cstdint>
+#include <ctime>
+#include <memory>
+#include <string>
+#include <unordered_map>
+#include <utility>
+
+#include "cereal/messaging/messaging.h"
+#include "common/util.h"
+#include "system/ubloxd/generated/gps.h"
+#include "system/ubloxd/generated/glonass.h"
+#include "system/ubloxd/generated/ubx.h"
+
+using namespace std::string_literals;
+
+const int SECS_IN_MIN = 60;
+const int SECS_IN_HR = 60 * SECS_IN_MIN;
+const int SECS_IN_DAY = 24 * SECS_IN_HR;
+const int SECS_IN_WEEK = 7 * SECS_IN_DAY;
+
+// protocol constants
+namespace ublox {
+  const uint8_t PREAMBLE1 = 0xb5;
+  const uint8_t PREAMBLE2 = 0x62;
+
+  const int UBLOX_HEADER_SIZE = 6;
+  const int UBLOX_CHECKSUM_SIZE = 2;
+  const int UBLOX_MAX_MSG_SIZE = 65536;
+
+  struct ubx_mga_ini_time_utc_t {
+    uint8_t type;
+    uint8_t version;
+    uint8_t ref;
+    int8_t leapSecs;
+    uint16_t year;
+    uint8_t month;
+    uint8_t day;
+    uint8_t hour;
+    uint8_t minute;
+    uint8_t second;
+    uint8_t reserved1;
+    uint32_t ns;
+    uint16_t tAccS;
+    uint16_t reserved2;
+    uint32_t tAccNs;
+  } __attribute__((packed));
+
+  inline std::string ubx_add_checksum(const std::string &msg) {
+    assert(msg.size() > 2);
+
+    uint8_t ck_a = 0, ck_b = 0;
+    for (int i = 2; i < msg.size(); i++) {
+      ck_a = (ck_a + msg[i]) & 0xFF;
+      ck_b = (ck_b + ck_a) & 0xFF;
+    }
+
+    std::string r = msg;
+    r.push_back(ck_a);
+    r.push_back(ck_b);
+    return r;
+  }
+
+  inline std::string build_ubx_mga_ini_time_utc(struct tm time) {
+    ublox::ubx_mga_ini_time_utc_t payload = {
+      .type = 0x10,
+      .version = 0x0,
+      .ref = 0x0,
+      .leapSecs = -128, // Unknown
+      .year = (uint16_t)(1900 + time.tm_year),
+      .month = (uint8_t)(1 + time.tm_mon),
+      .day = (uint8_t)time.tm_mday,
+      .hour = (uint8_t)time.tm_hour,
+      .minute = (uint8_t)time.tm_min,
+      .second = (uint8_t)time.tm_sec,
+      .reserved1 = 0x0,
+      .ns = 0,
+      .tAccS = 30,
+      .reserved2 = 0x0,
+      .tAccNs = 0,
+    };
+    assert(sizeof(payload) == 24);
+
+    std::string msg = "\xb5\x62\x13\x40\x18\x00"s;
+    msg += std::string((char*)&payload, sizeof(payload));
+
+    return ubx_add_checksum(msg);
+  }
+}
+
+class UbloxMsgParser {
+  public:
+    bool add_data(float log_time, const uint8_t *incoming_data, uint32_t incoming_data_len, size_t &bytes_consumed);
+    inline void reset() {bytes_in_parse_buf = 0;}
+    inline int needed_bytes();
+    inline std::string data() {return std::string((const char*)msg_parse_buf, bytes_in_parse_buf);}
+
+    std::pair<std::string, kj::Array<capnp::word>> gen_msg();
+    kj::Array<capnp::word> gen_nav_pvt(ubx_t::nav_pvt_t *msg);
+    kj::Array<capnp::word> gen_rxm_sfrbx(ubx_t::rxm_sfrbx_t *msg);
+    kj::Array<capnp::word> gen_rxm_rawx(ubx_t::rxm_rawx_t *msg);
+    kj::Array<capnp::word> gen_mon_hw(ubx_t::mon_hw_t *msg);
+    kj::Array<capnp::word> gen_mon_hw2(ubx_t::mon_hw2_t *msg);
+    kj::Array<capnp::word> gen_nav_sat(ubx_t::nav_sat_t *msg);
+
+  private:
+    inline bool valid_cheksum();
+    inline bool valid();
+    inline bool valid_so_far();
+
+    kj::Array<capnp::word> parse_gps_ephemeris(ubx_t::rxm_sfrbx_t *msg);
+    kj::Array<capnp::word> parse_glonass_ephemeris(ubx_t::rxm_sfrbx_t *msg);
+
+    std::unordered_map<int, std::unordered_map<int, std::string>> gps_subframes;
+
+    float last_log_time = 0.0;
+    size_t bytes_in_parse_buf = 0;
+    uint8_t msg_parse_buf[ublox::UBLOX_HEADER_SIZE + ublox::UBLOX_MAX_MSG_SIZE];
+
+    // user range accuracy in meters
+    const std::unordered_map<uint8_t, float> glonass_URA_lookup =
+      {{ 0,  1}, { 1,   2}, { 2, 2.5}, { 3,   4}, { 4,  5}, {5, 7},
+       { 6, 10}, { 7,  12}, { 8,  14}, { 9,  16}, {10, 32},
+       {11, 64}, {12, 128}, {13, 256}, {14, 512}, {15, 1024}};
+
+    std::unordered_map<int, std::unordered_map<int, std::string>> glonass_strings;
+    std::unordered_map<int, std::unordered_map<int, long>> glonass_string_times;
+    std::unordered_map<int, std::unordered_map<int, int>> glonass_string_superframes;
+};

system/ubloxd/ubloxd.cc

@@ -0,0 +1,65 @@
+#include <cassert>
+
+#include <kaitai/kaitaistream.h>
+
+#include "cereal/messaging/messaging.h"
+#include "common/swaglog.h"
+#include "common/util.h"
+#include "system/ubloxd/ublox_msg.h"
+
+ExitHandler do_exit;
+using namespace ublox;
+
+int main() {
+  LOGW("starting ubloxd");
+  AlignedBuffer aligned_buf;
+  UbloxMsgParser parser;
+
+  PubMaster pm({"ubloxGnss", "gpsLocationExternal"});
+
+  std::unique_ptr<Context> context(Context::create());
+  std::unique_ptr<SubSocket> subscriber(SubSocket::create(context.get(), "ubloxRaw"));
+  assert(subscriber != NULL);
+  subscriber->setTimeout(100);
+
+
+  while (!do_exit) {
+    std::unique_ptr<Message> msg(subscriber->receive());
+    if (!msg) {
+      if (errno == EINTR) {
+        do_exit = true;
+      }
+      continue;
+    }
+
+    capnp::FlatArrayMessageReader cmsg(aligned_buf.align(msg.get()));
+    cereal::Event::Reader event = cmsg.getRoot<cereal::Event>();
+    auto ubloxRaw = event.getUbloxRaw();
+    float log_time = 1e-9 * event.getLogMonoTime();
+
+    const uint8_t *data = ubloxRaw.begin();
+    size_t len = ubloxRaw.size();
+    size_t bytes_consumed = 0;
+
+    while (bytes_consumed < len && !do_exit) {
+      size_t bytes_consumed_this_time = 0U;
+      if (parser.add_data(log_time, data + bytes_consumed, (uint32_t)(len - bytes_consumed), bytes_consumed_this_time)) {
+
+        try {
+          auto ublox_msg = parser.gen_msg();
+          if (ublox_msg.second.size() > 0) {
+            auto bytes = ublox_msg.second.asBytes();
+            pm.send(ublox_msg.first.c_str(), bytes.begin(), bytes.size());
+          }
+        } catch (const std::exception& e) {
+          LOGE("Error parsing ublox message %s", e.what());
+        }
+
+        parser.reset();
+      }
+      bytes_consumed += bytes_consumed_this_time;
+    }
+  }
+
+  return 0;
+}