src/marnav/nmea/tfi.cpp

   1 #include <marnav/nmea/tfi.hpp>
   2 #include <marnav/nmea/io.hpp>
   3 #include <stdexcept>
   4
   5 namespace marnav
   6 {
   7 namespace nmea
   8 {
   9 namespace
  10 {
  11 /// Converts data read from the NMEA string to the corresponding
  12 /// enumerator.
  13 ///
  14 /// @param[in] value The numerical value to convert.
  15 /// @return The corresponding enumerator.
  16 /// @exception std::invalid_argument The specified value to convert is unknown.
  17 ///
  18 static tfi::state state_mapping(typename std::underlying_type<tfi::state>::type value)
  19 {
  20         switch (value) {
  21                 case 0:
  22                         return tfi::state::off;
  23                 case 1:
  24                         return tfi::state::on;
  25                 case 2:
  26                         return tfi::state::no_answer;
  27         }
  28         throw std::invalid_argument{"invaild value for conversion to tfi::state"};
  29 }
  30 }
  31
  32 std::string to_string(tfi::state value)
  33 {
  34         switch (value) {
  35                 case tfi::state::off:
  36                         return "0";
  37                 case tfi::state::on:
  38                         return "1";
  39                 case tfi::state::no_answer:
  40                         return "2";
  41         }
  42         throw std::invalid_argument{"invaild value for conversion of tfi::state"};
  43 }
  44
  45 constexpr sentence_id tfi::ID;
  46 constexpr const char * tfi::TAG;
  47 constexpr const int tfi::num_sensors;
  48
  49 tfi::tfi()
  50         : sentence(ID, TAG, talker::global_positioning_system)
  51 {
  52         for (auto & t : sensors_)
  53                 t = state::no_answer;
  54 }
  55
  56 tfi::tfi(talker talk, fields::const_iterator first, fields::const_iterator last)
  57         : sentence(ID, TAG, talk)
  58 {
  59         if (std::distance(first, last) != 3)
  60                 throw std::invalid_argument{"invalid number of fields in tfi"};
  61
  62         for (size_t i = 0; i < num_sensors; ++i)
  63                 read(*(first + i), sensors_[i], state_mapping);
  64 }
  65
  66 void tfi::check_index(int index) const
  67 {
  68         if ((index < 0) || (index >= num_sensors)) {
  69                 throw std::out_of_range{"sensor index out of range"};
  70         }
  71 }
  72
  73 tfi::state tfi::get_sensor(int index) const
  74 {
  75         check_index(index);
  76         return sensors_[index];
  77 }
  78
  79 void tfi::set_sensor(int index, state t)
  80 {
  81         check_index(index);
  82         sensors_[index] = t;
  83 }
  84
  85 void tfi::append_data_to(std::string & s) const
  86 {
  87         for (auto const & t : sensors_)
  88                 append(s, to_string(t));
  89 }
  90 }
  91 }