按位查询算法---基于Perimiter Sensor

这里只贴出部分代码，以备后续参考。

/*********************************************************
FILE NAME   perimeter.c 
DESCRIPTION    
Copyright: Galaxy Industry Ltd.
All Rights  Reserved
Author: Milo lu
*********************************************************/

//================
User includes
==================/
#include "Global.h"

#include"IO_Port.h"

#include"McuInit.h"

#include "eeprom.h"

#include"CachedDataControl.h"

#include"gsmcomms.h"

#include"TCPIP.h"

#include"R232_Init.h"

#include"Perimeter.h"

extern flag_e flag;

extern GsenserVariable GsenserTmp;

extern u16 System_Time_msec,UsartA2_Tx_Disable_T;

extern u16 Tx_Head_index,Tx_Tail_index;

//==============================
Public variable declaration
================================/
Usart2StateTypeDef usart2_state = USART2_IDLE;

usart2_flag usart2_fcmd;

SensorTypeDef ps_sr_status;


//==============================
Private variable declaration
================================/
static IgnitionStateReportTypeDef ignition_report = REPORT_UNKNOWN;

static Sri900nConnectivityTypeDef sri900n_connection = PLUG;

static u16 usart2_time_ms;
static u8 DH_Input_Index;

static s8 DH_Package[16];

//cmd
static s8 usart2_cmd[][3]={
  {0xB5,0x78,0x01},
  {0xB5,0x77,0x02},
  {0xB5,0x76,0x03},
  {0xB5,0x75,0x04},
  {0xB5,0x74,0x05},
  {0xB5,0x73,0x06},
  {0xB5,0x00,0x07},
  {0xB5,0xCC,0}};

//=========== get state =============
Sri900nConnectivityTypeDef get_sri900n_connection_state(void)
{
  return sri900n_connection;
}

Usart2StateTypeDef get_usart2_state(void)
{
  return usart2_state;
}
//========== set state =============
void set_usart2_state(Usart2StateTypeDef state)
{
  usart2_state = state;
}

//=========================================
function name: DH_Package_Checksum
description
parameters: array datalength
return: checksum
=========================================/
static u8 DH_Package_Checksum(s8* arrary,short datalength)
{
  u8 checksum =0;
  u8 i;
  s8 *data = arrary;
  for(i=0;i<datalength;i++)
  {
    checksum += *data++;
  }
  return checksum;
}

//=========================================================
function name:usartA2_Send_Package
discription:send two-dimentional-array
parameters:a pointer to an array:
return: none
============================================================/
void usartA2_Send_Package(s8(*v)[])
{
  s8 *pt;
  u8 checksum;
  
  TxA2_PowerON;
  
  Tx_Head_index = 0;
  Tx_Tail_index = 0;
  
  checksum = 0;
  pt = *(v);
  for(int i=0;i<3;i++)
  {
    if(usartA2_Send_Char(*pt));
      checksum += *pt++;
  }
  
  usartA2_Send_Char(checksum);
  
  if((UCA2IE&UCTXIE)==0)
  {
    UCA2IE|=UCTXIE;
    UCA2IFG |= UCTXIFG;
  }
}

//============================================
function name:Is_DH_Package_Received
description:
Complate datas have received
parameters: none
return: 1 data received
        0 data unreceived
==============================================/
HAL_StatusTypeDef usartA2_reception(void)
{
  u8 checksum;
  
  HAL_StatusTypeDef option_state = HAL_BUSY;
  
  if(usartA2_Received_Count())
  {
    DH_Package[DH_Input_Index++] = usartA2_Read_Char();
    if(DH_Package[0]==0xA4)
    {
      if(DH_Input_Index >= 4)
      {
        DH_Package[DH_Input_Index] = 0;
        checksum = DH_Package_Checksum(DH_Package,3);
        if(checksum == DH_Package[3])
        {
          option_state = HAL_OK;
        }
        DH_Input_Index = 0;
      }
    }
    else 
    {
      DH_Input_Index = 0;
    }
  }
  return option_state;
}

//============================================
  description:
    byte0 = header  
    byte1-2 information
    byte3 crc  
==============================================/
bool usartA2_decryption(s8 *pt,u8 id)
{
  bool result=false;
  u8 i;
  if(pt[1]==0xcc)       //transmit response
  {
   if(pt[2]==(id+1))
   {
     usart2_fcmd.value&=~(1<<id);
     result = true;
   }
  }
  else                  //status report
  {
    //byte0 = header,
    byte1:bit7 arm/disarm, bit6=ps on/off,bit5=ps installation status,bit4= sr on/off
          bit3 = ignition on/off, bit2-bit0 = gs level.
    byte2: 0x11=panic,0x22=ignition alarm,0x33=shock alert,0x44=tilt alert,0x55=ps alert/
    if(BIT7&pt[1])      //arm state
    {
      if(get_security_state()!=ARM_STATE)
      {
        set_security_state(ARM_STATE);
        if(get_tcpip_state()!=TCPIP_ON_LINE)
        {
          flag.GPRSRetryCount=3;
        }
        flag.flag2|= f2gprs_duration_3mins;
        flag.fReportStatus |= fAlarmArmStatus;
      }
    }
    else if(get_security_state()!=DISARM_STATE)//disarm state
    {
      set_security_state(DISARM_STATE);
      if(get_tcpip_state()!=TCPIP_ON_LINE)
      {
        flag.GPRSRetryCount=3;
      }
      flag.flag2|= f2gprs_duration_3mins;
      flag.fReportStatus |= fAlarmArmStatus;
    }
    
    if(BIT5&pt[1])      //ps installed
    {
      if(BIT6&pt[1])      //ps on
      {
        if(ps_sr_status.ps_status!=INSTALLED_AND_ENABLED)
        {
          ps_sr_status.ps_status = INSTALLED_AND_ENABLED;
          flag.fReportStatus |= fPerimeterSirenStatus;
        }
      }
      else                //ps off
      {
        if(ps_sr_status.ps_status!=INSTALLED_BUT_DISABLED)
        {
          ps_sr_status.ps_status = INSTALLED_BUT_DISABLED;
          flag.fReportStatus |= fPerimeterSirenStatus;
        }
      }
    }
    else                //ps support but no installed
    {
      if(ps_sr_status.ps_status!=SUPPORT_BUT_NOT_INSTALLED) 
      {
        ps_sr_status.ps_status = SUPPORT_BUT_NOT_INSTALLED;
        flag.fReportStatus|=fPerimeterSirenStatus;
      }
    }
    
    if(BIT4&pt[1])      //sr installed and enable
    {
      if(ps_sr_status.sr_status!=INSTALLED_AND_ENABLED)
      {
        ps_sr_status.sr_status = INSTALLED_AND_ENABLED;
        flag.fReportStatus |= fPerimeterSirenStatus;
      }
    }
    else                //sr installed but disable
    {
      if(ps_sr_status.sr_status!=INSTALLED_BUT_DISABLED)
      {
        ps_sr_status.sr_status = INSTALLED_BUT_DISABLED;
        flag.fReportStatus |= fPerimeterSirenStatus;
      }
    }
    
    if(BIT3&pt[1])      //ignition status
    {
      ignition_report = REPORT_ON;
    }
    else
    {
      ignition_report = REPORT_OFF;
    }
    
    i= 0x07&pt[1];      //gs level
    if((i!=GsenserTmp.SetLevel)&&(5 >= i)&&(i!=0))
    {
      GsenserTmp.SetLevel = i;
      EEReadModifyWrite(1,eeGsenserTmpSetLevel,&GsenserTmp.SetLevel,1);
      flag.fReportStatus |= fGsenserSensitivityStatus;
    }
    switch(pt[2])
    {
    case 0x11:  //panic
      {
        flag.Alarm_flag |= fPanicAlarmAlert;
        break;
      }
    case 0x22:  //ignition alarm
      {
        flag.Alarm_flag |= fIgnitionAlerts;
        break;
      }
    case 0x33:  //shock alert
      {
        CachedDataTypeDef gsensor_class = StatusAlertDataBytes(ShockAlarmAlertID);
        loading_data_bytes(gsensor_class);
        if(get_tcpip_state()!=TCPIP_ON_LINE)
        {
          flag.GPRSRetryCount=3;
        }
        flag.flag2|= f2gprs_duration_15mins;
        flag.Alarm_flag |= fShock_Alarm;
        flag.flag0 |= fGsenserStrikeOccur;      //led turn on for 1500ms
        break;
      }
    case 0x44:  //tilt alert
      {
        CachedDataTypeDef gsensor_class = StatusAlertDataBytes(ShockAlarmAlertID);
        loading_data_bytes(gsensor_class);
        if(get_tcpip_state()!=TCPIP_ON_LINE)
        {
          flag.GPRSRetryCount=3;
        }
        flag.flag2|= f2gprs_duration_15mins;
        flag.Alarm_flag |= fTilt_Alarm;
        flag.flag0 |= fGsenserStrikeOccur;      //led turn on for 1500ms
        break;
      }
    case 0x55:  //ps alert
      {
        if(get_tcpip_state()!=TCPIP_ON_LINE)
        {
          flag.GPRSRetryCount=3;
        }
        flag.flag2|= f2gprs_duration_15mins;
        flag.Alarm_flag |= fPerimeterTriggerAlarm;
        flag.flag0 |= fGsenserStrikeOccur;      //led turn on for 1500ms
        break;
      }
    default:
      break;
    }
    usart2_cmd[7][2]=pt[2];
    usartA2_Send_Package(usart2_cmd+7);//status response
  }
  return result;
}

static void sri900_connnecting_status(void)
{
  static u16 debouncing_time_msec;
  if(f0ignition_off&flag.flag0)
  {
    if(ignition_report == REPORT_OFF)
    {
      if(sri900n_connection == UNPLUG)
        sri900n_connection = PLUG;
      debouncing_time_msec = System_Time_msec;
    }
    else if(sri900n_connection == PLUG)
    {
      if(System_Time_msec - debouncing_time_msec >= 3*seconds)
      {
        ignition_report = REPORT_UNKNOWN;
        sri900n_connection = UNPLUG;
      }
    }
  }
  else 
  {
    if(ignition_report == REPORT_ON)
    {
       if(sri900n_connection == UNPLUG)
         sri900n_connection = PLUG;
      debouncing_time_msec = System_Time_msec;
    }
    else if(sri900n_connection == PLUG)
    {
      if(System_Time_msec - debouncing_time_msec >= 3*seconds)
      {
        ignition_report = REPORT_UNKNOWN;
        sri900n_connection = UNPLUG;
      }
    }
  }
  if((IsTxA2_PowerON)&&((UCA2IE&UCTXIE)==0))
  {
    if(System_Time_msec - UsartA2_Tx_Disable_T >= 10)
    {
      TxA2_PowerOFF;
    }
  }
  else UsartA2_Tx_Disable_T = System_Time_msec;
}
//========== usart2 control ============
void usartA2_controler(void)
{
  u8 i,j;
  //UsartA2OptionTypeDef opt;
  static u8 usart2_resend_cnt,sequence_cmd = 0;
  switch(usart2_state)
  {
  case USART2_IDLE:
    {
      if(f0system_init_ok&flag.flag0)
      {
        set_usart2_state(USART2_INIT);
      }
      break;
    }
  case USART2_INIT:
    {
      if(!(f0usart2_init_ok&flag.flag0))
      {
        usartA2_Init(BR9600);
      }
      usart2_resend_cnt = 0;
      set_usart2_state(USART2_TRANSMIT);
      break;
    }
  case USART2_TRANSMIT:
    {
      sequence_cmd = 0xFF;
      if(usart2_fcmd.value)     //cmd request
      {
        j=BIT0;
        for(i=0;i<8;i++)        //check which cmd send first
        {
          if(j&usart2_fcmd.value)
          {
            sequence_cmd = i;
            break;
          }
          j<<=1;
        }
        usart2_cmd[6][1] = GsenserTmp.SetLevel;
        usartA2_Send_Package(usart2_cmd+sequence_cmd);
        DH_Input_Index = 0;
      }
      else 
      {
        usart2_resend_cnt = 0;
      }
      usart2_time_ms = System_Time_msec;
      set_usart2_state(USART2_STANDBY);
      break;
    }
  case USART2_STANDBY:
    { 
      if(usartA2_reception()==HAL_OK)//any data receive via RS232
      {
        if(usartA2_decryption(DH_Package,sequence_cmd)==true)//Does responsed?
        {
          usart2_resend_cnt = 0;
          set_usart2_state(USART2_TRANSMIT);//check again, does any other request?
        }
      }
      else if(usart2_fcmd.value) //request need to send?
      {
        if((System_Time_msec - usart2_time_ms >= 1*seconds)||(usart2_resend_cnt == 0))
        {
          if(usart2_resend_cnt++ >= 5)
          {
            usart2_fcmd.value &=~ (1<<sequence_cmd);
            usart2_resend_cnt = 0;
          }
          set_usart2_state(USART2_TRANSMIT);
        }
      }
      
      break;
    }
    
  default:
    {
      set_usart2_state(USART2_TRANSMIT);
      break;
    }
  }
  
  sri900_connnecting_status();
}

InstallationStatusTypeDef get_ps_status(void)
{
  return ps_sr_status.ps_status;
}
InstallationStatusTypeDef get_sr_status(void)
{
  return ps_sr_status.sr_status;
}
//============== end file ===================