re-implementation of C serial forwarder in C++

[tinyos-2.x.git] / support / sdk / cpp / sf / sfpacket.cpp

diff --git a/support/sdk/cpp/sf/sfpacket.cpp b/support/sdk/cpp/sf/sfpacket.cpp
new file mode 100644 (file)
index 0000000..8fc555f
--- /dev/null
+++ b/support/sdk/cpp/sf/sfpacket.cpp
@@ -0,0 +1,141 @@
+/*
+ * Copyright (c) 2007, Technische Universitaet Berlin
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without 
+ * modification, are permitted provided that the following conditions 
+ * are met:
+ * - Redistributions of source code must retain the above copyright notice,
+ *   this list of conditions and the following disclaimer.
+ * - Redistributions in binary form must reproduce the above copyright 
+ *   notice, this list of conditions and the following disclaimer in the 
+ *   documentation and/or other materials provided with the distribution.
+ * - Neither the name of the Technische Universitaet Berlin nor the names 
+ *   of its contributors may be used to endorse or promote products derived
+ *   from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
+ * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 
+ * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 
+ * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED 
+ * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, 
+ * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY 
+ * OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE 
+ * USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+/**
+ * @author Philipp Huppertz <huppertz@tkn.tu-berlin.de>
+ */
+
+#include "sfpacket.h"
+
+SFPacket::SFPacket(int pType, int pSeqno)
+{
+    length = 0;
+    seqno = pSeqno;
+    type = pType;
+}
+
+// copy constructor
+SFPacket::SFPacket(const SFPacket &pPacket)
+{
+    length = pPacket.getLength();
+    type = pPacket.getType();
+    setPayload(pPacket.getPayload(), length);
+}
+
+SFPacket::~SFPacket()
+{
+    // if (buffer) delete[] buffer;
+}
+
+const char* SFPacket::getPayload() const
+{
+    if ( ((type == SF_PACKET_ACK) || (type == SF_PACKET_NO_ACK)))
+    {
+        return payloadBuffer;
+    }
+    else
+    {
+        return NULL;
+    }
+}
+
+int SFPacket::getLength() const
+{
+    return length;
+}
+
+int SFPacket::getType() const
+{
+    return type;
+}
+
+int SFPacket::getSeqno() const
+{
+    return seqno;
+}
+
+bool SFPacket::setPayload(const char* pBuffer, uint8_t pLength)
+{
+    if ((pLength > 0) && (pLength < cMaxPacketLength) && ((type == SF_PACKET_ACK) || (type == SF_PACKET_NO_ACK)))
+    {
+        length = pLength;
+        for (int i=0; i < pLength; i++)
+        {
+            payloadBuffer[i] = *(pBuffer+i);
+        }
+        return true;
+    }
+    DEBUG("SFPACKET::setPayload : wrong packet length = " << static_cast<int>(pLength) << " or type = " << type)
+    return false;
+}
+
+void SFPacket::setSeqno(int pSeqno)
+{
+    seqno = pSeqno;
+}
+
+void SFPacket::setType(int pType)
+{
+    type = pType;
+}
+
+int const SFPacket::getMaxPayloadLength()
+{
+    return cMaxPacketLength;
+}
+
+/* == operator */
+bool SFPacket::operator==(SFPacket const& pPacket)
+{
+    bool retval=false;
+    if (!((pPacket.getType() != type) || (pPacket.getLength() != length) || pPacket.getSeqno() != seqno))
+    {
+        if ((type == SF_PACKET_ACK) || (type == SF_PACKET_NO_ACK))
+        {
+            const char* cmpBuffer = pPacket.getPayload();
+            if (cmpBuffer) {
+               retval = true;
+                // compare buffers
+                for (int i=0; i < length; i++)
+                {
+                    if (payloadBuffer[i] != cmpBuffer[i])
+                    {
+                        i = length;
+                        retval = false;
+                    }
+                }
+           }
+        }
+        else
+        {
+            retval = true;
+        }
+    }
+    return retval;
+}
+