src/marnav/seatalk/message_52.cpp

   1 #include "message_52.hpp"
   2 #include <cmath>
   3
   4 namespace marnav
   5 {
   6 namespace seatalk
   7 {
   8
   9 message_52::message_52()
  10         : message(ID)
  11         , sog(0)
  12 {
  13 }
  14
  15 std::unique_ptr<message> message_52::parse(const raw & data)
  16 {
  17         check_size(data, SIZE);
  18
  19         std::unique_ptr<message> result = utils::make_unique<message_52>();
  20         message_52 & msg = static_cast<message_52 &>(*result);
  21
  22         //  52  01 XX XX
  23         // raw   1  2  3
  24
  25         msg.sog = 0;
  26         msg.sog += data[2];
  27         msg.sog <<= 8;
  28         msg.sog += data[3];
  29
  30         return result;
  31 }
  32
  33 raw message_52::get_data() const
  34 {
  35         return raw{static_cast<uint8_t>(ID), 0x01, static_cast<uint8_t>((sog >> 8) & 0xff),
  36                 static_cast<uint8_t>((sog >> 0) & 0xff)};
  37 }
  38
  39 /// Returns the speed over ground in knots.
  40 double message_52::get_sog() const noexcept
  41 {
  42         return 0.1 * sog;
  43 }
  44
  45 /// Sets the speed over ground in knots.
  46 void message_52::set_sog(double t) noexcept
  47 {
  48         sog = std::floor(t * 10.0);
  49 }
  50 }
  51 }