searchsch.c

ASC 信号机控制程序,国内最先进的信号机控制程序

#include <searchsch.h>

/*****************************************************************************************************/
// 查找日计划号
/*****************************************************************************************************/
uchar search_day_plan() using 1
{
    uchar xdata i,id,xing;
    unsigned int xdata j,fang;

    for(i=0; i<10; i++)
    {
       j = 6*i;
       if((XBYTE[0X6CE2+j]!=0) && (XBYTE[0X6CE3+j]!=0) && (XBYTE[0X6CE4+j]!=0) && (XBYTE[0X6CE5+j]!=0))
       {
         if(now_month>XBYTE[0X6CE2+j])
         {
            if(now_month<XBYTE[0X6CE4+j])
            {
               id = XBYTE[0X6CE7+j];
               return (id);
            }
            else if((now_month==XBYTE[0X6CE4+j]) && (now_date<=XBYTE[0X6CE5+j]))
            {
               id = XBYTE[0X6CE7+j];
               return (id);
            }
         }
         else if((now_month==XBYTE[0X6CE2+j]) && (now_date>=XBYTE[0X6CE3+j]))
         {
            if(now_month<XBYTE[0X6CE4+j])
            {
               id = XBYTE[0X6CE7+j];
               return (id);
            }
            else if((now_month==XBYTE[0X6CE4+j]) && (now_date<=XBYTE[0X6CE5+j]))
            {
               id = XBYTE[0X6CE7+j];
               return (id);
            }

         }
       }
    }
    for(i=0; i<10; i++)
    {
        j = 6*i;
        fang=0x6ce6+j;
        xing=XBYTE[fang];
        if(now_day==xing)
        {
           id = XBYTE[0X6CE7+j];
           return (id);
        }
    }

    return 0;
}
/*****************************************************************************************************/
// 查找方案号
/*****************************************************************************************************/
uint timecounter,timecountern;
 uint addr_temp;
uchar search_scheme()                    //计算当前时段
{
    uchar i,j,id;
    //uint timecounter,timecountern;
    //uint addr_temp;
    uchar state_flag=1;
    addr_temp = 0x63a4+74*(now_day_planid-1);       //当前日计划表基地址
 /*   for(i=0;i<24;i++){
         j=i*3;
       timecounter = XBYTE[addr_temp+j]*60+XBYTE[addr_temp+1+j];
       timecountern= XBYTE[addr_temp+j+3]*60+XBYTE[addr_temp+4+j];
       if(timecountern<=timecounter){
                         max_timep=i+1;
                         break;
                                     }
                      }

 */
    for(i=0; i<24; i++)
    {
       j = i*3;
       timecounter = XBYTE[addr_temp+j]*60+XBYTE[addr_temp+1+j];
       timecountern= XBYTE[addr_temp+j+3]*60+XBYTE[addr_temp+4+j];
       if(timecountern!=0)
       {
          if(timecounter<timecountern)
          { /*if((now_time<timecounter)&&(i==0)){
                    timeid=max_timep;
                    id = XBYTE[addr_temp+2+3*(timeid-1)];
                    return (id);
                                               }   */

             if((now_time>=timecounter) && (now_time<timecountern))
             {
                state_flag=0;
                timeid = i+1;         //当前时段号
                id = XBYTE[addr_temp+2+j];
                return (id);
             }
          }
          else if(timecounter>timecountern)
          {
             if((now_time>=timecounter) || (now_time<timecountern))
             {
                state_flag=0;
                timeid = i+1;
                id = XBYTE[addr_temp+2+j];
                return (id);
             }
          }
       }
       else
       {
           //if(now_time>=timecounter)
          if(state_flag==1)
           {
                timeid = i+1;
                id = XBYTE[addr_temp+2+j];
                return (id);
           }
       }
    }
    last_timeid=timeid;
    return 0 ;
}
uchar search_scheme_yellow()
{
    uchar i,j,id;
    uint timecounter,timecountern;
    uint addr_temp;
    uchar state_flag=1;
    addr_temp = 0x63a4+74*(now_day_planid-1);       //当前日计划表基地址
    for(i=0; i<24; i++)
    {
       j = i*3;
       timecounter = XBYTE[addr_temp+j]*60+XBYTE[addr_temp+1+j];
       timecountern= XBYTE[addr_temp+j+3]*60+XBYTE[addr_temp+4+j];
       if(timecountern!=0)
       {
          if(timecounter<timecountern)
          {
             if((now_time>=timecounter) && (now_time<timecountern))
             {
                state_flag=0;
                timeid = i+1;
                id = XBYTE[addr_temp+2+j];
                return (id);
             }
          }
          else if(timecounter>timecountern)
          {
             if((now_time>=timecounter) || (now_time<timecountern))
             {
                state_flag=0;
                timeid = i+1;
                id = XBYTE[addr_temp+2+j];
                return (id);
             }
          }
       }
       else
       {
           //if(now_time>=timecounter)
           if(state_flag==1)
           {
                timeid = i+1;
                id = XBYTE[addr_temp+2+j];
                return (id);
           }
       }
    }
    last_timeid=timeid;
    return 0 ;
}

/*****************************************************************************************************/
// 查找方案
/*****************************************************************************************************/
uint lai_temp,u[16];
uint xdata addr_temp ;
void search_sch() using 1
{
   uchar i,j,k;
   uint xdata toto;
   uint xdata phasek;

   uint xdata addr_exange;
   uint xdata addr_sch;

   uchar h,m,sh,num,w,s,sum;
   uchar idd,tmod;
   uint t[16];

   unsigned long xdata now_colock,time_d;
   for(i=0;i<16;i++)t[i]=5;
   EA=0;
   per_count++;
   if(per_count>100)per_count=100;
   now_day_planid = search_day_plan();                        //查找日计划表号
   if(now_day_planid==0)
   {
    now_day_planid=1;
   }
   else if(now_day_planid<=32)
   {
      now_schemeid = search_scheme();                         //查找方案号
  //    if(loop_error_flag==1)now_schemeid=32;                  //如果当前相位全部检测器都出现故障，降级为方案32
      baseaddr_now_schemesch = 0x5E83+41*(now_schemeid-1);
      now_step_schid = XBYTE[baseaddr_now_schemesch];         //当前阶段表号
      step_num = XBYTE[0x5243+(now_step_schid-1)*98];
      XBYTE[baseaddr_now_schemesch+1]=step_num;             //当前阶段数

      baseaddr_now_stepsch = 0x5243+98*(now_step_schid-1);
      now_phase_schid = XBYTE[baseaddr_now_stepsch+3];          //当前相位表号
      if(now_phase_schid==0)
      {
         baseaddr_now_phasesch = 0x5001;
      }
      else if(now_phase_schid==1)
      {
         baseaddr_now_phasesch = 0x5122;
      }

      for(i=0; i<step_num; i++){sensor_step[i] = 0;}            //lq          //感应阶段标志置成0先

      for(i=0; i<step_num; i++)
      {
         k = 3*i;
         addr_temp=baseaddr_now_stepsch+k;
         inuse_phase_temp = XBYTE[addr_temp+1];      //baseaddr_now_stepsch:阶段表基址
         inuse_phase_temp = inuse_phase_temp<<8;
         inuse_phase[i] = (inuse_phase_temp|XBYTE[addr_temp+2]);   //阶段用到的相位

         if(i<step_num-1)
         {
            inuse_phase_temp = XBYTE[baseaddr_now_stepsch+4+k];
            inuse_phase_temp = inuse_phase_temp<<8;
            inuse_phasen[i] = inuse_phase_temp|XBYTE[baseaddr_now_stepsch+5+k]; //下个阶段用到的相位
            inuse_phasen[i] = inuse_phasen[i]&inuse_phase[i];            //当前和下个阶段都用到的相位
            inuse_phasen1[i] = ~inuse_phasen[i];
            inuse_phase1[i]  = inuse_phase[i]&inuse_phasen1[i];          //去掉下个阶段用到的相位
         }
         else          //最后阶段的下一个阶段为第一个阶段
         {
            //inuse_phasen[i] = 0;
            //inuse_phase1[i] = inuse_phase[i];

            inuse_phase_temp = XBYTE[baseaddr_now_stepsch+1];
            inuse_phase_temp = inuse_phase_temp<<8;
            inuse_phasen[i] = inuse_phase_temp|XBYTE[baseaddr_now_stepsch+2]; //下个阶段用到的相位
            inuse_phasen[i] = inuse_phasen[i]&inuse_phase[i];            //当前和下个阶段都用到的相位
            inuse_phasen1[i] = ~inuse_phasen[i];
            inuse_phase1[i]  = inuse_phase[i]&inuse_phasen1[i];          //去掉下个阶段用到的相位
         }

        for(j=0; j<16; j++)
         {
           phasek = 18*j;
           toto = 0x0001;
           toto = toto<<j;
            inuse_phase_temp = toto&inuse_phase1[i];
        //    inuse_phase_temp = toto&inuse_phase1[j];
           if(inuse_phase_temp!=0)
            {   //////////////////////////////////////////////////////////////////////////
               if(XBYTE[baseaddr_now_phasesch+11+phasek]!=0)
                                       sensor_step[i] = 1;// && ((XBYTE[baseaddr_now_phasesch+2+phasek]&0x04)!=0x04))     //感应间隔不为0，即为感应相位
                //  sensor_step[j] = 1;
           }

         }
      }
      if(start_counter>10){
                 step_counter = 0;
                 now_step_key = 0;
                 sensor_virgin_flag = 1;
                 now_phase_status = 0;
                           }
      if(XBYTE[0X8021]==0X00){
                 step_counter = 0;
                 now_step_key = 0;
                 sensor_virgin_flag = 1;
                 now_phase_status = 0;
                         }else{  //////////////////////////////////////////相位差处理
         if(start_counter<10){
             for(i=0;i<24;i++){
                   period_start[i]=0x00000000;
                   sssch[24]=0;
                               }
             addr_temp = 0x63a4+74*(now_day_planid-1);       //当前日计划表基地址
             period_start[0]=0X00;//240*60;          //协调的标准时间是0点
             for(i=0;i<timeid;i++){ //各时段开始时间 以秒为单位记
                   addr_exange=(addr_temp+i*3);
                   h=XBYTE[addr_exange];
                   m=XBYTE[addr_exange+1];
                   if(h*60+m>1092)period_start[i+1]=64800+((h-18)*3600+m*60);
                             else period_start[i+1]=(h*3600+m*60);//((h*60+m)*60);   //各时段开始时间 以秒为单位记
                   sh=XBYTE[addr_exange+2];                           //时段对应的方案号
                   sssch[i]=sh;
                   addr_sch=0x5e82+41*(sh-1);                         //方案的基地址
                   num=XBYTE[addr_sch+2];
                   t_sch[i]=0;                            //本方案的阶段数
                   for(w=0;w<num;w++){
                             t_sch[i]=t_sch[i]+XBYTE[addr_sch+w+9];            //计算每时段对应方案的周期
                                      }
                                }

                   for(i=timeid;i>0;i--){
                             t_sch[i]=t_sch[i-1];             //循环向后移1位
                             sssch[i]=sssch[i-1];
                                         }
                             t_sch[0]=t_sch[timeid];        //最后的移到最前
                             sssch[0]=sssch[timeid];
                   for(i=0;i<timeid;i++){
                          dlt[i]=(period_start[i+1]-period_start[i])%t_sch[i];//时段总秒数对周期取余数
                          period_start[i+1]=period_start[i+1]+dlt[i];         //时段真正的开始时间
                                         }

           h=XBYTE[0Xc004];
           m=XBYTE[0XC002];
           s=XBYTE[0XC000];
           s=s+XBYTE[0X8021];   //
           if(h*60+m>1092){
               now_colock=64800+((h-18)*3600+m*60)+s;
                           }else now_colock=h*3600+m*60+s;
           i=0;
           do{
              i++;

              }while((now_colock>=period_start[i])&&(period_start[i]!=0x00));
               idd=i-1;          //判断当前时段  相位差已经起作用
               time_d= now_colock-period_start[idd]; //当前时间与本阶段开始时间的时间差
               tmod=time_d%t_sch[idd];               //周期的余数
               addr_sch=0x5e82+41*(sssch[idd]-1);    //本阶段方案基本地址
               num=XBYTE[addr_sch+2];                //阶段数
           i=0;sum=0;
           do{
              i++;

              sum=sum+XBYTE[addr_sch+i+8];
              }while(tmod>=sum);
           step_counter=i-1;     //当前所应处的阶段
           step_time=XBYTE[addr_sch+i+8];

           if(i==0x01)now_step_key=tmod;
                 else now_step_key=(tmod+XBYTE[addr_sch+i+8]-sum);
           now_phase_status = 0;
           EA=1;
                               }
                      }


      use_phase = 0;                 //整个阶段用到的相位
      for(i=0; i<step_num; i++)
      {
         // toto = 0x0001;
          toto = (0x0001<<i);
          use_phase = (use_phase|inuse_phase[i]);                 //整个阶段用到的相位
      }
      use_lamp = 0;                  //整个阶段用到的灯组
      addr_temp=baseaddr_now_phasesch;
      lai_temp=0;

     /*
      for(i=0;i<16;i++){
         addr_temp=18*i;
         addr_temp=addr_temp+baseaddr_now_phasesch;
         g=XBYTE[addr_temp];
         l=XBYTE[addr_temp+1];
         toto = (0x0001<<i);
         if((toto&use_phase)!=0)t[i]=((g<<8)|l);
                       }   */
      for(i=0; i<16; i++)
      {
         // phasek = 18*i;
          u[i]=5;
          addr_temp=18*i;
          addr_temp=addr_temp+baseaddr_now_phasesch;

          toto = (0x0001<<i);
          use_lamp_temp = (toto&use_phase);
          if((toto&use_phase)!=0)
          {
             use_lamp_temp=XBYTE[addr_temp]*256+XBYTE[addr_temp+1];
            // k=0;do{k++;}while(k>100);
            // u[i]=XBYTE[addr_temp]*256+XBYTE[addr_temp+1];
             k=0;do{k++;}while(k>100);
             use_lamp = (use_lamp|use_lamp_temp);                 //整个阶段用到的灯组

          }
      }
/*      l=0;
      g=0;
      for(i=0;i<8;i++){
          l=(l|u[i]);
          g=(g|(u[8+i]>>8));
                        }
      lai_temp= ((g<<8)|l);  */
      use_lamp_sch=use_lamp;
 /*    if(use_lamp_sch!=0x3fff){
          use_lamp_sch=0;
                             }    */

   }  EA=1;
}