src/marnav/nmea/rpm.cpp

   1 #include "rpm.hpp"
   2 #include <marnav/nmea/io.hpp>
   3
   4 namespace marnav
   5 {
   6 namespace nmea
   7 {
   8 MARNAV_NMEA_DEFINE_SENTENCE_PARSE_FUNC(rpm)
   9
  10 namespace
  11 {
  12 /// Converts data read from the NMEA string to the corresponding
  13 /// enumerator.
  14 ///
  15 /// @param[in] value The numerical value to convert.
  16 /// @return The corresponding enumerator.
  17 /// @exception std::invalid_argument The specified value to convert is unknown.
  18 ///
  19 static rpm::source_id source_id_mapping(
  20         typename std::underlying_type<rpm::source_id>::type value)
  21 {
  22         switch (value) {
  23                 case 'S':
  24                         return rpm::source_id::shaft;
  25                 case 'E':
  26                         return rpm::source_id::engine;
  27         }
  28         throw std::invalid_argument{"invaild value for conversion to rpm::source_id"};
  29 }
  30 }
  31
  32 std::string to_string(rpm::source_id value)
  33 {
  34         switch (value) {
  35                 case rpm::source_id::shaft:
  36                         return "S";
  37                 case rpm::source_id::engine:
  38                         return "E";
  39         }
  40         throw std::invalid_argument{"invaild value for conversion of rpm::source_id"};
  41 }
  42
  43 constexpr const char * rpm::TAG;
  44
  45 rpm::rpm()
  46         : sentence(ID, TAG, talker_id::integrated_instrumentation)
  47 {
  48 }
  49
  50 rpm::rpm(talker talk, fields::const_iterator first, fields::const_iterator last)
  51         : sentence(ID, TAG, talk)
  52 {
  53         if (std::distance(first, last) != 5)
  54                 throw std::invalid_argument{"invalid number of fields in rpm"};
  55
  56         read(*(first + 0), source, source_id_mapping);
  57         read(*(first + 1), source_number);
  58         read(*(first + 2), revolutions);
  59         read(*(first + 3), propeller_pitch);
  60         read(*(first + 4), data_valid);
  61 }
  62
  63 void rpm::set_source(source_id id, uint32_t num)
  64 {
  65         source = id;
  66         source_number = num;
  67 }
  68
  69 std::vector<std::string> rpm::get_data() const
  70 {
  71         return {to_string(source), to_string(source_number), format(revolutions, 1),
  72                 format(propeller_pitch, 1), to_string(data_valid)};
  73 }
  74 }
  75 }