Diff: config.cpp

Revision:

8:1b4bf6e5e029

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/config.cpp	Sun Dec 03 18:19:22 2017 +0000
@@ -0,0 +1,101 @@
+#include "config.h"
+#include "ATcommand.h"
+
+int configFromFile(char* path, Serial *xbee, Serial *pc, char * url){
+    pc->printf("\n\rConfig Filename: %s", path); 
+    
+    int maxRetry = 2;
+    
+    FILE* file = fopen(path, "r");
+    char line[256];
+    while (fgets(line, sizeof(line), file)) {
+        bool delimiterFound = false;
+        
+        // Line is a comment
+        if( (line[0]=='#') || (line[0]=='\n')){
+            pc->printf("\n\r%s", line); 
+            
+        // Line is url config
+        }else if(strstr(line, "url") != NULL){
+            int ptr = 0;
+            for(int i =0;i<sizeof(line)&& line[i]!='\0'; i++){
+                if(!delimiterFound){
+                    delimiterFound = (line[i]=='=');
+                }else{
+                    url[ptr] = line[i];
+                    ptr++;
+                }
+            }
+            pc->printf("Url:%s", url); 
+        
+        // Others line is AT COMMAND
+        }else{
+            int ptr = 0;
+            bool EOL = false;
+            pc->printf("AT Command\n\r"); 
+            for(int i =0;i<sizeof(line)&& !EOL; i++){
+                if(!delimiterFound){
+                    delimiterFound = (line[i]=='=');
+                    pc->printf("%c",line[i]); 
+                }else{
+                    
+                    // Send command
+                    char *cmd = NULL;
+                    char *params = NULL;
+                    int cmd_len = 0;
+                    int param_len = 0;
+                    
+                    for( ;i<sizeof(line)&& line[i]!= '\0'; i=i+2){
+                        unsigned char c = ahex2bin(line[i],line[i+1]);
+                        if(c == 0xDA){
+                            EOL =true;
+                        }else if(cmd_len <2){
+                            cmd = (char*)realloc(cmd ,sizeof(char)*(cmd_len+1));
+                            cmd[cmd_len++] = c;
+                        }else{
+                            params = (char*)realloc(params ,sizeof(char)*(param_len+1));
+                            params[param_len++] =  c;
+                        }
+                    }
+                    
+                    do{
+                        bool exit = false;
+                        sendAT(xbee, pc, cmd, params,param_len);
+                        wait_ms(200);
+                        ATWR (xbee, pc);
+                        wait_ms(200);
+                        apply(xbee, pc);
+                        wait_ms(200);                   
+                        // Verify command status
+                        char status = getStatusResponse(xbee, pc);
+                        if(status == 0x00){
+                            pc->printf("\n\rStatus OK"); 
+                            exit =true;      
+                        }else{
+                            if(status==0x02){
+                              pc->printf("\n\Invalid Command %d\n\r",status);  
+                            }     
+                            toggleError(xbee, pc, 200, "Warning status fail");  
+                            maxRetry--;    
+                        }
+                    }while(maxRetry>0 && !exit);
+                    free(cmd);
+                    free(params);
+                
+                    EOL =true;
+                }
+            }
+        }
+    }
+    fclose(file);
+    pc->printf("\n\rClose file"); 
+    return 0;
+}
+
+
+unsigned char ahex2bin (unsigned char MSB, unsigned char LSB){  
+    if (MSB > '9') MSB -= 7;   // Convert MSB (0x30..0x3F)  
+    if (LSB > '9') LSB -= 7;   // Convert LSB (0x30..0x3F)  
+    return (MSB << 4) | (LSB & 0x0F); 
+}
+