AS3992 UHF RFID for arduino 车库管理源代码

#include 
 
#define  DEBUG
#define   LOCAT_EPC   6
#define   EPC_len    12
#define   MAXCONTAIN  2      //设置最大车位数,可自行设置
#define   OUT  0            //出车库
#define   IN   !OUT         //入车库
#define  SWITCH 10          //可控制挡车杆
 
NewSoftSerial as3992(2,3);
char CountOfIn=0;     //已经占用的车位
byte  COMMAND[30];
byte  ReceBuffer[50];   //接收到的数据         
byte EPC[MAXCONTAIN][EPC_len];    //保存进入车库的EPC
byte epc_t[EPC_len];            //扫描到的车的EPC
int NumOfRece=0;  //rfid返回的数据的个数
byte char_in;
 
void setup()
{
  Serial.begin(115200);
  as3992.begin(115200);
  pinMode(3,OUTPUT);
  pinMode(SWITCH,OUTPUT);
}
 
void loop()
{
    byte *WhichCar=NULL;
    if(SearchForTag(epc_t,0x01) > 0)
    {
      if(  InOrOut( EPC,epc_t,WhichCar)  == IN)  //有车要进去
      {                                          //判断epc_t是否在EPC[][]中,如果在,说明有车要出去,并用WhichCar保存该车在EPC[][]中的编号.
                                                 //如果不在,说明车要进入
        if( CountOfIn == MAXCONTAIN)
        {
#ifdef DEBUG        
          Serial.print("No empty parking space...\n\n");
#endif              ;
        } 
        else
        {    
          digitalWrite(SWITCH,HIGH);    
          for(byte i;i<EPC_len;i++)
             EPC[CountOfIn][i]=epc_t[i];
          CountOfIn++;  
          while(1)
          {
            if(SearchForTag(epc_t,0x01) == 0)
            {
              delay(500);
              if(SearchForTag(epc_t,0x01) == 0)
                break;
            }
          }
          digitalWrite(SWITCH,LOW);
#ifdef DEBUG
          Serial.print(MAXCONTAIN-CountOfIn);
          Serial.print(" empty parking space left..\n\n");
#endif            
        }
      }
      else        //有车要出去
      {
        digitalWrite(SWITCH,HIGH);
        for(byte j=(*WhichCar);j < CountOfIn-1;j++)
        {
          for(byte i=0;i<EPC_len;i++)             EPC[j][i]=EPC[j+1][i];         }           while(1)           {             if(SearchForTag(epc_t,0x01) == 0)             {               delay(500);               if(SearchForTag(epc_t,0x01) == 0)                 break;             }           }        CountOfIn--;        digitalWrite(SWITCH,LOW);        #ifdef DEBUG         Serial.print(MAXCONTAIN-CountOfIn);         Serial.print(" empty parking space left..\n\n"); #endif       }          }       } void ReceData(byte * buffer) {   NumOfRece=0;   int index=0;   while(Serial.available() > 0)   
  {
    char_in=Serial.read();
    NumOfRece++;
    *(buffer+index)=char_in;   
    index++;
  }
}
 
byte InOrOut( byte epc[][EPC_len], byte *epc_t,byte *which )
{
  byte p,j;
  for(p=0;p<CountOfIn;p++)    //循环对比此车EPC是否在车库中记录的EPC中
  {
    for(j=0;j<EPC_len;j++)  //循环12次比较EPC
    {
      if( epc_t[j]==epc[p][j] )
                ;
      else
        break;
    }
    if(j==EPC_len)
    {
      *which=p;
      return OUT;
    }
  }
   return IN;  
}
 
byte SearchForTag(byte *epc,byte start)
{
  COMMAND[0]=0x31;
  COMMAND[1]=0x03;
  COMMAND[2]=start;
  char i;
  for(i=0;i<COMMAND[1];i++)     as3992.print(COMMAND[i]);   delay(100);    //延迟很重要   ReceData(ReceBuffer);   if(ReceBuffer[0] == 0x32  && ReceBuffer[2] >  0) 
  {
    byte StartPoint=LOCAT_EPC;
      for(byte j=StartPoint,k=0;k<EPC_len;j++,k++)  //保存EPC
        epc[k]=ReceBuffer[j];  
    return ReceBuffer[2];
  }
  else
    return 0;
}