drv103.c

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

   if( pIECDEF[addr]->IODef.CONNECTTYPE == mMCD )  SendDef.Buf[12]   = 0x3e;
   SendDef.Buf[13]  = 1;
   SendDef.Buf[14]  = grp;
   SendDef.Buf[15]  = 0x00;
   SendDef.Buf[16]  = 1;

   SendDef.Buf[17]  = sum( &(SendDef.Buf[4]),SendDef.Buf[1] );
   SendDef.Buf[18]  = LPCI_ETX;
   SendDef.SendSize = 19;

}

C_GC_NA_B4(addr)  /* General */
unsigned char addr;
{

   memset(SendDef.Buf,0,MaxSendBuf);

   SendDef.Buf[0]   = LPCI_STX;
   SendDef.Buf[1]   = 10;
   SendDef.Buf[2]   = 10;
   SendDef.Buf[3]   = LPCI_STX;
   SendDef.Buf[4]   = 0x40 | pIECDEF[addr]->FCB | pIECDEF[addr]->FCV | C_SND_AK;
   SendDef.Buf[5]   = pIECDEF[addr]->IODef.OCCNO;
   SendDef.Buf[6]   = C_GC_NA;
   SendDef.Buf[7]   = 0x81;
   SendDef.Buf[8]   = COT_GRD;
   SendDef.Buf[9]   = pIECDEF[addr]->IODef.OCCNO;

   SendDef.Buf[10]  = FUN_GEN;
   SendDef.Buf[11]  = 240;
   SendDef.Buf[12]  = 0;
   if( pIECDEF[addr]->IODef.CONNECTTYPE == mMCD )  SendDef.Buf[12]   = 0x3e;
   SendDef.Buf[13]  = 0;

   SendDef.Buf[14]  = sum( &(SendDef.Buf[4]),SendDef.Buf[1] );
   SendDef.Buf[15]  = LPCI_ETX;
   SendDef.SendSize = 16;

}

C_GC_NA_B5(addr,grp)  /* General */
unsigned char addr;
int grp;
{

   memset(SendDef.Buf,0,MaxSendBuf);

   SendDef.Buf[0]   = LPCI_STX;
   SendDef.Buf[1]   = 13;
   SendDef.Buf[2]   = 13;
   SendDef.Buf[3]   = LPCI_STX;
   SendDef.Buf[4]   = 0x40 | pIECDEF[addr]->FCB | pIECDEF[addr]->FCV | C_SND_AK;
   SendDef.Buf[5]   = pIECDEF[addr]->IODef.OCCNO;
   SendDef.Buf[6]   = C_GC_NA;
   SendDef.Buf[7]   = 0x81;
   SendDef.Buf[8]   = COT_GRD;
   SendDef.Buf[9]   = pIECDEF[addr]->IODef.OCCNO;

   SendDef.Buf[10]  = FUN_GEN;
   SendDef.Buf[11]  = 241;
   SendDef.Buf[12]  = 0;
   if( pIECDEF[addr]->IODef.CONNECTTYPE == mMCD )  SendDef.Buf[12]   = 0x3e;
   SendDef.Buf[13]  = 1;
   SendDef.Buf[14]  = grp;
   SendDef.Buf[15]  = 0x00;
   SendDef.Buf[16]  = 0x0a;

   SendDef.Buf[17]  = sum( &(SendDef.Buf[4]),SendDef.Buf[1] );
   SendDef.Buf[18]  = LPCI_ETX;
   SendDef.SendSize = 19;

}

C_GC_NA_B3_Proc()
{
}

C_GC_NA_B4_Proc()
{
}

C_GC_NA_B5_Proc()
{
}

TxDriver(ptr,len)
unsigned char *ptr;
unsigned short len;
{
int Length;
unsigned short i,k,addr;

   signal(SIGALRM,alarm_handler);
   alarm(4);
   Length=write(fd,ptr,len);
   alarm(0);
   signal(SIGALRM,SIG_DFL);
   if (Length!=len) {
      fprintf(stderr,"s%2x: TxDriver TimeOut\n",HEX_BCD(port));
      ioctl(fd,TCFLSH,1);
      return -1;
   }
   if (Length<0) {
      fprintf(stderr,"s%2x: TxDriver error\n",HEX_BCD(port));
      init_device();
      return -1;
   }
   else {
      if( ptr[0]==LPCI_STX ) addr = ptr[5];
      else addr = ptr[2];
      if (pIECDEF[addr]->Display != 0) {
         if (ptr[0]==LPCI_STX)
              IEC68dsp('s',ptr[6]);
         else IEC10dsp('s',ptr[1]);
         for (i=0;i<len;i++) {
            printf("%2x ",ptr[i]);
            if ((((i+1) % MaxListDsp)==0) && (i!=len-1))
               printf("\n               ");
         }
         printf("\n");
      }
      return Length;
   }
}

int RxDriver(addr)
unsigned char addr;
{
unsigned char k,temp,ReadNum,CntTmp,ReadNullCount;
unsigned char crcl,crch;
unsigned int  i,count,RxC;

   RxC=0;
   ReadNullCount=0;
   while (1)
   {
      ReadNum=0;
      ReadNum=read(fd,&temp,1);
      if (ReadNum==1) {
         RcvDef.Buf[RxC]=temp;
         RxC++;
         ReadNullCount=0;
      }
      else if (ReadNum==0) {
         if (RxC) {
            ReadNullCount++;
            if (ReadNullCount>3) {
                printf("r: Breakat RxC=%d\n",RxC);
                for (i=0;i<RxC;i++) {
                    printf("%2x ",RcvDef.Buf[i]);
                    if ((((i+1) % MaxListDsp)==0) && (i!=RxC))
                       printf("\n               ");
                }
                printf("\n");
                ioctl(fd,TCFLSH,0);
                return -2;
            }
         }
         else {
            RxC=0;
            return -1;
         }
      }
      else {
         printf("Error Read File\n");
         init_device();
         return -3;
      }
      if (RxC==1) {
         if ((RcvDef.Buf[0]==LPCI_STX) || (RcvDef.Buf[0]==LPCI_SYN)) continue;
         else {
            RxC=0;
            if (pIECDEF[addr]->Display == 1)
               printf("r%2x: Err STX %2x\n",HEX_BCD(port),RcvDef.Buf[0]);
            ioctl(fd,TCFLSH,0);
         }
      }
      else if (RxC==5) {
         if ((RcvDef.Buf[0]==LPCI_STX)&&(RcvDef.Buf[0]==RcvDef.Buf[3])&&(RcvDef.Buf[1]==RcvDef.Buf[2])) continue;
         else if ((RcvDef.Buf[0]==LPCI_SYN) && (RcvDef.Buf[2]==pIECDEF[addr]->IODef.OCCNO) &&
                  (RcvDef.Buf[4]==LPCI_ETX) && (RcvDef.Buf[3]==sum(&RcvDef.Buf[1],2))) {
                   if (pIECDEF[addr]->Display == 1) {
                       IEC10dsp('r',RcvDef.Buf[1]);
                       for (i=0;i<RxC;i++) printf("%2x ",RcvDef.Buf[i]);
                       printf("\n");
                   }
                   if (RcvDef.Buf[1] & LPCI_ACD) pIECDEF[addr]->ACD=YES;
                   else pIECDEF[addr]->ACD=NO;
                   return RxC;
         }
         else {
            printf("r%2x: sync Error-- ",HEX_BCD(port));
            for (i=0;i<RxC;i++) printf("%2x ",RcvDef.Buf[i]);
            printf("\n");
            RxC=0;
            ioctl(fd,TCFLSH,0);
         }
      }
      else if( (RxC>=14) && (RxC>=RcvDef.Buf[1]+6) ){
         if ( (RcvDef.Buf[RxC-1]==LPCI_ETX) && (RcvDef.Buf[RxC-2]==sum(&RcvDef.Buf[4],RcvDef.Buf[1])) ) {
             if (pIECDEF[addr]->Display == 1) {
                 IEC68dsp('r',RcvDef.Buf[6]);
                 if(RxC>1024) return -2;
                 for (i=0;i<RxC;i++) {
                    printf("%2x ",RcvDef.Buf[i]);
                    if ((((i+1) % MaxListDsp)==0) && (i!=RxC))
                       printf("\n               ");
                 }
                 printf("\n");
             }
             if (RcvDef.Buf[4] & LPCI_ACD) pIECDEF[addr]->ACD=YES;
             else pIECDEF[addr]->ACD=NO;
             return RxC;
         }
      }
   }
}

drv_recv(delay,addr)
int delay;
unsigned char addr;
{
int i,rtn;

   RcvTimeOut=0;
   signal(SIGALRM,ralarm_handler);
   alarm(delay*2);
   for (i=0;i<delay*5;i++) {
      rtn=RxDriver(addr);
      if (rtn>=0) break;
   }
   alarm(0);
   signal(SIGALRM,SIG_DFL);
   if ( (RcvTimeOut==0) && (rtn>=0) ) return rtn;
   else {
      if (pIECDEF[addr]->Display == 1)
         printf("r%2x: RxDriver Timeout=%d rtn=%d\n",
                        HEX_BCD(port),RcvTimeOut,rtn);
      return -1;
   }
}

RxDrvCheckProc(addr)
unsigned char addr;
{
int rtn,i;
char str[128];

   while ( (rtn=drv_recv(5,addr)) < 0 ) {
      if (SendDef.RepCount<MaxRetry) {
         if (pIECDEF[addr]->Status == NODE_OFF) {
            SendDef.RepCount=0;
            break;
         }
         else {
            SendDef.RepCount++;
            TxDriver(SendDef.Buf,SendDef.SendSize);
         }
      }
      else {
         if (pIECDEF[addr]->Status == NODE_ON) {
             pIECDEF[addr]->Status =  NODE_OFF;
             SendStatusToPeer(NODE_OFF,addr);
             sprintf(str,"%s通讯中断",
                   ((char *)pSysDef+(int)pIECDEF[addr]->FB.pDescript));
             AlarmProc(str,diag_tag);
         }
         SendDef.RepCount=0;
         break;
      }
   }
   if ( rtn > 0 ) {
      SendDef.RepCount=0;
      if (pIECDEF[addr]->Status == NODE_OFF) {
          pIECDEF[addr]->Status =  NODE_ON;
          pIECDEF[addr]->ClkSet =  YES;
          SendStatusToPeer(NODE_ON,addr);
          sprintf(str,"%s通讯恢复",
                ((char *)pSysDef+(int)pIECDEF[addr]->FB.pDescript));
          AlarmProc(str,diag_tag);
      }
      pIECDEF[addr]->FCB ^= LPCI_FCB;
      return rtn;
   }
   else return -1;
}

rLoadDataBase()
{
 int   i,j,fd,FileLen,ionumber;
 char  io_file[100];
 FILE  *fp;

    pIEC=(IECDEF *)get_FB_address(IEC_TAGNAME);
    if(pIEC == (IECDEF *)(-1)){
       printf("IECDEF tagname: %s Does Not Exist!\n",IEC_TAGNAME);
       exit_exe();
    }
    AddrIEC = pIEC->IODef.INSTNO;

    sprintf(io_file,"%s/%s/%s/%s.%s",PROJECT_PREFIX,strategy,
           DBDIR,strategy,IO_SUFFIX);

    if ((fp=fopen(io_file,"r"))==NULL) {
       printf("IO_File : %s Does Not Exist!\n",io_file);
       exit_exe();
    }
    fseek(fp,0,SEEK_END);
    FileLen = ftell(fp);
    rewind(fp);
    fread(&ionumber,sizeof(int),1,fp);
    fclose(fp);

    if ((fd=open(io_file,O_RDONLY))<=0) {
       printf("IO_File : %s Does Not Exist!\n",io_file);
       exit_exe();
    }
    pIODEF=(IODEF*)malloc(FileLen+4);
    read(fd,(char*)&IONumber,sizeof(int));
    read(fd,(char*)pIODEF,FileLen);
    close(fd);
    pStr=(char*)((char*)pIODEF+sizeof(IODEF)*IONumber);

    IECCount=0;
    for (i=0;i<IONumber;i++) {
       if(((pIODEF+i)->POINTTYPE == fIEC) &&
          ((pIODEF+i)->INSTNO == AddrIEC) )
                IECCount++;
    }
    if (IECCount==0) {
       printf("IECDEF Function (fIEC103) Not in DB\n");
       exit_exe();
    }
    if (IECCount>MaxIECNum) {
       printf("IECDEF Function (fIEC) Exceed MaxIECNum\n");
       exit_exe();
    }
    for (i=0; i<MaxIECNum; i++) pIECDEF[i]=(IECDEF *)0;
    j=0;
    for (i=0;i<IONumber;i++) {
       if (((pIODEF+i)->POINTTYPE == fIEC)&&((pIODEF+i)->INSTNO == AddrIEC)){
          rFoundPointer((long*)&pIODEF[i].TAGNAME,pStr);
          pIODEF[i].DBADDRESS=(char*)get_FB_address(pIODEF[i].TAGNAME);
          if (pIODEF[i].DBADDRESS==(char*)(-1)) {
             printf("IECDEF Tagname: %s Not in DB\n",pIODEF[i].TAGNAME);
             exit_exe();
          }
          else {
             if ((pIODEF+i)->OCCNO>MaxIECNum){
               fprintf(stderr,"IECDEF:OCCNO >MaxNum(254)\n");
               exit_exe();
             }
             else{
                if((pIODEF+i)->CONNECTTYPE != mRCS9692)
                   pIECDEF[pIODEF[i].OCCNO]=(IECDEF *)pIODEF[i].DBADDRESS;
                j++;
             }
          }
       }
    }
    free(pIODEF);
}

BH_ATTACH_SHM_BUF()
{
  int i,j,instno;
  SHM_BH_DEF  *pshm1;
  SHM_BH_DEF1 *pshm2;

  pshm_bh_buf_w = (SHM_BH_DEF  *)-1;
  pshm_bh_buf_r = (SHM_BH_DEF1 *)-1;
  if( pIEC->IODef.ICNNO != 1) return;                /* 不要读写共享内存  */

  i = sizeof(SHM_BH_DEF);
  pshm1 = (SHM_BH_DEF *)rGetSharedMemory(0x700000 , i);
  if( pshm1 == (SHM_BH_DEF *)-1 )  {
    printf("CREATE sharedmemory(YS_BH) failed\n");
    return;
  }
  pshm_bh_buf_w = (SHM_BH_DEF *)pshm1;
  pshm_bh_buf_w->wptr = pshm_bh_buf_w->rptr;
  pshm_bh_buf_w->oflag = 0;

  i = sizeof(SHM_BH_DEF1);
  instno = pIEC->IODef.INSTNO;
  pshm2 = (SHM_BH_DEF1 *)rGetSharedMemory(0x600001+instno , i);
  if( pshm2 == (SHM_BH_DEF1 *)-1 )  {
    printf("CREATE sharedmemory(YS_BH_%d) failed\n",instno);
    return;
  }
  pshm_bh_buf_r=(SHM_BH_DEF1 *)pshm2;
  pshm_bh_buf_r->rptr = pshm_bh_buf_r->wptr;
}