Eduard Medla / Mbed 2 deprecated Autonomous_quadcopter

Regenerating PPM signal based on distances from ultrasonic sensors, ESP8266 for connectin via wifi. Autonomous quadcopter behaviour, autonomou height holding. Flying direction based on front and back ultrasonic sensors.

Dependencies:   ConfigFile HCSR04 PID PPM2 mbed-rtos mbed

ESP8266/Server.h@2:d172c9963f87, 2017-10-26 (annotated)

Committer:
edy05
Date:
Thu Oct 26 15:54:47 2017 +0000
Revision:
2:d172c9963f87
Child:
9:86a5af9935b1
stable release with distanceRegulation thread

Who changed what in which revision?

UserRevisionLine numberNew contents of line
edy05 2:d172c9963f87 1 #include "mbed.h"
edy05 2:d172c9963f87 2 #include "rtos.h"
edy05 2:d172c9963f87 3
edy05 2:d172c9963f87 4
edy05 2:d172c9963f87 5 RawSerial esp(p9, p10); // tx, rx
edy05 2:d172c9963f87 6 DigitalOut reset(p8);
edy05 2:d172c9963f87 7
edy05 2:d172c9963f87 8 // Standard Mbed LED definitions
edy05 2:d172c9963f87 9 DigitalOut led1(LED1); // (PTB18)
edy05 2:d172c9963f87 10 DigitalOut led3(LED3); // (PTD1)
edy05 2:d172c9963f87 11
edy05 2:d172c9963f87 12 Timer t1;
edy05 2:d172c9963f87 13 Timer t2;
edy05 2:d172c9963f87 14
edy05 2:d172c9963f87 15 char cmdbuff[32];
edy05 2:d172c9963f87 16 char replybuff[1024];
edy05 2:d172c9963f87 17 char webcount[8];
edy05 2:d172c9963f87 18 char webdata[1024]; // This may need to be bigger depending on WEB browser used
edy05 2:d172c9963f87 19 char webbuff[4096]; // Currently using 1986 characters, Increase this if more web page data added
edy05 2:d172c9963f87 20 char type[16];
edy05 2:d172c9963f87 21 char channel[2];
edy05 2:d172c9963f87 22 char ip_address[20];
edy05 2:d172c9963f87 23 int bufflen, DataRX, count, getcount, replycount, servreq, timeout;
edy05 2:d172c9963f87 24 int bufl, ipdLen, linkID, weberror, webcounter;
edy05 2:d172c9963f87 25
edy05 2:d172c9963f87 26 void getreply(); void SendCMD();
edy05 2:d172c9963f87 27 void startserver();
edy05 2:d172c9963f87 28 void ReadWebData();
edy05 2:d172c9963f87 29 void sendpage();
edy05 2:d172c9963f87 30 void sendcheck();
edy05 2:d172c9963f87 31 void get_ip_address(char web_data[1024]);
edy05 2:d172c9963f87 32 void SendWEB();
edy05 2:d172c9963f87 33
edy05 2:d172c9963f87 34 void serverRun();
edy05 2:d172c9963f87 35 void serverMain();
edy05 2:d172c9963f87 36 void serverLoop();
edy05 2:d172c9963f87 37 void callback();
edy05 2:d172c9963f87 38
edy05 2:d172c9963f87 39 int port =80; // set server port
edy05 2:d172c9963f87 40 int SERVtimeout =5; // set server timeout in seconds in case link breaks.
edy05 2:d172c9963f87 41
edy05 2:d172c9963f87 42 char P[6] = "7.2";
edy05 2:d172c9963f87 43 char I[6] = "6.3";
edy05 2:d172c9963f87 44 char D[6] = "1.8";
edy05 2:d172c9963f87 45
edy05 2:d172c9963f87 46 //serverThread.start(serverRun);
edy05 2:d172c9963f87 47
edy05 2:d172c9963f87 48 void callback(){
edy05 2:d172c9963f87 49 //pc.printf("callback!!!!!!!!!!!!!!!!_________________________\n\r");
edy05 2:d172c9963f87 50 led3 = 1;
edy05 2:d172c9963f87 51 while (esp.readable()) {
edy05 2:d172c9963f87 52 webbuff[count] = esp.getc();
edy05 2:d172c9963f87 53 count++;
edy05 2:d172c9963f87 54 }
edy05 2:d172c9963f87 55 if(strlen(webbuff)>bufflen) {
edy05 2:d172c9963f87 56 DataRX=1;
edy05 2:d172c9963f87 57 led3=0;
edy05 2:d172c9963f87 58 }
edy05 2:d172c9963f87 59 }
edy05 2:d172c9963f87 60
edy05 2:d172c9963f87 61
edy05 2:d172c9963f87 62 void serverRun(){
edy05 2:d172c9963f87 63 reset=0;
edy05 2:d172c9963f87 64 pc.baud(115200);
edy05 2:d172c9963f87 65
edy05 2:d172c9963f87 66 pc.printf("\f\n\r------------ ESP8266 Hardware Reset --------------\n\r");
edy05 2:d172c9963f87 67 wait(0.5);
edy05 2:d172c9963f87 68 reset=1;
edy05 2:d172c9963f87 69 timeout=6000;
edy05 2:d172c9963f87 70 getcount=500;
edy05 2:d172c9963f87 71 getreply();
edy05 2:d172c9963f87 72 esp.baud(115200); // ESP8266 baudrate. Maximum on KLxx' is 115200, 230400 works on K20 and K22F
edy05 2:d172c9963f87 73 startserver();
edy05 2:d172c9963f87 74 while(1){
edy05 2:d172c9963f87 75 if(DataRX==1) {
edy05 2:d172c9963f87 76 ReadWebData();
edy05 2:d172c9963f87 77 if (servreq == 1 && weberror == 0) {
edy05 2:d172c9963f87 78 sendpage();
edy05 2:d172c9963f87 79 }
edy05 2:d172c9963f87 80 esp.attach(&callback);
edy05 2:d172c9963f87 81 pc.printf(" IPD Data:\r\n\n Link ID = %d,\r\n IPD Header Length = %d \r\n IPD Type = %s\r\n", linkID, ipdLen, type);
edy05 2:d172c9963f87 82 pc.printf("\n\n HTTP Packet: \n\n%s\n", webdata);
edy05 2:d172c9963f87 83 pc.printf(" Web Characters sent : %d\n\n", bufl);
edy05 2:d172c9963f87 84 pc.printf(" -------------------------------------\n\n");
edy05 2:d172c9963f87 85 servreq=0;
edy05 2:d172c9963f87 86 }
edy05 2:d172c9963f87 87 Thread::wait(1000);
edy05 2:d172c9963f87 88 }
edy05 2:d172c9963f87 89 }
edy05 2:d172c9963f87 90
edy05 2:d172c9963f87 91
edy05 2:d172c9963f87 92 // Static WEB page
edy05 2:d172c9963f87 93 void sendpage(){
edy05 2:d172c9963f87 94 strcpy(webbuff, "<!DOCTYPE html>");
edy05 2:d172c9963f87 95 strcat(webbuff, "<html><head><title>ESP8266 Mbed LPC1768</title></head>");
edy05 2:d172c9963f87 96 strcat(webbuff, "<body>");
edy05 2:d172c9963f87 97 strcat(webbuff, "<div style=\"text-align:center; background-color:#F4F4F4; color:#00AEDB;\"><h1>ESP8266 Mbed IoT Web PID Controller</h1>");
edy05 2:d172c9963f87 98 strcat(webbuff, "Hit Count - ");
edy05 2:d172c9963f87 99 strcat(webbuff, webcount);
edy05 2:d172c9963f87 100 strcat(webbuff, "</div><br /><hr>");
edy05 2:d172c9963f87 101 strcat(webbuff, "<p><form method=\"POST\">");
edy05 2:d172c9963f87 102 if(led1==0) {
edy05 2:d172c9963f87 103 strcat(webbuff, "<p><input type=\"radio\" name=\"led1\" value=\"0\" checked> LED 1 off");
edy05 2:d172c9963f87 104 strcat(webbuff, "<br><input type=\"radio\" name=\"led1\" value=\"1\" > LED 1 on<br>");
edy05 2:d172c9963f87 105 } else {
edy05 2:d172c9963f87 106 strcat(webbuff, "<p><input type=\"radio\" name=\"led1\" value=\"0\" > LED 1 off");
edy05 2:d172c9963f87 107 strcat(webbuff, "<br><input type=\"radio\" name=\"led1\" value=\"1\" checked> LED 1 on<br>");
edy05 2:d172c9963f87 108 }
edy05 2:d172c9963f87 109 strcat(webbuff, "P: <input type=\"text\" name=\"proportional\" size=6 value=\"");
edy05 2:d172c9963f87 110 strcat(webbuff, P);
edy05 2:d172c9963f87 111 strcat(webbuff, "\"><br>");
edy05 2:d172c9963f87 112 strcat(webbuff, "I: <input type=\"text\" name=\"integral\" size=6 value=\"");
edy05 2:d172c9963f87 113 strcat(webbuff, I);
edy05 2:d172c9963f87 114 strcat(webbuff, "\"><br>");
edy05 2:d172c9963f87 115 strcat(webbuff, "D: <input type=\"text\" name=\"derivative\" size=6 value=\"");
edy05 2:d172c9963f87 116 strcat(webbuff, D);
edy05 2:d172c9963f87 117 strcat(webbuff, "\"><br>");
edy05 2:d172c9963f87 118 strcat(webbuff, "<p><input type=\"radio\" name=\"nothing\" value=\"1\" checked>");
edy05 2:d172c9963f87 119 strcat(webbuff, "<p><input type=\"submit\" value=\"send-refresh\" style=\"background: #3498db;");
edy05 2:d172c9963f87 120 strcat(webbuff, "background-image:-webkit-linear-gradient(top, #3498db, #2980b9);");
edy05 2:d172c9963f87 121 strcat(webbuff, "background-image:linear-gradient(to bottom, #3498db, #2980b9);");
edy05 2:d172c9963f87 122 strcat(webbuff, "-webkit-border-radius:12;border-radius: 12px;font-family: Arial;color:#ffffff;font-size:20px;padding:");
edy05 2:d172c9963f87 123 strcat(webbuff, "10px 20px 10px 20px; border:solid #103c57 3px;text-decoration: none;");
edy05 2:d172c9963f87 124 strcat(webbuff, "background: #3cb0fd;");
edy05 2:d172c9963f87 125 strcat(webbuff, "background-image:-webkit-linear-gradient(top,#3cb0fd,#1a5f8a);");
edy05 2:d172c9963f87 126 strcat(webbuff, "background-image:linear-gradient(to bottom,#3cb0fd,#1a5f8a);");
edy05 2:d172c9963f87 127 strcat(webbuff, "text-decoration:none;\"></form>");
edy05 2:d172c9963f87 128 strcat(webbuff, "</body></html>");
edy05 2:d172c9963f87 129 // end of WEB page data
edy05 2:d172c9963f87 130 bufl = strlen(webbuff); // get total page buffer length
edy05 2:d172c9963f87 131 sprintf(cmdbuff,"AT+CIPSEND=%d,%d\r\n", linkID, bufl); // send IPD link channel and buffer character length.
edy05 2:d172c9963f87 132 timeout=200;
edy05 2:d172c9963f87 133 getcount=7;
edy05 2:d172c9963f87 134 SendCMD();
edy05 2:d172c9963f87 135 getreply();
edy05 2:d172c9963f87 136 SendWEB(); // send web page
edy05 2:d172c9963f87 137 memset(webbuff, '\0', sizeof(webbuff));
edy05 2:d172c9963f87 138 sendcheck();
edy05 2:d172c9963f87 139
edy05 2:d172c9963f87 140
edy05 2:d172c9963f87 141 }
edy05 2:d172c9963f87 142
edy05 2:d172c9963f87 143 void sendcheck(){
edy05 2:d172c9963f87 144 weberror=1;
edy05 2:d172c9963f87 145 timeout=500;
edy05 2:d172c9963f87 146 getcount=24;
edy05 2:d172c9963f87 147 t2.reset();
edy05 2:d172c9963f87 148 t2.start();
edy05 2:d172c9963f87 149 while(weberror==1 && t2.read() <5) {
edy05 2:d172c9963f87 150 getreply();
edy05 2:d172c9963f87 151 if (strstr(replybuff, "SEND OK") != NULL) {
edy05 2:d172c9963f87 152 weberror=0; // wait for valid SEND OK
edy05 2:d172c9963f87 153 }
edy05 2:d172c9963f87 154 }
edy05 2:d172c9963f87 155 if(weberror==1) { // restart connection
edy05 2:d172c9963f87 156 strcpy(cmdbuff, "AT+CIPMUX=1\r\n");
edy05 2:d172c9963f87 157 timeout=500;
edy05 2:d172c9963f87 158 getcount=10;
edy05 2:d172c9963f87 159 SendCMD();
edy05 2:d172c9963f87 160 getreply();
edy05 2:d172c9963f87 161 pc.printf(replybuff);
edy05 2:d172c9963f87 162 sprintf(cmdbuff,"AT+CIPSERVER=1,%d\r\n", port);
edy05 2:d172c9963f87 163 timeout=500;
edy05 2:d172c9963f87 164 getcount=10;
edy05 2:d172c9963f87 165 SendCMD();
edy05 2:d172c9963f87 166 getreply();
edy05 2:d172c9963f87 167 pc.printf(replybuff);
edy05 2:d172c9963f87 168 } else {
edy05 2:d172c9963f87 169 sprintf(cmdbuff, "AT+CIPCLOSE=%s\r\n",channel); // close current connection
edy05 2:d172c9963f87 170 SendCMD();
edy05 2:d172c9963f87 171 getreply();
edy05 2:d172c9963f87 172 pc.printf(replybuff);
edy05 2:d172c9963f87 173 }
edy05 2:d172c9963f87 174 t2.reset();
edy05 2:d172c9963f87 175 }
edy05 2:d172c9963f87 176
edy05 2:d172c9963f87 177 // Large WEB buffer data send
edy05 2:d172c9963f87 178 void SendWEB()
edy05 2:d172c9963f87 179 {
edy05 2:d172c9963f87 180 int i=0;
edy05 2:d172c9963f87 181 if(esp.writeable()) {
edy05 2:d172c9963f87 182 while(webbuff[i]!='\0') {
edy05 2:d172c9963f87 183 esp.putc(webbuff[i]);
edy05 2:d172c9963f87 184 i++;
edy05 2:d172c9963f87 185 }
edy05 2:d172c9963f87 186 }
edy05 2:d172c9963f87 187 }
edy05 2:d172c9963f87 188
edy05 2:d172c9963f87 189 // Reads and processes GET and POST web data
edy05 2:d172c9963f87 190 void ReadWebData(){
edy05 2:d172c9963f87 191 wait_ms(200);
edy05 2:d172c9963f87 192 esp.attach(NULL);
edy05 2:d172c9963f87 193 count=0;
edy05 2:d172c9963f87 194 DataRX=0;
edy05 2:d172c9963f87 195 weberror=0;
edy05 2:d172c9963f87 196 memset(webdata, '\0', sizeof(webdata));
edy05 2:d172c9963f87 197 int x = strcspn (webbuff,"+");
edy05 2:d172c9963f87 198 if(x) {
edy05 2:d172c9963f87 199 strcpy(webdata, webbuff + x);
edy05 2:d172c9963f87 200 pc.printf("webdata received: %s", webdata);
edy05 2:d172c9963f87 201 weberror=0;
edy05 2:d172c9963f87 202 int numMatched = sscanf(webdata,"+IPD,%d,%d:%s", &linkID, &ipdLen, type);
edy05 2:d172c9963f87 203 if (strstr(webdata, "led1=1") != NULL ) {
edy05 2:d172c9963f87 204 led1=1;
edy05 2:d172c9963f87 205 }
edy05 2:d172c9963f87 206 if (strstr(webdata, "led1=0") != NULL ) {
edy05 2:d172c9963f87 207 led1=0;
edy05 2:d172c9963f87 208 }
edy05 2:d172c9963f87 209 if (strstr(webdata, "proportional") != NULL ){
edy05 2:d172c9963f87 210 pc.printf("\n\r looking for data \n\r");
edy05 2:d172c9963f87 211 char* p_webdata = strstr(webdata, "proportional");
edy05 2:d172c9963f87 212 p_webdata = p_webdata + strlen("proportional") + 1;
edy05 2:d172c9963f87 213 int i = 0;
edy05 2:d172c9963f87 214 while(*p_webdata != '&'){
edy05 2:d172c9963f87 215 pc.printf("%c", *p_webdata);
edy05 2:d172c9963f87 216 P[i] = *p_webdata;
edy05 2:d172c9963f87 217 p_webdata += 1;
edy05 2:d172c9963f87 218 i++;
edy05 2:d172c9963f87 219 }
edy05 2:d172c9963f87 220 pc.printf("\n\r");
edy05 2:d172c9963f87 221 P[i] = '\0';
edy05 2:d172c9963f87 222 pc.printf("proportional: %s", P);
edy05 2:d172c9963f87 223 pc.printf("\n\r end of looking for data \n\r");
edy05 2:d172c9963f87 224 }
edy05 2:d172c9963f87 225 if (strstr(webdata, "integral") != NULL){
edy05 2:d172c9963f87 226 pc.printf("\n\r looking for data \n\r");
edy05 2:d172c9963f87 227 char* p_webdata = strstr(webdata, "integral");
edy05 2:d172c9963f87 228 p_webdata = p_webdata + strlen("integral") + 1;
edy05 2:d172c9963f87 229 int i = 0;
edy05 2:d172c9963f87 230 while(*p_webdata != '&'){
edy05 2:d172c9963f87 231 pc.printf("%c", *p_webdata);
edy05 2:d172c9963f87 232 I[i] = *p_webdata;
edy05 2:d172c9963f87 233 p_webdata += 1;
edy05 2:d172c9963f87 234 i++;
edy05 2:d172c9963f87 235 }
edy05 2:d172c9963f87 236 pc.printf("\n\r");
edy05 2:d172c9963f87 237 I[i] = '\0';
edy05 2:d172c9963f87 238 pc.printf("integral: %s", I);
edy05 2:d172c9963f87 239 pc.printf("\n\r end of looking for data \n\r");
edy05 2:d172c9963f87 240
edy05 2:d172c9963f87 241 }
edy05 2:d172c9963f87 242 if (strstr(webdata, "derivative") != NULL){
edy05 2:d172c9963f87 243 pc.printf("\n\r looking for data \n\r");
edy05 2:d172c9963f87 244 char* p_webdata = strstr(webdata, "derivative");
edy05 2:d172c9963f87 245 p_webdata = p_webdata + strlen("derivative") + 1;
edy05 2:d172c9963f87 246 int i = 0;
edy05 2:d172c9963f87 247 while(*p_webdata != '&'){
edy05 2:d172c9963f87 248 pc.printf("%c", *p_webdata);
edy05 2:d172c9963f87 249 D[i] = *p_webdata;
edy05 2:d172c9963f87 250 p_webdata += 1;
edy05 2:d172c9963f87 251 i++;
edy05 2:d172c9963f87 252 }
edy05 2:d172c9963f87 253 pc.printf("\n\r");
edy05 2:d172c9963f87 254 D[i] = '\0';
edy05 2:d172c9963f87 255 pc.printf("derivative: %s", D);
edy05 2:d172c9963f87 256 pc.printf("\n\r end of looking for data \n\r");
edy05 2:d172c9963f87 257 }
edy05 2:d172c9963f87 258 sprintf(channel, "%d",linkID);
edy05 2:d172c9963f87 259 if (strstr(webdata, "GET") != NULL) {
edy05 2:d172c9963f87 260 servreq=1;
edy05 2:d172c9963f87 261 }
edy05 2:d172c9963f87 262 if (strstr(webdata, "POST") != NULL) {
edy05 2:d172c9963f87 263 servreq=1;
edy05 2:d172c9963f87 264 }
edy05 2:d172c9963f87 265 webcounter++;
edy05 2:d172c9963f87 266 sprintf(webcount, "%d",webcounter);
edy05 2:d172c9963f87 267 }else{
edy05 2:d172c9963f87 268 memset(webbuff, '\0', sizeof(webbuff));
edy05 2:d172c9963f87 269 esp.attach(&callback);
edy05 2:d172c9963f87 270 weberror=1;
edy05 2:d172c9963f87 271 }
edy05 2:d172c9963f87 272
edy05 2:d172c9963f87 273 }
edy05 2:d172c9963f87 274
edy05 2:d172c9963f87 275 void startserver(){
edy05 2:d172c9963f87 276 pc.printf("++++++++++ Resetting ESP ++++++++++\r\n");
edy05 2:d172c9963f87 277 strcpy(cmdbuff,"AT+RST\r\n");
edy05 2:d172c9963f87 278 timeout=8000;
edy05 2:d172c9963f87 279 getcount=1000;
edy05 2:d172c9963f87 280 SendCMD();
edy05 2:d172c9963f87 281 getreply();
edy05 2:d172c9963f87 282 pc.printf(replybuff);
edy05 2:d172c9963f87 283 pc.printf("%d",count);
edy05 2:d172c9963f87 284 if (strstr(replybuff, "OK") != NULL) {
edy05 2:d172c9963f87 285 pc.printf("\n++++++++++ Starting Server ++++++++++\r\n");
edy05 2:d172c9963f87 286 strcpy(cmdbuff, "AT+CIPMUX=1\r\n"); // set multiple connections.
edy05 2:d172c9963f87 287 timeout=500;
edy05 2:d172c9963f87 288 getcount=20;
edy05 2:d172c9963f87 289 SendCMD();
edy05 2:d172c9963f87 290 getreply();
edy05 2:d172c9963f87 291 pc.printf(replybuff);
edy05 2:d172c9963f87 292 sprintf(cmdbuff,"AT+CIPSERVER=1,%d\r\n", port);
edy05 2:d172c9963f87 293 timeout=500;
edy05 2:d172c9963f87 294 getcount=20;
edy05 2:d172c9963f87 295 SendCMD();
edy05 2:d172c9963f87 296 getreply();
edy05 2:d172c9963f87 297 pc.printf(replybuff);
edy05 2:d172c9963f87 298 wait(1);
edy05 2:d172c9963f87 299 sprintf(cmdbuff,"AT+CIPSTO=%d\r\n",SERVtimeout);
edy05 2:d172c9963f87 300 timeout=500;
edy05 2:d172c9963f87 301 getcount=50;
edy05 2:d172c9963f87 302 SendCMD();
edy05 2:d172c9963f87 303 getreply();
edy05 2:d172c9963f87 304 pc.printf(replybuff);
edy05 2:d172c9963f87 305 wait(5);
edy05 2:d172c9963f87 306 pc.printf("\n Getting Server IP \r\n");
edy05 2:d172c9963f87 307 strcpy(cmdbuff, "AT+CIFSR\r\n");
edy05 2:d172c9963f87 308 timeout=2500;
edy05 2:d172c9963f87 309 getcount=200;
edy05 2:d172c9963f87 310 while(weberror==0) {
edy05 2:d172c9963f87 311 SendCMD();
edy05 2:d172c9963f87 312 getreply();
edy05 2:d172c9963f87 313 if (strstr(replybuff, "0.0.0.0") == NULL) {
edy05 2:d172c9963f87 314 weberror=1; // wait for valid IP
edy05 2:d172c9963f87 315 }
edy05 2:d172c9963f87 316 }
edy05 2:d172c9963f87 317 pc.printf("\n Enter WEB address (IP) found below in your browser \r\n\n");
edy05 2:d172c9963f87 318 pc.printf("\n The MAC address is also shown below,if it is needed \r\n\n");
edy05 2:d172c9963f87 319 replybuff[strlen(replybuff)-1] = '\0';
edy05 2:d172c9963f87 320 //char* IP = replybuff + 5;
edy05 2:d172c9963f87 321 sprintf(webdata,"%s", replybuff);
edy05 2:d172c9963f87 322 //SAVE IP ADDRESS
edy05 2:d172c9963f87 323 get_ip_address(webdata);
edy05 2:d172c9963f87 324 pc.printf("ip_address: %s\n\r",ip_address);
edy05 2:d172c9963f87 325 pc.printf(webdata);
edy05 2:d172c9963f87 326 pc.printf("\n\n++++++++++ Ready ++++++++++\r\n\n");
edy05 2:d172c9963f87 327 esp.attach(&callback);
edy05 2:d172c9963f87 328 } else {
edy05 2:d172c9963f87 329 pc.printf("\n++++++++++ ESP8266 error, check power/connections ++++++++++\r\n");
edy05 2:d172c9963f87 330 while(1) {}
edy05 2:d172c9963f87 331 }
edy05 2:d172c9963f87 332 t2.reset();
edy05 2:d172c9963f87 333 t2.start();
edy05 2:d172c9963f87 334 }
edy05 2:d172c9963f87 335
edy05 2:d172c9963f87 336 void SendCMD()
edy05 2:d172c9963f87 337 {
edy05 2:d172c9963f87 338 esp.printf("%s", cmdbuff);
edy05 2:d172c9963f87 339 }
edy05 2:d172c9963f87 340
edy05 2:d172c9963f87 341 void getreply()
edy05 2:d172c9963f87 342 {
edy05 2:d172c9963f87 343 memset(replybuff, '\0', sizeof(replybuff));
edy05 2:d172c9963f87 344 t1.reset();
edy05 2:d172c9963f87 345 t1.start();
edy05 2:d172c9963f87 346 replycount=0;
edy05 2:d172c9963f87 347 while(t1.read_ms()< timeout && replycount < getcount) {
edy05 2:d172c9963f87 348 if(esp.readable()) {
edy05 2:d172c9963f87 349 replybuff[replycount] = esp.getc();
edy05 2:d172c9963f87 350 replycount++;
edy05 2:d172c9963f87 351 }
edy05 2:d172c9963f87 352 }
edy05 2:d172c9963f87 353 t1.stop();
edy05 2:d172c9963f87 354 }
edy05 2:d172c9963f87 355
edy05 2:d172c9963f87 356 void get_ip_address(char web_data[1024]){
edy05 2:d172c9963f87 357 char pre_text[] = "+CIFSR:STAIP,\"";
edy05 2:d172c9963f87 358 char* p_text = strstr(webdata, pre_text);
edy05 2:d172c9963f87 359 p_text = p_text+strlen(pre_text);
edy05 2:d172c9963f87 360 char* p_text2 = strstr(p_text, "\"");
edy05 2:d172c9963f87 361 for(int i = 0;;i++){
edy05 2:d172c9963f87 362 if(*(p_text+i) == *p_text2){
edy05 2:d172c9963f87 363 ip_address[i] = '\0';
edy05 2:d172c9963f87 364 break;
edy05 2:d172c9963f87 365 }
edy05 2:d172c9963f87 366 ip_address[i] = *(p_text+i);
edy05 2:d172c9963f87 367
edy05 2:d172c9963f87 368 }
edy05 2:d172c9963f87 369 }