Initial commit

Lts/Proxies/WirelessLocationSystem/wls_sfm_message.cpp

@@ -0,0 +1,100 @@
+/**
+  * Messages from/to a SFM (passed through Wls message PayloadMobileToHost / PayloadHostToMobile
+  * $Id$
+  * $HeadURL$
+  * $Author$
+  * Created by Christian Ehrlicher, SLSE, 2017-01-10
+  */
+
+#include "wls_sfm_message.h"
+
+
+namespace WirelessLocationSystem
+{
+
+/// -------------- SfmMsgGpsControl_tx --------------
+
+QByteArray SfmMsgGpsControl_tx::getPayload() const
+{
+  QByteArray payload;
+  payload.append(isGpsOn() ? 1 : 0);
+  return payload;
+}
+
+/// ---------- SfmMsgEquipmentId_rx ----------
+bool SfmMsgEquipmentId::setPayload(const QByteArray &p_payload)
+{
+  if (p_payload.size() != s_payloadSize)
+    return false;
+
+  m_equipmentNumber = p_payload[0] << 8;
+  m_equipmentNumber |= ((unsigned short)p_payload[1]) & 0xFF;
+
+  return true;
+}
+
+QByteArray SfmMsgEquipmentId::getPayload() const
+{
+  QByteArray retVal(3, Qt::Uninitialized);
+  retVal[0] = (m_equipmentNumber >> 8) & 0xFF;
+  retVal[1] = m_equipmentNumber & 0xFF;
+  retVal[2] = 0;
+  return retVal;
+}
+
+/// ---------- SfmMsgTacticalState_rx ----------
+bool SfmMsgTacticalState_rx::setPayload(const QByteArray &p_payload)
+{
+  if (p_payload.size() != s_payloadSize)
+    return false;
+  m_tacticalState = p_payload[0];
+
+  return true;
+}
+
+/// ---------- SfmMsgTetra ----------
+bool SfmMsgTetra_rx::setPayload(const QByteArray &p_data)
+{
+  if (p_data.size() < 3)
+    return false;
+
+  m_sendCounter = p_data[0];
+  m_fragmentByte = p_data[1];
+  m_payload = p_data.mid(2);
+
+  return true;
+}
+
+// ---------- Acknowledge_rx ----------
+bool Acknowledge_rx::setPayload(const QByteArray &p_data)
+{
+  if (p_data.size() != s_payloadSize)
+    return false;
+  m_recvCounter = p_data[0];
+  m_ackState = p_data[1];
+  return true;
+}
+
+// ---------- Acknowledge_tx ----------
+QByteArray Acknowledge_tx::getPayload() const
+{
+  QByteArray ba(2, Qt::Uninitialized);
+  ba[0] = m_recvCounter;
+  ba[1] = m_ackState;
+  return ba;
+}
+
+
+/// ---------- SfmMsgLizensStatus ----------
+bool SfmMsgLicenseState_rx::setPayload(const QByteArray &p_data)
+{
+  if (p_data.size() != s_payloadSize)
+    return false;
+
+  if (p_data[0] != 0 && p_data[0] != 1)
+    return false;
+  m_isLicensed = p_data[0] ? true : false;
+  return true;
+}
+
+} // namespace WirelessLocationSystem