arduino 串口数据啊按字节分析

#include <avr/wdt.h>
#include <SoftwareSerial.h>
#include <EEPROM.h>

#define FPIN 13
#define E2PROM_OFFSET 16

SoftwareSerial mySerial(, ); // RX, TX
unsigned long lastSendTime=;
unsigned long lastReceiveTime=;
unsigned long SafeKey=987654321UL; // Max 4,294,967,295
byte RecCache[];
volatile int CacheIndex=;

void setup() {
  // put your setup code here, to run once:
  pinMode(FPIN,OUTPUT);
  digitalWrite(FPIN,LOW);

  Serial.begin();
  delay();
  Serial.println("Ready!");

   //========Start==========

   //=========End=============
  unsigned long sk=123456789UL;
  if(_ReadSafeKey(sk)){
    SafeKey=sk;
  }

  //========Wifi Config=============
  initWifi();
  setCache(,);

}

void loop() {
  // put your main code here, to run repeatedly:
  handleTXR();
}

void  initWifi(){
  mySerial.begin();
  delay();
    mySerial.println("AT+RST");
    delayAndRead();

   mySerial.println("AT+CIPMUX=1");
   delayAndRead();
   mySerial.println("AT+CIPSERVER=1");
   delayAndRead();
}

void handleTXR(){

  while(mySerial.available()){
    byte c=(byte) mySerial.read();
    RecCache[CacheIndex++]=c;

  }
   if(CacheIndex>){
      CacheIndex=;
      setCache(,);
    }

  int bIndex=bIndexOf("$F",);
  if(bIndex>=){
    int eIndex=bIndexOf("$E",bIndex);
    if(eIndex>bIndex){
       //Extra Data
       int dataLen= eIndex - (bIndex +);
       byte data[dataLen];
       for(int i=;i<dataLen;i++){
         data[i]= RecCache[bIndex+ +i] ;

       }

       for(int w=(eIndex +);w<CacheIndex && w<;w++){
          RecCache[w-(eIndex + )]=RecCache[w];
       }
       CacheIndex = CacheIndex - (eIndex +);
       setCache(CacheIndex,);

       lastReceiveTime=millis();
       handleCmd(data,dataLen);

    }
  }

    if(CacheIndex>){
      CacheIndex=;
      setCache(,);
    }

}

void setCache(int start,int endIndex){
  for(int i=start;i<endIndex;i++){
     RecCache[i]=;
  }
}
boolean bStartsWith(byte data[],int len, String fStr){
    int fLen=fStr.length() ;
   byte fBytes[fLen + ];
   fStr.getBytes(fBytes,fLen+);

   if(len<=)return false;
   if(len<fLen)return false;
   byte flag=;
   for(int j=;j<fLen;j++){
       if(fBytes[j]!=data[j])
       {
                flag=;
                break;
        }

    }
   if(flag) return true; 

   return false;
}

int bIndexOf(String fStr,int start){
    int fLen=fStr.length() ;
   byte fBytes[fLen + ];
   fStr.getBytes(fBytes,fLen+);

   for(int i=start;i<(CacheIndex +  -fLen);i++){

       if(RecCache[i]==fBytes[])
       {
         byte flag=;
          for(int j=;j<fLen;j++){
              if(fBytes[j]!=RecCache[i+j])
              {
                flag=;
                break;
              }
          }
          if(flag)return i;
       }
   }
   return -;
}

void handleCmd(byte data[], int len){

//    Serial.println("\n=============");
//  for(int i=0;i<len;i++){
//    Serial.print(data[i],DEC);
//    Serial.print(",");
//  }

 if(bStartsWith(data,len,"HB:")){
     hbCmd();
 }else if(bStartsWith(data,len,"F:")){

    fireCmd(data,len);
 }else if(bStartsWith(data,len,"SetSK:")){
    setSKCmd(data,len);
 }else if(bStartsWith(data,len,"ClsSK:")){
    clsSKCmd(data,len);
 }
}

void hbCmd(){
    byte bs[];
    unsigned long mlis=millis();
    long2byte(mlis,bs);
    byte msg[]={,,,,,,,,,,};
    Serial.println(mlis);
    replyBytes(true,"HB",bs,);
}

void fireCmd(byte data[], int len){
   byte safeBytes[]={,,,};

   for(int i=;i<;i++){
     safeBytes[i]=(byte)data[+i];

   }
  unsigned long sk= bytes2long(safeBytes);
  byte duration=data[];
  if(duration>) duration=;
  if(duration<=)duration=;

  if(sk!=SafeKey){
    reply(false,"F","Safe Key not match!");
    return;
  }
  reply(true,"F","");
  digitalWrite(FPIN,HIGH);
  delay(duration * );
  digitalWrite(FPIN,LOW);
}

void setSKCmd(byte data[], int len){
   byte safeBytes[]={,,,};
   for(int i=;i<;i++){
     safeBytes[i]=(byte)data[+i];
     //Serial.println(safeBytes[i],DEC);
   }
  unsigned long sk= bytes2long(safeBytes);
  if(sk!=SafeKey){
    reply(false,"SetSK","Safe Key not match!");
    return;
  }

   byte newSafeBytes[]={,,,};
   for(int i=;i<;i++){
     newSafeBytes[i]=(byte)data[+i];

   }
  unsigned long newSK= bytes2long(newSafeBytes);
  _StorageSafeKey(newSafeBytes);
  SafeKey=newSK;

  reply(true,"SetSK","");
}

void clsSKCmd(byte data[],int len){
  if(bStartsWith(data,len,"ClsSK:pwdashitdingke")){
    _ClsSafeKey();
    reply(true,"ClsSK","");

  }else{
    reply(false,"ClsSK","-_!");
  }
}

void reply(bool isOk,String cmd,String msg){
 String rStr="";
 if(isOk){
  rStr="$FOK-" + cmd +":" +msg +"$E";
  mySerial.println("AT+CIPSEND=0," + (String)rStr.length());
  delay();
  mySerial.println(rStr);
 }else{
    rStr="$FEE-" + cmd +":" +msg +"$E";
    mySerial.println("AT+CIPSEND=0," + (String)rStr.length());
    delay();
    mySerial.println(rStr);
 } 

}

void replyBytes(bool isOk,String cmd,byte msg[],int msgLen){
 String rStr="";
 int  sendLen=;
 if(isOk){
  rStr="$FOK-" + cmd +":" ;
    sendLen= rStr.length() + msgLen +; //2 is "$E"
  mySerial.println("AT+CIPSEND=0," + (String)sendLen);
  delay();
  mySerial.print(rStr);
  for(int i=;i<msgLen;i++){
    mySerial.write(msg[i]);
  }
  mySerial.println("$E");
 }else{
  rStr="$FEE-" + cmd +":" ;
  sendLen= rStr.length() + msgLen +; //2 is "$E"
  mySerial.println("AT+CIPSEND=0," + (String)sendLen);
  delay();
  mySerial.print(rStr);
  for(int i=;i<msgLen;i++){
    mySerial.write(msg[i]);
  }
  mySerial.println("$E");
 } 

}

void cls(){
   while(mySerial.available()){
     mySerial.read();
  }
}

void delayAndRead(int waitTime){
   delay(waitTime);
   while(mySerial.available()){
     Serial.write(mySerial.read());
   }
}

void _StorageSafeKey(byte skBytes[]){
    String flag="SK-OK";
    int i=;
    for(int address=E2PROM_OFFSET;address<(E2PROM_OFFSET + );address++){
     EEPROM.write(address,flag.charAt(i++));
     //Serial.print((char)EEPROM.read(address));
   }

   i=;
   for(int address=(E2PROM_OFFSET + );address< (E2PROM_OFFSET +  +);address++){
       EEPROM.write(address,skBytes[i++]);
   }
}

void _ClsSafeKey(){
    for(int address=E2PROM_OFFSET;address<(E2PROM_OFFSET + );address++){
     EEPROM.write(address,(byte)0xFF);
     //Serial.print((char)EEPROM.read(address));
   }
}

boolean _ReadSafeKey(unsigned long &b){
    b=;
    int address=;
    String tmp="";
    char readChar=' ';
   for(int address=E2PROM_OFFSET;address<(E2PROM_OFFSET + );address++){
     readChar=(char)EEPROM.read(address);
     tmp +=readChar;
  }

  if(tmp!="SK-OK"){
    return false;
  }

   byte skBytes[]={,,,};
   int i=;
   for(int address=(E2PROM_OFFSET + );address< (E2PROM_OFFSET +  +);address++){
     skBytes[i]=(byte)EEPROM.read(address);

     i++;
  }
  //Serial.println(tmp);
  b= bytes2long(skBytes);
  return true;
}

 void long2byte(unsigned long res,byte targets[] ) {
        targets[] = (byte) (res & 0xff);// 鏈�浣庝綅
        targets[] = (byte) ((res >> ) & 0xff);// 娆′綆浣�
        targets[] = (byte) ((res >> ) & 0xff);// 娆￠珮浣�
        targets[] = (byte) (res >> );// 鏈�楂樹綅,鏃犵鍙峰彸绉汇��  

    }  

unsigned long bytes2long(byte buf[]) {
        unsigned long firstByte = ;
        unsigned long secondByte = ;
        unsigned long thirdByte = ;
        unsigned long fourthByte = ;
        int index = ;
        firstByte = (0x000000FFU & ( buf[index+]));
        secondByte = (0x000000FFU & ( buf[index + ]));
        thirdByte = (0x000000FFU & ( buf[index + ]));
        fourthByte = (0x000000FFU & ( buf[index ]));
        index = index + ;
        return ((unsigned long) (firstByte <<  | secondByte <<  | thirdByte <<  | fourthByte)) & 0xFFFFFFFFUL;
    }  

注意，unsigned int 跟int 最好只用一种，混合使用是有些莫名其妙的问题