src/marnav/nmea/gsa.cpp

   1 #include "gsa.hpp"
   2 #include <limits>
   3 #include <marnav/nmea/io.hpp>
   4
   5 namespace marnav
   6 {
   7 namespace nmea
   8 {
   9 MARNAV_NMEA_DEFINE_SENTENCE_PARSE_FUNC(gsa)
  10
  11 constexpr const char * gsa::TAG;
  12
  13 gsa::gsa()
  14         : sentence(ID, TAG, talker_id::global_positioning_system)
  15 {
  16 }
  17
  18 gsa::gsa(talker talk, fields::const_iterator first, fields::const_iterator last)
  19         : sentence(ID, TAG, talk)
  20 {
  21         if (std::distance(first, last) != 17)
  22                 throw std::invalid_argument{"invalid number of fields in gsa"};
  23
  24         read(*(first + 0), sel_mode);
  25         read(*(first + 1), mode);
  26
  27         constexpr uint32_t init_val = std::numeric_limits<uint32_t>::max();
  28
  29         int index = 2;
  30         for (auto i = 0; i < max_satellite_ids; ++i, ++index) {
  31                 uint32_t id = init_val;
  32                 read(*(first + index), id);
  33                 if (id != init_val)
  34                         set_satellite_id(i, id);
  35         }
  36         read(*(first + 14), pdop);
  37         read(*(first + 15), hdop);
  38         read(*(first + 16), vdop);
  39 }
  40
  41 void gsa::check_index(int index) const
  42 {
  43         if ((index < 0) || (index >= max_satellite_ids)) {
  44                 throw std::out_of_range{"satellite id out of range"};
  45         }
  46 }
  47
  48 void gsa::set_satellite_id(int index, uint32_t t)
  49 {
  50         check_index(index);
  51         satellite_id[index] = t;
  52 }
  53
  54 utils::optional<uint32_t> gsa::get_satellite_id(int index) const
  55 {
  56         check_index(index);
  57         return satellite_id[index];
  58 }
  59
  60 std::vector<std::string> gsa::get_data() const
  61 {
  62         return {to_string(sel_mode), to_string(mode), format(satellite_id[0], 2),
  63                 format(satellite_id[1], 2), format(satellite_id[2], 2), format(satellite_id[3], 2),
  64                 format(satellite_id[4], 2), format(satellite_id[5], 2), format(satellite_id[6], 2),
  65                 format(satellite_id[7], 2), format(satellite_id[8], 2), format(satellite_id[9], 2),
  66                 format(satellite_id[10], 2), format(satellite_id[11], 2), to_string(pdop),
  67                 to_string(hdop), to_string(vdop)};
  68 }
  69 }
  70 }