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

main.cpp

Committer:
dev_alexander
Date:
2018-07-20
Revision:
27:6b549f838f0a
Parent:
26:69aba05f010f
Child:
28:0ed92c590607

File content as of revision 27:6b549f838f0a:

/*
 * Copyright (c) 2018 HELIOS Software GmbH
 * 30826 Garbsen (Hannover) Germany
 * Licensed under the Apache License, Version 2.0);
 */
  
 /*
 * For Wiring Instructions, please visit the link below:
 * https://www.hackster.io/DevinAlex64/getting-started-with-the-max32620fthr-and-lora-f9d8dd\
 */
 
 #include "main.h"
 #include "global_buffers.h"
 #include "GridEye.h"


/* If the board that is compiled is the master device (BLE enabled MAX32630FTHR),
 * then it needs this library and needs to be configed in order for the device to 
 * work with a 3.3volt output instead of a 1.8 volt output. 
 * 
 * This is only needed for the MAX32630FTHR. The MAX325620FTHR is exampt from this 
 * additional setup in the main program.
 */ 
 #if defined(TARGET_MAX32630FTHR) // using the RFM95 board
   #include "max32630fthr.h"
    MAX32630FTHR pegasus(MAX32630FTHR::VIO_3V3);
 #endif

DigitalOut myled(LED);

//Serial pc(USBTX, USBRX);


#if   defined(TARGET_MAX32630FTHR) // Master Device: MAX32630FTHR BLE-to-LoRa Gateway
    /* No grid eye object needed. The function the master uses to convert the raw 
     * data that is sent over from the slave deevice that contains the data from the
     * actual grid eye sensor is actually a function that is not part of the grid eye
     * class. this is due to the fact that the grid eye class requires n i2c bus to 
     * be assigned to a phyiscal sensor. In this case, the library for the Grid Eye 
     * sensor has a support functin that is used to convert data that is aquired from 
     * the grid eye sensor. So it is not supposed to be a class specific function.
    */
#elif defined(TARGET_MAX32620FTHR) // Slave Device: Robot
    //Init I2C communications in default I2C bus I2C #1
    I2C i2cGridEye(P3_4,P3_5);
    GridEye gridEye(i2cGridEye);
#endif


/***************************************************************************
 * main()
 **************************************************************************/
int main() 
{
    /*
     * inits the Serial or USBSerial when available (230400 baud).
     * If the serial uart is not is not connected it swiches to USB Serial
     * blinking LED means USBSerial detected, waiting for a connect.
     * It waits up to 30 seconds for a USB terminal connections 
     */
    InitSerial(30*1000, &myled);
    dprintf("Welcome to the SX1276GenericLib");
  
    dprintf("Starting a simple LoRa PingPong");
    
    /* Setup begins here: */
    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
        dprintf("MAX32630FTHR: Master");
    #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
        dprintf("MAX32620FTHR: Slave");
    #endif

/***************************************************************************
 * Lora Communication Buffers
 **************************************************************************/
    /* Create Buffers to store both incoming and outgoing LoRa communications */
    uint8_t BufferTx[BufferSizeTx];
    uint8_t BufferRx[BufferSizeRx];
    
/***************************************************************************
 * BLE Data Buffers
 **************************************************************************/
    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
        uint8_t curr_ble_data_to_slave[size_of_ble];
    #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
        uint8_t curr_ble_data_from_master[size_of_ble];
        uint8_t prev_ble_data_from_master[size_of_ble];
    #endif
/***************************************************************************
 * Grid Eye Sensor Data Buffers
 **************************************************************************/
    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
        char curr_raw_frame_data_from_slave[size_of_grid_eye];
        char prev_raw_frame_data_from_slave[size_of_grid_eye];
        int16_t conv_frame_data_from_slave[64];
    #elif defined(TARGET_MAX32620FTHR) // Client Device: LoRa Controlled Robot
        char curr_raw_frame_data_to_master[size_of_grid_eye];
        char prev_raw_frame_data_to_master[size_of_grid_eye];
        int16_t conv_frame_data_to_master[64];
    #endif
/***************************************************************************
 * GPS Data Buffers
 **************************************************************************/
    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
        uint8_t curr_gps_data_from_slave[size_of_gps];
        uint8_t prev_gps_data_from_slave[size_of_gps];
    #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
        uint8_t curr_gps_data_to_master[size_of_gps];
    #endif
/***************************************************************************
 * MAX17055 Data Buffers
 **************************************************************************/
    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
        uint8_t curr_MAX17055_from_slave[size_of_MAX17055];
        uint8_t prev_MAX17055_from_slave[size_of_MAX17055];
    #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
        uint8_t curr_MAX17055_to_master[size_of_MAX17055];
    #endif
    
/***************************************************************************
 * MAX77650 Data Buffers
 **************************************************************************/
    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
        uint8_t curr_MAX77650_from_slave[size_of_MAX77650];
        uint8_t prev_MAX77650_from_slave[size_of_MAX77650];
    #elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
        uint8_t curr_MAX77650_to_master[size_of_MAX77650];
    #endif
/***************************************************************************
 * Store Aliases to the buffers created here in main porgram
 **************************************************************************/
#if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
createAliasesForGlobalBufs(BufferTx,
                           BufferRx, 
                           curr_ble_data_to_slave,
                           curr_raw_frame_data_from_slave,
                           curr_gps_data_from_slave,
                           curr_MAX17055_from_slave,
                           curr_MAX77650_from_slave
                           );
#elif defined(TARGET_MAX32620FTHR) // Slave Device: LoRa Controlled Robot
createAliasesForGlobalBufs(BufferTx, 
                           BufferRx, 
                           curr_ble_data_from_master,
                           curr_raw_frame_data_to_master, 
                           curr_gps_data_to_master,
                           curr_MAX17055_to_master,
                           curr_MAX77650_to_master
                           );
#endif
/***************************************************************************
 * 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
     **************************************************************************/
    #if   defined(TARGET_MAX32630FTHR) // Master Device: BLE-to-LoRa Gateway
        int frame_idx = 0;
    #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
    
    
    while(1) 
    {
        /***************************************************************************
         * Grid Eye Sensor 
         **************************************************************************/
        #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 )
            {
                // 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
                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;
                        pc.printf("%.2f  \t", pixel_data);
                    }
                    pc.printf("\r\n\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 
             * program from converting the same raw data aquired by the grid eye
             * sensor on the slave device to the floating point array with the 
             * 0.25 degrees celsius precision level when there is not new data. 
             */
            //memcpy(prev_raw_frame_data_from_slave, curr_raw_frame_data_from_slave, sizeof(curr_raw_frame_data_from_slave));
            
        #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(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(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);
                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 = local_conv_frame_data_to_master[idx]/4.0;
                        pc.printf("%.2f  \t", pixel_data);
                    }
                    pc.printf("\r\n\r\n");
                }
                pc.printf("\r\n");
                
                // Increment frame counter
                frame_idx = frame_idx +1;
            }
*/          
            
            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
        **************************************************************************/

        wait_ms( 10 );  
        SX1276PingPong();
    
        
        
        
        
    }
    
}