Changeset 1137 for applications/doprava

Timestamp:

07/14/10 17:12:12 (15 years ago)

Author:

jabu

Message:

Funkce pro TrafficAgentCycleTime?

Files:

• applications/doprava/traffic_agent.h (modified) (2 diffs)

applications/doprava/traffic_agent.h

@@ -77 +77 @@
                 rv_queue.add(RV(lane.queue, 1)); 
                 inputs.set_size(rv_inputs._dsize());
+                // KOD PRO TrafficAgentCycleTime
+                init();
         }
 
@@ -87 +89 @@
         //! arbitrary function that computes the need of the signal group for green light in common units (number of waiting cars?)
         double expected_output(double green_time);
+
+        
+
+/********************************
+* KOD PRO TrafficAgentCycleTime *
+*********************************/
+        double last_queue;
+        double sum_queue_length;
+        double last_sum_queue_length;
+        double queue_diff_sum;
+        double queue_variance_sum;
+        int n_of_queues_in_length;
+        int last_n_of_queues_in_length;
+        double last_variance;
+        double green_time_ratio;
+        double Tc;
+        double last_Tc;
+        double saturated_stream;
+        double delta; // ztratovy cas pri prechodu na zelenou
+        // udaje opro kalmana
+        double queue_avg; //  pruner
+        double queue_w;   //  vaha
+        double queue_d;   //  rozptyl
+        double queue_dd;  //  snizeni verohodnosti odhadu 
+        double queue_r;   //  neduveryhodnost mereni = 1
+
+        double Ro_avg;  //  prumer
+        double Ro_w;    //  vaha K
+        double Ro_d;            //  rozptyl P
+        double Ro_dd;           //  snizeni verohodnosti odhadu Q
+        double Ro_r;            //  neduveryhodnost mereni = 1 R
+
+        double last_queue_avg;
+
+// pomocne funkce
+
+        
+
+        void init () {
+                last_Tc = 0;
+                saturated_stream = 0.5;
+                queue = 0;
+                sum_queue_length = 0;
+                last_sum_queue_length = 0;
+                n_of_queues_in_length = 0;
+                last_n_of_queues_in_length = 0;
+                queue_diff_sum = 0;
+                queue_variance_sum = 0;
+                last_variance = 0;
+                delta = 5;
+                // KALMAN
+                queue_avg = 0;  //  prumer
+                queue_w = 1;    //  vaha K
+                queue_d = 0.9;          //  rozptyl P
+                queue_dd =0.1;          //  snizeni verohodnosti odhadu Q
+                queue_r = 9;            //  neduveryhodnost mereni = 1 R
+
+                Ro_avg = 0;     //  prumer
+                Ro_w = 1;       //  vaha K
+                Ro_d = 0.9;             //  rozptyl P
+                Ro_dd =0.1;             //  snizeni verohodnosti odhadu Q
+                Ro_r = 9;               //  neduveryhodnost mereni = 1 R
+
+                last_queue_avg = 0;
+        }
+
+        /*double abs ( double x ) {
+                if ( x > 0 ) return x;
+                else return -x;
+        }*/
+
+        void echo () {
+                //cout << "n:" << n_of_queues_in_length << " " << getQueueName() << " q:" << getQueue() << " aq:" << getAverageQueueLength() << " diff:" << getAverageQueueGrow() << " D:" << getQueueVariance() << endl;
+                /*cout << "n:" << n_of_queues_in_length 
+                     << " " << getQueueName() 
+                         << "LAST aq:" << last_sum_queue_length/last_n_of_queues_in_length 
+                         << " aq:" << getAverageQueueLength()
+                         << " diff" <<  getAverageQueueLength() - last_sum_queue_length/last_n_of_queues_in_length 
+                         << endl;*/
+                cout << getQueueName();
+                /*if ( last_n_of_queues_in_length> 0 && n_of_queues_in_length > 0 )
+                        cout << " DIFF: " << getAverageQueueLength() - last_sum_queue_length/last_n_of_queues_in_length;
+                else
+                        cout << " no diff available";*/
+                //cout << "\tn " << n_of_queues_in_length;
+                //cout << " prijizdejicich aut za 90: " << getRo()*90;
+                cout << "\tgtr: " << green_time_ratio;
+                cout << "\tRo: " << getRo();
+                cout << "\tC: " << green_time_ratio*Tc*saturated_stream - getRo()*Tc << endl; 
+                //cout << "\tWT:";
+                for ( int i = -2; i <= 2; i++ ) {
+                        double tc = Tc + i*8;
+                        cout << tc << "\t";
+                }
+                cout << endl;
+                for ( int i = -2; i <= 2; i++ ) {
+                        double tc = Tc + i*8;
+                        cout << (int)(100*getWT(tc)) << "\t";
+                }
+                //cout << " diff: " << getRo()*Tc - saturated_stream*getGreenTime();
+                /*if ( saturated_stream*getGreenTime() >= getAverageQueueLength() )
+                        cout << " projede vsechno ";
+                else
+                        cout << " zustanou auta ";*/
+                cout << endl << endl;
+        }
+        
+
+        Lane getLane () {
+                return lane;
+        }
+
+        string getSG () {
+                return lane.sg;
+        }
+
+        string getQueueName () {
+                return lane.queue;
+        }
+
+        double getQueue() {
+                return queue_avg;
+        }
+
+        void addQueueLength ( int ql ) {
+                // pricita pouze namerene udaje
+                if ( ql >= 0 ) {
+                        last_queue = queue;
+                        queue = ql;
+                        queue_diff_sum += queue - last_queue;
+                        //queue_variance_sum += abs(queue - last_queue);
+                
+                        sum_queue_length += ql;
+                        n_of_queues_in_length ++;
+                        // KALMAN                       
+                        cout << endl << "pridani fronty\t" << queue_avg << "\t" << ql << endl;
+                        queue_avg += queue_w*( ql - queue_avg );
+                        queue_d += queue_dd;
+                        queue_w = queue_d/(queue_d+1);
+                        queue_d = (1-queue_w)*queue_d;
+        
+                        double Ro = getActualRo();
+                        Ro_avg += Ro_w*( Ro - Ro_avg );
+                        Ro_d += Ro_dd;
+                        Ro_w = Ro_d/(Ro_d+1);
+                        Ro_d = (1-Ro_w)*Ro_d;
+                }
+        }
+
+        void resetQueue () {
+                last_Tc = Tc;
+                //last_variance = getQueueVariance();
+                last_n_of_queues_in_length = n_of_queues_in_length;
+                last_sum_queue_length = sum_queue_length;
+                n_of_queues_in_length = 0;
+                sum_queue_length = 0;
+                queue_variance_sum = 0;
+                queue_diff_sum = 0;
+                // kalman
+                last_queue_avg = getAverageQueueLength();
+        }
+
+        double getAverageQueueLength () {
+                // kalmam
+                return queue_avg;
+
+                if( n_of_queues_in_length > 0 )
+                        return sum_queue_length / n_of_queues_in_length;
+                else
+                        return 0.0;
+        }
+
+        double getLastAverageQueueLength () {
+                if( last_n_of_queues_in_length > 0 )
+                        return last_sum_queue_length / last_n_of_queues_in_length;
+                else
+                        return 0.0;
+        }
+
+        /*double getAverageQueueGrow () {
+                return queue_diff_sum / n_of_queues_in_length;
+        }*/
+        
+        /*double getQueueVariance () {
+                return queue_variance_sum / n_of_queues_in_length;
+        }*/
+
+        double getGreenTime ( double tc ) { return green_time_ratio * tc - delta; }     
+        double getGreenTime () { return getGreenTime( Tc ); }   
+        
+        double getRedTime ( double tc ) { return (1-green_time_ratio) * tc;     }
+        double getRedTime () { return getRedTime( Tc ); }       
+
+        double getRelativeQueueDiff () {
+                if ( last_n_of_queues_in_length > 0 && n_of_queues_in_length > 0 ) {
+                        
+                        return getAverageQueueLength()/(Tc*(1-green_time_ratio)) - (last_sum_queue_length/last_n_of_queues_in_length)/(last_Tc*(1-green_time_ratio));
+                }
+                else
+                        return 0;
+        }
+
+        // hodnotici funkce - suma cekaciho casu aut za 10h
+        double getWT ( double  Tc ) {
+          double T = 36000; // celkovy cas 10h
+          double Ro = getRo();
+          double Gr = green_time_ratio;
+          double ss = saturated_stream;
+          double WT = 0;
+          double q = 0;  // zacina s nulovou frontou ?
+          double ti = 0;
+          double sumq = q;
+          while ( ti < T ) {
+                // ve fronte stoji vic aut nez je schopno odjet za zelenou
+                if ( q > 0.5*ss*Tc ) {
+                  WT += 0.5*ss*(Tc*Gr - delta)*(Tc*Gr - delta);
+                }
+                else {
+
+                  WT += 0.5*q*(Tc*Gr - delta);
+                }
+
+                if ( (Tc*Gr - delta)*ss < q )
+                  q -= (Tc*Gr - delta)*ss;
+                else
+                  q = 0;
+
+                WT += q * Tc; // zbytek fronty ceka cely cyklus
+                // cekani vozidel, ktera prijela za pocitany cyklus
+                if ( q > 0 ) {
+                  //pokud je fronta > 0, auta cekaji prumerne polovinu delky cyklu
+                  WT += Ro*Tc*0.5*Tc;
+                }
+                else {
+                  // pokud je fronta = 0 cekaji pouze auta, ktera prijela na cervenou (p=(1-Gr)) 0.5Tc(1-Gr)
+                  WT += Ro*(1-Gr)*Tc*0.5*(1-Gr)*Tc;
+                }
+                // fronta se zvetsi o Ro*Tc
+                q += Ro*Tc;
+                sumq += Ro*Tc;
+                ti += Tc;
+          }
+
+          //return WT;
+          if ( sumq > 0 )
+                return 100*(WT/(0.5*T*sumq));
+          else
+          return 0;
+        }
+
+        //double getWT ( double  tc ) {
+        //      double T = ;
+        //      double WT = 0;
+        //      double cWT = 0;
+        //      double q = 0;
+        //      double cq = 0;
+        //      double sum_t;
+        //      double car_part = 0.1;
+        //      double Ro = getRo();
+        //      double dt = car_part/Ro;
+        //      while ( sum_t < T ) {
+        //              if ( q < 0 )
+        //                      q = 0;
+        //              WT += q * dt;
+        //              // prirustek fronty za dt
+        //              q += car_part;
+        //              // zelena - auta projedou
+        //              if ( (sum_t - tc*(int)(sum_t/tc)) > delta && )
+        //                      q -= saturated_stream*dt;
+        //              sum_t += dt;
+        //      }
+        //}
+        // Odhad hustoty ( auto/sec )
+        double getActualRo () {
+                // pokud delka fronty mensi nez pocet aut ktere odjedou za zelenou
+                if ( saturated_stream*getGreenTime() >= getAverageQueueLength() ) {
+                        // pocet aut, ktera prijela pri cervene
+                        return getAverageQueueLength()/getRedTime();
+                }
+                else {
+                        //fronta se nevynuluje
+                        // pocet aut = to co stihlo projet na zelenou + o co narostla fronta
+                        // doba pocet_cyklu*90
+                        //double T = n_of_queues_in_length*90;
+                        //double cars_per_green = T*(getGreenTime()/Tc)*saturated_stream;
+                        //return (cars_per_green + queue_diff_sum)/T;
+                        double T = 90;
+                        double cars_per_green = T*(getGreenTime()/Tc)*saturated_stream;
+                        return (cars_per_green + (getLastAverageQueueLength()-getAverageQueueLength()))/T;
+                }
+        }
+
+        double getRo() {
+                return Ro_avg;
+        }
+        
+        
+
+        /***************************************
+        * KONEC KODU PRO TrafficAgentCycleTime *
+        ****************************************/
 };