Форум arduino.ua

#include <SoftwareSerial.h>
#include <Servo.h>

#define DEBUG 1
#define SIM800_TX_PIN D6 // TX pin of SIM800L
#define SIM800_RX_PIN D5 // RX pin of SIM800L

SoftwareSerial serialSIM800(SIM800_TX_PIN,SIM800_RX_PIN);
char responseBuffer[256];

Servo servo;

char *checkPhone    = {
                          (char *)"79", // Phone number to check
                        };

char *checkSms[]    = {
                          (char *)"CMT:", // Sms string
                        };

char *initSim[]       = {
                          (char *)"AT", // Ping module
                        };


char *initTextMode[]   = {
                          (char *)"AT+CMGF=1\r\n", // Mobile network status
                        };


char *initSmsMode[]    = {
                          (char *)"AT+CNMI=1,2,0,0,0\r\n", // Mobile network status
                        };



void setup() {
  Serial.begin(115200);
  while(!Serial);

  servo.attach(2); //D4
  servo.write(0);

  if(DEBUG) Serial.println("Connecting GSM module");
  if (!connectModule()) {
    delay(1000);
    reboot();
  }

  writeToSim(initTextMode, sizeof(initTextMode)/sizeof(*initTextMode));
  readSim(responseBuffer, 2000);
  Serial.println(responseBuffer);
  delay(1000);

  writeToSim(initSmsMode, sizeof(initSmsMode)/sizeof(*initSmsMode));
  readSim(responseBuffer, 2000);
  Serial.println(responseBuffer);
  delay(1000);
}

void loop() {
  readSim(responseBuffer, 2000);
  Serial.println(responseBuffer);

  if(strstr(responseBuffer,  (char *)"CMT:")) {
    if(strstr(responseBuffer, checkPhone)) {
      Serial.println("SMS detected!");
      servo.write(145);
      delay(1000);
      servo.write(0);
      delay(1000);
   
    }
  }
}


bool connectModule() {
  serialSIM800.begin(57600);
  Serial.print("Trying 57600 ...");
  writeToSim(initSim, sizeof(initSim)/sizeof(*initSim));
  readSim(responseBuffer, 2000);
  if (isResponseOk(responseBuffer)) {
    Serial.println("Connected to mobile");
    return true;
  }
  Serial.println("Bad");
  return false;
}


void writeToSim(char *commands[], int size) {
  for(int i = 0; i < size; i++) {
    serialSIM800.println(commands);
    if(DEBUG) { Serial.print("Writing: "); Serial.println(commands); }
    delay(1000);
  }
}

// Read Sim response until timeout
char* readSim(char* buffer, int timeout) {
  unsigned long timeStart = millis();
  int charCount = 0;

  while(charCount < 256) {
    if(serialSIM800.available()) {
      buffer[charCount++] = serialSIM800.read();
    }
    if(millis() - timeStart > timeout) break;
    delay(10);
  }

  buffer[charCount++] = 0;
  return buffer;
}


bool isResponseOk(char* buffer) {
  // 1. Get buflen
  int buflen = 0;
  for(int i = 0; i < 256; i++) {
    if(int(buffer) == 0) {
      buflen = i;
      break;
    }
  }
  if(DEBUG) { Serial.print("Buflen: " ); Serial.println(buflen, DEC); }

  // 2. Is last ok? buffer[buflen] == 0
  while (buflen > 0) {
    buflen--;
    if (int(buffer[buflen]) == 10) {
      continue;
    }
    if (int(buffer[buflen]) == 13) {
      continue;
    }
    if (int(buffer[buflen]) == 75 && int(buffer[buflen-1]) == 79) {
      if(DEBUG) { Serial.println("Response is OK"); }
      return true;
    }
      if(DEBUG) { Serial.println("Response is BAD"); }
    return false;
  }
  return false;
}

void reboot() {
  wdt_disable();
  wdt_enable(WDTO_15MS);
  while (1) {}
}