drv103.c

在Ｕｎｉｘ平台下完成的电力系统广发使用的ＩＥＣ１０３规约的程序

#include "iec103.h"

char           myprocessname[NAME_SIZE+1];
char           mynodename[NAME_SIZE+1];
char           strategy[NAME_SIZE+1];
char           hostname[NAME_SIZE+1];
char           com_tagname[NAME_SIZE+1];
char           diag_tag[NAME_SIZE+1];
char           IEC_TAGNAME[NAME_SIZE+1];
audio_msg      Audio;

SENDDEF        SendDef;
RCVDEF         RcvDef;
MSG_BUF        SendMsg;
MSG_BUF        RcvMsg;
char           recv_data[ BUFSIZE ];

IODEF         *pIODEF;
IECDEF        *pIECDEF[MaxIECNum],*pIEC;
char          *pStr;
int           IECCount,INTCOUNT;
int           Display,Enqflag;
int           GRP[MaxGRPNum];

unsigned       port,RcvTimeOut,IONumber,IECInitMark;
short          AddrIEC;
SHM_BH_DEF    *pshm_bh_buf_w;
SHM_BH_DEF1   *pshm_bh_buf_r;

extern int          fd;
extern char         *rGetSharedMemory();
extern SysDef       *pSysDef;
extern PORT_DEF      port_def[];

extern void RcvTimeOut_hnd();
extern void alarm_handler();
extern void ralarm_handler();
extern void exit_exe();

struct timeb NowTime,EnqTime,ClkTime,FltTest,ValTime;

main(argc,argv)
int argc;
char *argv[];
{
char *pSHM;
int i;

   if ( (argc!=3) && (argc!=4) ) {
      printf("Command Syntax ----- drv103 com<11-48> TAGNAME [on|off]\n");
      printf("Invalid argc ------- %s\n",argv[0]);
      exit(0);
   }
   port=1;
   while (strcmp(port_def[port].alias,"")!=0)
   {
      if (strcmp(port_def[port].alias,argv[1])==0) break;
      else port++;
   }
   if (strcmp(port_def[port].alias,"")==0) {
      printf("Command Syntax ----- drv103 com<11-48> TAGNAME [on|off]\n");
      printf("Invalid argument --- %s\n",argv[1]);
      exit(0);
   }
   strcpy(IEC_TAGNAME,argv[2]);
   sprintf(myprocessname,"%s_%s",argv[0],argv[2]);
   get_local_name(hostname);
   if (InitSharedMemory()==-1) {
      printf("InitSharedMemory Failurei --- %s_%s\n",argv[0],argv[1]);
      exit(0);
   }
   if (get_local_aliasname(mynodename)==-1) {
      printf("get_local_aliasname Failure---%s_%s\n",argv[0],argv[1]);
      exit_exe();
   }
   if (get_local_strategy(strategy)==-1) {
      printf("get_local_strategy Failure---%s_%s\n",argv[0],argv[1]);
      exit_exe();
   }
   if (msg_init(myprocessname)==-1) {
      printf("Msg_init failure---%s\n",myprocessname);
      exit_exe();
   }
   get_diag_tag(hostname,diag_tag);

   init_sighandler();
   open_device();
   init_device();
   rLoadDataBase();
   BH_ATTACH_SHM_BUF();

   if (argc==3) pIEC->Display=0;
   else
      if (strcmp(argv[3],"on")==0) pIEC->Display=1;

   if (pIEC->Display != 0) {
      printf("\n          *==================================================*");
      printf("\n          |                                                  |");
      printf("\n          |      NARI IEC870-5-103 Relay Driver Interface    |");
      printf("\n          |                                                  |");
      printf("\n          *==================================================*\n");
   }

   for(i=0;i<MaxIECNum;i++){
       if(pIECDEF[i] == (IECDEF *)0)continue;
       pIECDEF[i]->FCV     = LPCI_FCV;
       pIECDEF[i]->ACD     = NO;
       pIECDEF[i]->Status  = NODE_ON;
       pIECDEF[i]->PAD1    = 0;
       pIECDEF[i]->PAD2    = 0;
       if( pIEC->Display == 1 ) pIECDEF[i]->Display = 1;
       else pIECDEF[i]->Display = 0;
   }

   pIEC->ClkSet  = YES;
   ftime(&EnqTime);
   ftime(&ValTime);
   ftime(&ClkTime);
   ftime(&FltTest);

   setsid();

   main_loop();

}

main_loop()
{
int init_flag,rtn,i,pending;

   init_flag = 0;
   while (1)
   {
      Enqflag = 0;
      if (get_redundant_flag(hostname) == 1) {
          if (init_flag == 0) {
             for(i=0;i<MaxIECNum;i++){
                 if(pIECDEF[i] == (IECDEF *)0)continue;
                 M_INIT_Proc(i);
                 sleep(1);
             }
             if( pshm_bh_buf_r != (SHM_BH_DEF1 *)-1 ){
                 pshm_bh_buf_r->rptr = pshm_bh_buf_r->wptr;
                 pshm_bh_buf_r->oflag = 0;
             }
             init_flag=1;
          }
          ReadBhShmProc();
          dbmIEC();
          ms_sleep(500);
      }
      else{
         ioctl(fd,TCFLSH,0);

         RcvMsg.mtype    = MESG_ALL;
         RcvMsg.msg_size = BUFSIZE;
         RcvMsg.msg_data = recv_data;
         pending = msg_recv( &RcvMsg, 0 );
         if (pending>=0) IEC_Status_Proc();
         for(i=0;i<MaxIECNum;i++){
             if(pIECDEF[i] == (IECDEF *)0) continue;
             pIECDEF[i]->ENQFLAG = 0;
         }
         if( pshm_bh_buf_r != (SHM_BH_DEF1 *)-1 ){
             pshm_bh_buf_r->rptr = pshm_bh_buf_r->wptr;
             pshm_bh_buf_r->oflag = 0;
         }
         sleep(2);
      }
   }
}

SendStatusToPeer(code,addr)
unsigned char   code,addr;
{
   MSG_BUF   sbuf;

   if (code == NODE_ON)
        sbuf.function_code = MSG_IEC_STATUS_ON;
   else sbuf.function_code = MSG_IEC_STATUS_OFF;
   strcpy((char *)sbuf.dest_node_name,mynodename);
   strcpy((char *)sbuf.dest_proc_name,myprocessname);
   sbuf.status_flags = addr;
   sbuf.msg_size = 0;
   sbuf.msg_data = 0;
   if(msg_send(&sbuf,0,8,1,0) < 0)
      printf("%s send: Network Sending Error----.\n",myprocessname);
}

IEC_Status_Proc()
{
unsigned char relay_addr;

   printf("recv msg from node=%s  proc=%s\n",
         RcvMsg.orig_node_name,RcvMsg.orig_proc_name);

   relay_addr = RcvMsg.status_flags;

   switch (RcvMsg.function_code)
   {
      case MSG_IEC_STATUS_ON:
         pIECDEF[relay_addr]->Status = NODE_ON;
         break;
      case MSG_IEC_STATUS_OFF:
         pIECDEF[relay_addr]->Status = NODE_OFF;
         break;
      default:
         printf("Error Set Modify Command by Node=%s Proc=%s\n",
                 RcvMsg.orig_node_name,RcvMsg.orig_proc_name);
         break;
   }
}

ReadBhShmProc()
{
   int addr,rptr,wait_times;

   if( pshm_bh_buf_r == (SHM_BH_DEF1 *)-1 )  return;
   if( pshm_bh_buf_r->oflag == 1 ||
       pshm_bh_buf_r->rptr != pshm_bh_buf_r->wptr){
       if( pshm_bh_buf_r->oflag == 1 ) {
           pshm_bh_buf_r->rptr = pshm_bh_buf_r->wptr;
           pshm_bh_buf_r->oflag = 0;
       }
       rptr = pshm_bh_buf_r->rptr;

       if( pIEC->Display == 1 )
           printf("BH read: instno=%d---rptr=%d---wptr=%d---\n",AddrIEC,rptr,pshm_bh_buf_r->wptr);

       do{
          addr = pshm_bh_buf_r->data[rptr].addr;
          if(pIECDEF[addr] == (IECDEF *)0 || pIECDEF[addr]->Status == NODE_OFF){
             rptr = ( rptr + 1 ) % BH_BUF_NUM;
             ms_sleep(100);
             continue;
          }
          memset(SendDef.Buf,0,MaxSendBuf);
          memcpy(SendDef.Buf,pshm_bh_buf_r->data[rptr].buf,pshm_bh_buf_r->data[rptr].len);
          SendDef.SendSize = pshm_bh_buf_r->data[rptr].len;
          if( SendDef.Buf[0] == LPCI_SYN ){
              SendDef.Buf[1] = SendDef.Buf[1] | pIECDEF[addr]->FCB | pIECDEF[addr]->FCV;
              SendDef.Buf[3] = sum( &(SendDef.Buf[1]),2 );
          }
          else{
              SendDef.Buf[4] = SendDef.Buf[4] | pIECDEF[addr]->FCB | pIECDEF[addr]->FCV;
              SendDef.Buf[SendDef.SendSize-2]  = sum( &(SendDef.Buf[4]),SendDef.Buf[1] );
          }
          TxDriver(SendDef.Buf,SendDef.SendSize);
          rptr = ( rptr + 1 ) % BH_BUF_NUM;
          ms_sleep(100);
          if (RxDrvCheckProc(addr) < 0) break;
          while( pIECDEF[addr]->ACD == NO && wait_times < MaxWaitTimes ){
            wait_times ++ ;
            C_PL2_NA_3(addr);
            TxDriver(SendDef.Buf,SendDef.SendSize);
            if (RxDrvCheckProc(addr) > 0) C_PL2_NA_Proc(addr);
            else break;
            sleep(1);
          }
          wait_times = 0;
          while( pIECDEF[addr]->ACD == YES ){
            C_PL1_NA_3(addr);
            TxDriver(SendDef.Buf,SendDef.SendSize);
            if (RxDrvCheckProc(addr) > 0){
                if( RcvDef.Buf[0] == LPCI_SYN ) break;
                C_PL1_NA_Proc(addr);
            }
            else break;
            sleep(1);
          }
       }while( rptr != pshm_bh_buf_r->wptr );
       pshm_bh_buf_r->rptr = rptr;
   }

}

dbmIEC()
{
int i,j,k;
int pending,wait_times;

   RcvMsg.mtype    = MESG_ALL;
   RcvMsg.msg_size = BUFSIZE;
   RcvMsg.msg_data = recv_data;
   pending = msg_recv( &RcvMsg, 0 );
   if (pending>=0) IECSetupCmdProc();

   ftime(&NowTime);

   for( i=0;i<MaxIECNum;i++ ){
     if( pIECDEF[i] == (IECDEF *)0 ) continue;
     if( pIECDEF[i]->Status == NODE_OFF ) continue;
     if( pIECDEF[i]->ACD == YES ){
         C_PL1_NA_3(i);
         TxDriver(SendDef.Buf,SendDef.SendSize);
         if (RxDrvCheckProc(i) > 0)  C_PL1_NA_Proc(i);
     }
     else if( pIEC->ClkSet == YES ){
       pIEC->ClkSet = NO;
       C_SYN_TA_3(i);
       TxDriver(SendDef.Buf,SendDef.SendSize);
       sleep(1);
     }
     else if( pIECDEF[i]->ENQFLAG == 1 || pIECDEF[i]->ENQDESP == 1 ){
       if( pIECDEF[i]->ENQFLAG == 1 ) pIECDEF[i]->PAD2 = 0;
       else pIECDEF[i]->PAD2 = 1;
       pIECDEF[i]->ENQFLAG = 0;
       pIECDEF[i]->ENQDESP = 0;
       Find_Relay_GRP(i);
       Enqflag = 1;
     }
     else if( pIECDEF[i]->PAD1 == 1 ){
       pIECDEF[i]->PAD1 = 0;
       Enqflag = 0;
       for( j=0;j<MaxGRPNum;j++ ){
         if( pIECDEF[i]->GROUP[j] == 1 ){
            if(pIECDEF[i]->PAD2 == 0)  C_GC_NA_B3(i,j);
            else  C_GC_NA_B5(i,j);
            TxDriver(SendDef.Buf,SendDef.SendSize);
            if (RxDrvCheckProc(i) > 0) C_GC_NA_B3_Proc();
            Enqflag = 1;
            pIECDEF[i]->GROUP[j] = 0;
            break;
         }
       }
     }
   }

   if (((NowTime.time-EnqTime.time) > EnqInterval) ||
       ((EnqTime.time-NowTime.time) > EnqInterval) )    {
       ftime(&EnqTime);
       for( i=0;i<MaxIECNum;i++ ){
          if( pIECDEF[i] == (IECDEF *)0 ) continue;
          if( pIECDEF[i]->Status == NODE_OFF ) continue;
          C_PL2_NA_3(i);
          TxDriver(SendDef.Buf,SendDef.SendSize);
          if (RxDrvCheckProc(i) > 0) C_PL2_NA_Proc(i);
       }
   }
   else if (((NowTime.time-ClkTime.time) > ClkInterval) ||
            ((ClkTime.time-NowTime.time) > ClkInterval) ) {
            ftime(&ClkTime);
            pIEC->ClkSet=YES;
   }
   else if (((NowTime.time-FltTest.time) > FltInterval) ||
           ((FltTest.time-NowTime.time) > FltInterval) ) {
           ftime(&FltTest);
           for( i=0;i<MaxIECNum;i++ ){
              if( pIECDEF[i] == (IECDEF *)0 ) continue;
              if( pIECDEF[i]->Status == NODE_OFF ){
                  M_INIT_Proc(i);
                  sleep(1);
              }
           }
   }

}


M_INIT_Proc(addr)
unsigned char addr;
{
int code,j,wait_times;

   C_RCU_NA_3(addr);
   TxDriver(SendDef.Buf,SendDef.SendSize);
   if ((RxDrvCheckProc(addr) < 0) ||
       ((RcvDef.Buf[1] & 0x0f) != M_CON_NA)) return -1;
   sleep(1);

/*
   C_RFB_NA_3(addr);
   TxDriver(SendDef.Buf,SendDef.SendSize);
   if ((RxDrvCheckProc(addr) < 0) ||
       ((RcvDef.Buf[1] & 0x0f) != M_CON_NA)) return -1;
   sleep(1);

   while( pIECDEF[addr]->ACD == YES ){
       C_PL1_NA_3(addr);
       TxDriver(SendDef.Buf,SendDef.SendSize);
       if( RxDrvCheckProc(addr) > 0 ) {
           if( RcvDef.Buf[0] == LPCI_SYN ) break;
           C_PL1_NA_Proc(addr);
       }
       else break;
       ms_sleep(100);
   }

   C_IGI_NA_3(addr);
   TxDriver(SendDef.Buf,SendDef.SendSize);
   if ((RxDrvCheckProc(addr) < 0) ||
       ((RcvDef.Buf[1] & 0x0f) != M_CON_NA)) return -1;

   pIECDEF->ClkSet  = YES;
*/
   return 1;
}