Changeset 1028 for applications/doprava

Timestamp:

06/02/10 10:44:35 (15 years ago)

Author:

prikryl

Message:

New global variables NumLanes, LaneQueuesSectIds, NumLaneQueuesSectIds, LaneQueueOffsets, LaneQueuesStatPos, LaneQueuesLaneIds, QueueLengthOffsets.
Corrected the computation of NumIntersections.
Added queue lengths to Drv and dt.
The step() methods fetches the last statistical data from Aimsun as well.

Files:

• applications/doprava/aimsun_bdm/aimsun_ds.cpp (modified) (10 diffs)

applications/doprava/aimsun_bdm/aimsun_ds.cpp

@@ -21 +21 @@
 const TCHAR * ControllerList[NUM_CONTROLLERS] = { TEXT("K_5_495"), TEXT("K_5_601") };
 const TCHAR * WindowStr[NUM_CONTROLLERS]      = { TEXT("els3@5.495"), TEXT("els3@5.601") };
-const int IntersectionIDs[] = { 495, 601 }; 
-const int NumIntersections = sizeof ( IntersectionIDs );
+const int IntersectionIDs[] = { 495, 601 };
+const int NumLanes[] = { 6, 6 };
+const int NumIntersections = sizeof ( IntersectionIDs )/sizeof(int);
 
 /* Entrance sections are hardwired for Aimsun scenario `zlicin_495_601.sce` */
@@ -37 +38 @@
 const int NumStatIds = sizeof(StatIds)/sizeof(int);
 
+const int LaneQueuesSectIds[] = {
+        1,      2,      3,      6,      7,
+        3,      4,      5,
+        35,     28,     32,     33,     34,
+        26,     27,     35,     28,     29,     30,     31,
+        16,     17,     18,     19,     20,     14,     15,
+        16,     17,     18,     19,     20,     12,     13,
+        21,     22,     23,     24,     25,     40,
+        21,     22,     23,     24,     25,     40,
+        61,     62,     63,     64,     65,
+        287,288,54,     55,     56,     57,     58,     59,     60,     61,     62,     63,     64,     65,
+        45,     49,     51,
+        45,     49,     50,
+        43,     44,
+        43,     44,     42 };
+const int NumLaneQueuesSectIds = sizeof(LaneQueuesSectIds)/sizeof(int);
+
+/* This array contains offsets of particular lanes stored in LaneQueuesSectIds,
+   plus the would-be offset of the next non-existent lane (this is used to
+   set the limits of the index when extracting statistical data from the
+   section_stats structure). */
+int LaneQueueOffsets[] = {
+        0, 5, 8, 13, 20, 27,
+        34, 40, 46, 51, 65, 68, 70, 72, NumLaneQueuesSectIds+1 };
+
+/* The position of the statistics is given by the indices in the StatIds
+   array. In order to parse the statistics correctly we have to create
+   a copy of LaneQueuesSectIds holding indices to the StatIds array instead
+   of the original section ids. */
+int * LaneQueuesStatPos;
+
+const int LaneQueuesLaneIds[] = {
+        1,      1,      2,      1,      1,
+        1,      1,      1,
+        2,      2,      1,      1,      1,
+        1,      1,      1,      1,      1,      1,      1,
+        2,      2,      2,      2,      2,      1,      1,
+        1,      1,      1,      1,      1,      1,      1,
+        2,      2,      2,      2,      2,      2,
+        1,      1,      1,      1,      1,      1,
+        2,      2,      2,      2,      2,
+        1,      1,      1,      1,      1,      1,      1,      1,      1,      1,      1,      1,      1,      1,
+        2,      2,      1,
+        1,      1,      1,
+        2,      2,
+        1,      1,      1 };
+
 
 const TCHAR * PatternsELS3[] = { TEXT("GetramELS3.dll"), TEXT("GetramELS3d.dll") };
@@ -43 +91 @@
 /* Offsets of `dt` components (dt is the vector returned by AimsunDS, it contains composite
    values of all measurements for all intersections in the system). */
-const int SignalPlanOffsets[] = {  0, 36 };
-const int MeasurementOffsets[]  = {  6, 42 };
+const int SignalPlanOffsets[]  = {  0, 42 };
+const int QueueLengthOffsets[] = {  6, 48 };
+const int MeasurementOffsets[] = { 12, 54 };
 
 AimsunDS::AimsunDS () : DS()
@@ -51 +100 @@
   Drv = RV ( "{"
     "495_VA  495_VB   495_VC   495_VD   495_VE   495_VF "
+    "495_QA  495_QB   495_QC   495_QD   495_QE   495_QF "
     "495_DVA 495_DVB  495_DVA1 495_DVB1 495_DVC  495_DVD  495_DVE  495_DVF  495_DVF1 "
     "495_S1  495_S2   495_S3   495_S4   495_S5   495_S5a "
     "601_VA  601_VB   601_VC   601_VD   601_VE   601_SE "
+    "601_QA  601_QB   601_QC   601_QD   601_QE   601_QSE "
         "601_DVA 601_DVAa 601_DVB  601_DVBa 601_DVB1 601_DVC  601_DVD  601_DVD1 601_DSE 601_DVE 601_DSE1 601_DVE1 "
     "601_S6  601_S6a  601_S7   601_S8   601_S9   601_S9a "
@@ -60 +111 @@
     "}",
         "    1,      1,      1,      1,      1,       1,      "
+        "    1,      1,      1,      1,      1,       1,      "
         "    2,      2,      2,      2,      2,       2,      2,      2,      2,"
         "    2,      2,      2,      2,      2,       2,"
+        "    1,      1,      1,      1,      1,       1,      "
         "    1,      1,      1,      1,      1,       1,      "
         "    2,      2,      2,      2,      2,       2,       2,       2,       2,       2,       2,       2,"
@@ -304 +357 @@
                 StringCbCat ( szExePath, MAX_EXE_PATH, TEXT("\" ") );
                 StringCbCat ( szExePath, MAX_EXE_PATH, szELS3Path );
+                StringCbCat ( szExePath, MAX_EXE_PATH, TEXT(" -a") );
                 StringCbCat ( szExePath, MAX_EXE_PATH, TEXT(" -l frm,det,spl") );
                 StringCbCat ( szExePath, MAX_EXE_PATH, TEXT(" -c 12.12.2007 00:00:00") );
@@ -333 +387 @@
                 TEXT("glob_stats.csv")
                 );
+
+        /* Create LaneQueuesStatPos holding indices to the statistical data for the
+           sections listed in LaneQueuesSectIds in the same order. */
+        LaneQueuesStatPos = (int *) calloc ( NumLaneQueuesSectIds, sizeof(int));
+        for ( int i=0 ; i < NumLaneQueuesSectIds ; i++ )
+        {
+                int p = _search_index ( StatIds, NumStatIds, LaneQueuesSectIds[i] );
+                if ( p >= 0 )
+                {
+                        LaneQueuesStatPos[i] = p;
+                }
+                else
+                {
+                        fprintf ( stderr, "Cannot find index  LaneQueuesStatIds[%d]=%d in StatIds!\n",
+                                i, LaneQueuesSectIds[i] );
+                    exit(1);
+                }
+        }
 
 }
@@ -345 +417 @@
     int res;
         
+        /* Allocate space for the section statistics.
+           TODO: This is ugly. This should be part of VGS API. */
+        sections_stats.queues = (int*) calloc ( MAX_SECTS*MAX_LANES, sizeof(int) );
+        sections_stats.stats  = (vgs_se_stat_entry*) calloc ( MAX_SECTS, sizeof(vgs_se_stat_entry) );
+
         /* Pass information about entrance sections to VGS API (and so to the
        GetramVGS extension that will be generating vehicles for these
@@ -436 +513 @@
                         printf ( "\n" );
                 }
+        }
+
+        /* Loop over the statistical data. We will extract the queue length for
+           every intersection and store it into the data vector. */
+        int oLanes = 0; // lane offset for the actual intersection
+        int oLpos  = 0;
+        for ( int i = 0 ; i < NumIntersections ; i++ )
+        {
+                /* Every intersection has a certain number of lanes that (roughly)
+                   correspond to the number of signal groups. */
+                int nLanes  = NumLanes[i];
+                int qoffset = QueueLengthOffsets[i];
+                for ( int j = 0 ; j < nLanes ; j++ )
+                {
+                        /* Initial queue length for this lane is zero. */
+                        int qLen = 0;
+                        /* Every lane has one or more section identifiers at certain
+                           positions in LaneQueuesStatIds. The sequence of lanes
+                           is given by offsets in LaneQueueOffsets, the position of
+                           the statistical information is stored in LaneQueuesStatPos. */
+                        for ( int k = oLpos ; k < LaneQueueOffsets[oLanes+j+1] ; k++ )
+                        {
+                                /* Get the index into statistical information records. */
+                                int pi = LaneQueuesStatPos[k];
+                                int pl = LaneQueuesLaneIds[k]-1; // indices are not zero-based
+                                /* Now query the last queue length (section with more than
+                                   one lane holds several queue lengths) and add it to the
+                                   acumulated queue length value. */
+                                qLen += sections_stats.queues[pi*sections_stats.max_lanes+pl];
+                        }
+                        /* Move the lane position offset. */
+                        oLpos = LaneQueueOffsets[oLanes+j+1];
+                        /* Update the data vector. */
+                        dt[qoffset+j] = qLen;
+                }
+                oLanes = oLanes + nLanes;
         }
 
@@ -553 +666 @@
                 printf(" but got no data ???\n");
         }
+
+        /* Finally we will also read the last statistical information
+           from the VGS interface. */
+        vgs_get_last_stats ( &sections_stats );
 }