Enviar SMS pelo Arduino Mega2560 + shield sim908 na IDE 1.5.5

Alguém tem um código para me passar onde eu possa enviar um SMS do Arduino Mega2560 + shield sim908 na IDE 1.5.5 para um número de celular?

Dias

Se ainda precisar do código, segue abaixo.
Está funcionando no 1.6.5-r2.


#include

SoftwareSerial mySerial(2,3);

char flag=0;
int powerkey = 5;
int statuspin = 6;
int pinState = 0;

String mensagem = "Fulano, retorno de posicao do GPS funcionando = 32,211715.000,A,1834.046278,S,4214.373276,W,0"; // corpo da msg
String numero = "99998888"; // numero do celular que ira raceber o SMS

void setup()
{
pinMode(powerkey, OUTPUT);
pinMode(statuspin, INPUT);

delay(5000);
mySerial.begin(9600);
Serial.begin(9600);
}

void loop()
{

pinState = digitalRead(statuspin);
if(pinState==LOW)
{
digitalWrite(powerkey, HIGH); // seta o LED on
delay(2000);
digitalWrite(powerkey, LOW);
}

if(flag==0)
{
mySerial.print("AT+CMGF=1\r"); //mandando SMS em modo texto
delay(1000);
Serial.println("Discando para o celular de n.: " + numero);
mySerial.print("AT+CMGS=\"+" + numero + "\"\r");
delay(8000);
flag=1;
}

if(flag==1)
{
Serial.println("Montando a mensagem.");
Serial.println(mensagem);
mySerial.print(mensagem + "\r");
delay(1000);
mySerial.write(0x1A); //equivalente a mandar Ctrl+Z(finaliza corpo do SMS)
delay(1000);
flag=2;
}
if(flag==2)
{
Serial.println("SMS Enviado com sucesso!");
delay(5000);
flag=3;
}
}