Diff: Payloads/PayloadV2.cpp

Revision:

0:a29a0225f203

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Payloads/PayloadV2.cpp	Mon Apr 02 22:05:20 2012 +0000
@@ -0,0 +1,156 @@
+/** IoT Gateway RFM12B payload V2 format handling
+ *
+ * @author Andrew Lindsay
+ *
+ * @section LICENSE
+ *
+ * Copyright (c) 2012 Andrew Lindsay (andrew [at] thiseldo [dot] co [dot] uk)
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, including without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ * 
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ * 
+ * @section DESCRIPTION
+ * 
+ * 
+ */
+
+#include "mbed.h"
+#include "PayloadV2.h"
+
+
+// Constructors for a new 21 payload
+PayloadV2::PayloadV2( ) : PayloadDef() {}
+
+PayloadV2::PayloadV2( uint8_t *pptr, short plen ): PayloadDef( pptr, plen ) {
+    uint8_t *ptr = pptr;
+    ptr += 4;
+    // Scan through payload counting readings
+    while ( ptr < (pptr + plen) ) {
+        switch ( *ptr & 0xf0 ) {
+            case 0x00:      // Byte
+                readingCount++;
+                ptr += 4;
+                break;
+            case 0x10:      // short, 16 bit
+                readingCount++;
+                ptr += 5;
+                break;
+            case 0x20:      // 32 bit
+                readingCount++;
+                ptr += 7;
+                break;
+            case 0x30:      // string
+                readingCount++;
+                ptr += 2;
+//                printf("String %d\n", *ptr);
+                if ( *ptr <= 40 )
+                    ptr += *ptr;
+                break;
+        }
+    }
+}
+
+short PayloadV2::numReadings() {
+    return readingCount;
+}
+
+uint8_t *PayloadV2::readingPtr( short readingNum ) {
+    uint8_t *ptr = payloadBuffer;
+    short currentReading = 0;
+    
+//    for(int i=0; i<payloadLen; i++ ) 
+//        printf("%02X ",*ptr++);
+//    ptr = payloadBuffer;
+//    printf("\n");
+    ptr += 4;
+
+    // Scan through payload readings
+    while ( ptr < (payloadBuffer + payloadLen) ) {
+        switch ( *ptr & 0xf0 ) {
+            case 0x00:      //
+                if ( currentReading == readingNum )
+                    return ptr;
+                currentReading++;
+                ptr += 3;
+                break;
+            case 0x10:      //
+                if ( currentReading == readingNum )
+                    return ptr;
+                currentReading++;
+                ptr += 4;
+                break;
+            case 0x20:      //
+                if ( currentReading == readingNum )
+                    return ptr;
+                currentReading++;
+                ptr += 6;
+                break;
+            case 0x30:      //
+                if ( currentReading == readingNum )
+                    return ptr;
+                currentReading++;
+                ptr += 2;
+                if ( *ptr <= 40 )
+                    ptr += *ptr;
+                break;
+            default:
+                ptr++;
+        }
+    }
+    return NULL;
+}
+
+int8_t PayloadV2::readingByte( short readingNum ) {
+    uint8_t *ptr = readingPtr( readingNum );
+
+    payloadv2ByteReading *bptr = (payloadv2ByteReading*)ptr;
+    return bptr->reading;
+}
+
+short PayloadV2::readingShort( short readingNum ) {
+    uint8_t *ptr = readingPtr( readingNum );
+    payloadv2ShortReading *bptr = (payloadv2ShortReading*)ptr;
+    return bptr->reading;
+}
+
+int PayloadV2::reading( short readingNum ) {
+    return( readingLong( readingNum ) );
+}
+    
+int PayloadV2::readingLong( short readingNum ) {
+    uint8_t *ptr = readingPtr( readingNum );
+
+    payloadv2LongReading *bptr = (payloadv2LongReading*)ptr;
+//    printf("Long Reading %ld\n",bptr->reading);
+    return bptr->reading;
+}
+
+short PayloadV2::readingType( short readingNum ) {
+    uint8_t *ptr = readingPtr( readingNum );
+    payloadv2Header *bptr = (payloadv2Header*)ptr;
+    return bptr->typeId >>4;
+}
+
+short PayloadV2::sensorId( short readingNum ) {
+    uint8_t *ptr = readingPtr( readingNum );
+
+    payloadv2Header *bptr = (payloadv2Header*)ptr;
+    
+//    printf("Sensor ID from pkt is %d, values %2x %2x\n", (bptr->typeId & 0x0f << 8) | bptr->id,bptr->typeId, bptr->id );
+    return (bptr->typeId & 0x0f << 8) | bptr->id;
+}