//#include <WProgram.h>
#include "MyGSM.h"

bool flagOn = false;

MyGSM::MyGSM(int pin)
{
  pinMode(pin, OUTPUT);
  digitalWrite(pin, LOW);
  _pin = pin;


}
 
void MyGSM::initShield(){
  if(flagOn == false){
    digitalWrite(_pin, LOW);
    delay(10);
    digitalWrite(_pin, HIGH);
    delay(500);
    digitalWrite(_pin, LOW);
    flagOn = true;
  }
  else return;
}

void MyGSM::enterPin(){
  
}

void MyGSM::send_AT_cmd(const char *at_cmd, char *at_rep)
{
  Serial1.print(at_cmd);
  int strCount = 0;
  if(strlen(at_cmd) != 0) {
	  Serial.print("\r[*] Sent : ");
	  Serial.print(at_cmd);
	  Serial.println();
  }
  delay(100);
  while(Serial1.available()>0) {
	  char reponse = Serial1.read();
	  at_rep[strCount] = reponse;
	  strCount++;
  }
  at_rep[strCount]='\0';
  delay(500);
  if(strCount != 0){
    Serial.println("\r\r[*] Received :");
    Serial.println(at_rep);
  }
}

//Return True if string find on buf
bool MyGSM::sortRecv(char *buf, char *string)
{
  if(strstr(buf, string) != NULL) {
    return true;
  }
  else return false;
}

char MyGSM::cutRecv(char *buf, char *strBegin, char *strEnd)
{
 /* char *token, *endtoken;
  token = strchr(buf, strBegin);
  token++;
  endtoken = strchr(token, strEnd);
  *endtoken = '\0';
  return *token;*/
}