Diff: main.cpp

Revision:

2:a8f00db60fdb

Parent:

0:a5e3347bad61

Child:

3:d81e4a63fb2e

--- a/main.cpp	Thu Jun 18 23:23:55 2015 +0000
+++ b/main.cpp	Thu Jul 02 01:03:13 2015 +0000
@@ -18,9 +18,21 @@
 #include "gps.h"
 #include "debug.h"
 
+
 #define SENET_F
 //#define SMTC
 
+typedef enum {
+    MOTE_NONE = 0,
+    MOTE_V2,
+    MOTE_V3
+} mote_version_e;
+mote_version_e mote_version = MOTE_NONE;
+
+DigitalOut pc_7(PC_7);
+DigitalIn pc_1(PC_1);
+
+
 /* ****************************************** */
 /* ***** Basic App and Network Parameters *** */
 /* ****************************************** */
@@ -113,6 +125,24 @@
 //////////////////////////////////////////////////
 // MAIN - INITIALIZATION AND STARTUP
 //////////////////////////////////////////////////
+void get_mote_version()
+{
+    char first;
+    
+    /*DigitalOut pc_7(PC_7);
+      DigitalIn pc_1(PC_1);*/
+      
+    pc_7 = 1;
+    first = pc_1;
+    pc_7 = 0;
+    if (first && !pc_1) {
+        //printf("v2-mote\r\n");
+        mote_version = MOTE_V2;
+    } else {
+        //printf("v3-mote\r\n");
+        mote_version = MOTE_V3;
+    }
+}
 
 // initial job
 static void initfunc (osjob_t* j) {
@@ -130,6 +160,12 @@
     // init done - onEvent() callback will be invoked...
 
     //DEBUG_STR("E: INITFUNC");
+    get_mote_version();
+    if (mote_version == MOTE_V3)
+        gps.en_invert = false;
+    else
+        gps.en_invert = true;
+        
     gps.init();
     gps.enable(1);
     //gps.verbose = 1;