LP Long Distance IR Vision Robot

Dependencies:   max77650_charger_sample BufferedSerial SX1276GenericLib Adafruit-MotorShield NEO-6m-GPS MAX17055_EZconfig Adafruit_GFX USBDeviceHT Adafruit-PWM-Servo-Driver

Revision:
26:69aba05f010f
Parent:
25:1a031add188a
Child:
27:6b549f838f0a
diff -r 1a031add188a -r 69aba05f010f main.cpp
--- a/main.cpp	Thu Jul 19 21:13:19 2018 +0000
+++ b/main.cpp	Fri Jul 20 16:31:41 2018 +0000
@@ -46,6 +46,23 @@
     GridEye gridEye(i2cGridEye);
 #endif
 
+
+/***************************************************************************
+ * Function Prototypes
+ **************************************************************************/
+/** 
+ * @brief This function constructs a payload buffer that is used in transmitting data in a LoRa Message
+ */
+//void fillPayloadWithGlobalBufs(uint8_t * payload_buffer_tx); 
+
+/** 
+ * @brief This function deconstructs a payload buffer that contains data from a received LoRa Message
+ */
+//void fillGlobalBufsWithPayload(uint8_t * payload_buffer_rx); 
+
+/***************************************************************************
+ * main()
+ **************************************************************************/
 int main() 
 {
     /*
@@ -66,10 +83,31 @@
         dprintf("MAX32620FTHR: Slave");
     #endif
     
-    /***************************************************************************
-     * Lora Communications
-     **************************************************************************/
-    SX1276PingPongSetup();
+
+/***************************************************************************
+ * Lora Communication Buffers
+ **************************************************************************/
+    /* Create Buffers to store both incoming and outgoing LoRa communications */
+    BufferTx = new  uint8_t[BufferSizeTx];
+    BufferRx = new  uint8_t[BufferSizeRx];
+    
+
+
+/***************************************************************************
+ * Store Aliases to the buffers created here in main porgram
+ **************************************************************************/
+
+/***************************************************************************
+ * Continue with Finishing Setup by Calling other functions
+ **************************************************************************/
+    
+    
+    /* Pass in pointers to the two buffers for LoRa communication to the sx1276 
+    `* Setup so that the LoRa communications know where data needs to be both
+     * stored to in a case of Receiving or where to find data in case of a 
+     * Transmistion occuring.
+     */
+    SX1276PingPongSetup(BufferTx, BufferRx);
     
     /***************************************************************************
      * Grid Eye Sensor: Non-Buffer Program Variables
@@ -79,6 +117,9 @@
     #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
         // none yet
         int frame_idx = 0;
+        char local_curr_raw_frame_data_to_master[size_of_grid_eye];
+        char local_prev_raw_frame_data_to_master[size_of_grid_eye];
+        int16_t local_conv_frame_data_to_master[64];
     #endif
     
     
@@ -89,28 +130,30 @@
          **************************************************************************/
         #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
             // Check to see if the contents of the previous scan are the same. If they are different then continue with converting
-            if( memcmp(prev_raw_frame_data_from_slave, curr_raw_frame_data_from_slave, sizeof(curr_raw_frame_data_from_slave)) != 0 )
-            {
+            //if( memcmp(prev_raw_frame_data_from_slave, curr_raw_frame_data_from_slave, sizeof(curr_raw_frame_data_from_slave)) != 0 )
+            //{
                 // Convert raw data sent from slave to a 16 bit integer array by calling this
                 convRaw8x8Data2Point25degC(curr_raw_frame_data_from_slave, conv_frame_data_from_slave);
                 
+                wait_ms(10);
+                
                 // Next Print off the Converted data
-                dprintf("\r\nFrame %d data: \r\n", frame_idx);
+                pc.printf("\r\nFrame %d data: \r\n", frame_idx);
                 uint8_t idx;
                 float pixel_data;
                 for (int y = 0; y < 8; y++) {
                     for (int x = 0; x < 8; x++) {
                         idx = y*8 + x;
                         pixel_data = conv_frame_data_from_slave[idx]/4.0;
-                        dprintf("%.2f  \t", pixel_data);
+                        pc.printf("%.2f  \t", pixel_data);
                     }
-                    dprintf("\r\n\r\n");
+                    pc.printf("\r\n\r\n");
                 }
-                dprintf("\r\n");
+                pc.printf("\r\n");
                 
                 // Increment frame counter
                 frame_idx = frame_idx +1;
-            }
+            //}
             
             /* Next copy in data received from current data into buffer used for
              * comparison next time the memcmp above is called. This prevents the 
@@ -122,13 +165,15 @@
             
         #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
             // Aquire raw data about 8x8 frame from the grid eye sensor in this function call 
-            gridEye.getRaw8x8FrameData(curr_raw_frame_data_to_master);
-            wait_ms( 1000 );  
-            
-            //if ( memcmp(prev_raw_frame_data_to_master, curr_raw_frame_data_to_master, sizeof(curr_raw_frame_data_to_master)) != 0 )
-            //{
+            gridEye.getRaw8x8FrameData(local_curr_raw_frame_data_to_master);
+            wait_ms( 10 );  
+/*            
+            if ( memcmp(prev_raw_frame_data_to_master, curr_raw_frame_data_to_master, sizeof(curr_raw_frame_data_to_master)) != 0 )
+            {
                 // Convert raw data sent from slave to a 16 bit integer array by calling this
-                convRaw8x8Data2Point25degC(curr_raw_frame_data_to_master, conv_frame_data_to_master);
+                convRaw8x8Data2Point25degC(local_curr_raw_frame_data_to_master, local_conv_frame_data_to_master);
+                
+                wait_ms(10);
                 
                 // Next Print off the Converted data
                 pc.printf("\r\nFrame %d data: \r\n", frame_idx);
@@ -137,7 +182,7 @@
                 for (int y = 0; y < 8; y++) {
                     for (int x = 0; x < 8; x++) {
                         idx = y*8 + x;
-                        pixel_data = conv_frame_data_to_master[idx]/4.0;
+                        pixel_data = local_conv_frame_data_to_master[idx]/4.0;
                         pc.printf("%.2f  \t", pixel_data);
                     }
                     pc.printf("\r\n\r\n");
@@ -146,13 +191,22 @@
                 
                 // Increment frame counter
                 frame_idx = frame_idx +1;
-            //}
-            memcpy(prev_raw_frame_data_to_master, curr_raw_frame_data_to_master, sizeof(curr_raw_frame_data_to_master));
+            }
+*/          
+            
+            memcpy(curr_raw_frame_data_to_master, local_curr_raw_frame_data_to_master, sizeof(curr_raw_frame_data_to_master));
+            memcpy(local_prev_raw_frame_data_to_master, local_curr_raw_frame_data_to_master, sizeof(local_curr_raw_frame_data_to_master));
         #endif
 
         /***************************************************************************
         * Lora Communications
         **************************************************************************/
+        #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
+            dprintf("MAX32630FTHR: Master");
+        #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
+            memcpy(&BufferTx[tx_idx_signature], PongMsg,                       size_signature);
+            memcpy(&BufferTx[tx_idx_grid_eye],  local_curr_raw_frame_data_to_master, size_of_grid_eye);
+        #endif
         wait_ms( 10 );  
         SX1276PingPong();
     
@@ -163,3 +217,42 @@
     }
     
 }
+
+
+
+
+/** 
+ * @brief This function constructs a payload buffer that is used in transmitting data in a LoRa Message
+ */
+void fillPayloadWithGlobalBufs(uint8_t * BufferTx)
+{
+    /* The master and slave devices will have different requirements for creating payload */
+    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
+        memcpy(&BufferTx[tx_idx_signature], PingMsg,                       size_signature); // SX1276PingPong() uses this to detect if the message was sent from the correct Slave Device
+        memcpy(&BufferTx[tx_idx_ble],       curr_ble_data_to_slave,        size_of_ble);
+    #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
+        memcpy(&BufferTx[tx_idx_signature], PongMsg,                       size_signature); // SX1276PingPong() uses this to detect if the message was sent from the correct Master Device
+        memcpy(&BufferTx[tx_idx_grid_eye],  curr_raw_frame_data_to_master, size_of_grid_eye);
+        memcpy(&BufferTx[tx_idx_gps],       curr_gps_data_to_master,       size_of_gps);
+        memcpy(&BufferTx[tx_idx_MAX17055],  curr_MAX17055_to_master,       size_of_MAX17055);
+        memcpy(&BufferTx[tx_idx_MAX77650],  curr_MAX77650_to_master,       size_of_MAX77650);
+    #endif
+    return;
+}
+
+/** 
+ * @brief This function deconstructs a payload buffer that contains data from a received LoRa Message
+ */
+void fillGlobalBufsWithPayload(uint8_t * BufferRx)
+{
+    /* The master and slave devices will have different requirements for offloading payload */
+    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
+        memcpy(curr_raw_frame_data_from_slave, &BufferRx[rx_idx_grid_eye], size_of_grid_eye);
+        memcpy(curr_gps_data_from_slave,       &BufferRx[rx_idx_gps],      size_of_gps);
+        memcpy(curr_MAX17055_from_slave,       &BufferRx[rx_idx_MAX17055], size_of_MAX17055);
+        memcpy(curr_MAX77650_from_slave,       &BufferRx[rx_idx_MAX77650], size_of_MAX77650);
+    #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
+        memcpy(curr_ble_data_from_master,      &BufferRx[rx_idx_ble],      size_of_ble);
+    #endif
+    return;
+} 
\ No newline at end of file