src/marnav/nmea/xdr.cpp

   1 #include "xdr.hpp"
   2 #include <marnav/nmea/io.hpp>
   3
   4 namespace marnav
   5 {
   6 namespace nmea
   7 {
   8 MARNAV_NMEA_DEFINE_SENTENCE_PARSE_FUNC(xdr)
   9
  10 namespace
  11 {
  12 inline std::string to_string(const utils::optional<xdr::transducer_info> & data)
  13 {
  14         if (!data)
  15                 return std::string{};
  16         auto const & value = data.value();
  17         return marnav::nmea::to_string(value.transducer_type) + ","
  18                 + marnav::nmea::to_string(value.measurement_data) + ","
  19                 + marnav::nmea::to_string(value.units_of_measurement) + ","
  20                 + marnav::nmea::to_string(value.name);
  21 }
  22 }
  23
  24 constexpr const char * xdr::TAG;
  25
  26 xdr::xdr()
  27         : sentence(ID, TAG, talker_id::transducer)
  28 {
  29 }
  30
  31 xdr::xdr(const std::string & talker, fields::const_iterator first, fields::const_iterator last)
  32         : sentence(ID, TAG, talker)
  33 {
  34         const auto size = std::distance(first, last);
  35         if ((size < 1) || (size > 4 * xdr::max_transducer_info))
  36                 throw std::invalid_argument{"invalid number of fields in xdr"};
  37
  38         if ((size % 4) != 0)
  39                 throw std::invalid_argument{"unexpected number of fields in xdr (quadruples?)"};
  40
  41         int index = 0;
  42         for (auto i = 0; i < size; i += 4, ++index) {
  43                 xdr::transducer_info info;
  44                 read(*(first + i + 0), info.transducer_type);
  45                 read(*(first + i + 1), info.measurement_data);
  46                 read(*(first + i + 2), info.units_of_measurement);
  47                 read(*(first + i + 3), info.name);
  48                 set_info(index, info);
  49         }
  50 }
  51
  52 void xdr::check_index(int index) const
  53 {
  54         if ((index < 0) || (index >= 4 * max_transducer_info)) {
  55                 throw std::out_of_range{"transducer index out of range"};
  56         }
  57 }
  58
  59 void xdr::set_info(int index, const transducer_info & info)
  60 {
  61         check_index(index);
  62         transducer_data[index] = info;
  63 }
  64
  65 utils::optional<xdr::transducer_info> xdr::get_info(int index) const
  66 {
  67         check_index(index);
  68         return transducer_data[index];
  69 }
  70
  71 std::vector<std::string> xdr::get_data() const
  72 {
  73         std::vector<std::string> result;
  74         for (const auto & data : transducer_data) {
  75                 auto s = to_string(data);
  76                 if (!s.empty())
  77                         result.push_back(s);
  78         }
  79         return result;
  80 }
  81 }
  82 }