69 SUMOTime haltingTimeThreshold,
double haltingSpeedThreshold,
double jamDistThreshold,
70 const std::string& vTypes,
int detectPersons) :
74 myJamHaltingSpeedThreshold(haltingSpeedThreshold),
75 myJamHaltingTimeThreshold(haltingTimeThreshold),
76 myJamDistanceThreshold(jamDistThreshold),
77 myNumberOfEnteredVehicles(0),
78 myNumberOfSeenVehicles(0),
79 myNumberOfLeftVehicles(0),
80 myCurrentVehicleSamples(0),
81 myCurrentOccupancy(0),
82 myCurrentMeanSpeed(0),
83 myCurrentMeanLength(0),
85 myCurrentMaxJamLengthInMeters(0),
86 myCurrentJamLengthInMeters(0),
87 myCurrentJamLengthInVehicles(0),
88 myCurrentHaltingsNumber(0) {
91 #ifdef DEBUG_E2_CONSTRUCTOR
93 std::cout <<
"\n" <<
"Creating MSE2Collector " <<
id
94 <<
" with lane = " << lane->
getID()
95 <<
" startPos = " << startPos
96 <<
" endPos = " << endPos
97 <<
" length = " << length
98 <<
" haltingTimeThreshold = " << haltingTimeThreshold
99 <<
" haltingSpeedThreshold = " << haltingSpeedThreshold
100 <<
" jamDistThreshold = " << jamDistThreshold
108 bool lengthInvalid = length == std::numeric_limits<double>::max() || length <= 0;
109 bool endPosInvalid = endPos == std::numeric_limits<double>::max();
110 bool posInvalid = startPos == std::numeric_limits<double>::max();
116 WRITE_WARNING(
"No valid detector length and start position given. Assuming startPos = 0 and length = end position");
120 WRITE_WARNING(
"No valid detector length and end position given. Assuming endPos = lane length and length = endPos-startPos");
123 endPos = endPos < 0 ? lane->
getLength() + endPos : endPos;
124 startPos = startPos < 0 ? lane->
getLength() + startPos : startPos;
125 bool valid = endPos <= lane->
getLength() && 0 <= startPos && startPos < endPos;
127 throw InvalidArgument(
"Error in specification for E2Detector '" +
id +
"'. Positional argument is malformed. 0 <= pos < endPos <= lane.getLength() is required.");
131 startPos =
snap(startPos, 0., POSITION_EPS);
132 length = endPos - startPos;
133 }
else if (posInvalid) {
135 endPos = endPos < 0 ? lane->
getLength() + endPos : endPos;
139 startPos = startPos < 0 ? lane->
getLength() + startPos : startPos;
140 startPos =
snap(startPos, 0., POSITION_EPS);
146 std::vector<MSLane*> lanes;
149 }
else if (endPosInvalid) {
153 lanes.push_back(lane);
163 DetectorUsage usage, std::vector<MSLane*> lanes,
double startPos,
double endPos,
164 SUMOTime haltingTimeThreshold,
double haltingSpeedThreshold,
double jamDistThreshold,
165 const std::string& vTypes,
int detectPersons) :
169 myFirstLane(lanes[0]),
170 myLastLane(lanes[lanes.size() - 1]),
171 myStartPos(startPos),
173 myJamHaltingSpeedThreshold(haltingSpeedThreshold),
174 myJamHaltingTimeThreshold(haltingTimeThreshold),
175 myJamDistanceThreshold(jamDistThreshold),
176 myNumberOfEnteredVehicles(0),
177 myNumberOfSeenVehicles(0),
178 myNumberOfLeftVehicles(0),
179 myCurrentVehicleSamples(0),
180 myCurrentOccupancy(0),
181 myCurrentMeanSpeed(0),
182 myCurrentMeanLength(0),
184 myCurrentJamLengthInMeters(0),
185 myCurrentJamLengthInVehicles(0),
186 myCurrentHaltingsNumber(0) {
189 for (std::vector<MSLane*>::const_iterator i = lanes.begin(); i != lanes.end(); ++i) {
193 #ifdef DEBUG_E2_CONSTRUCTOR
195 std::cout <<
"\n" <<
"Creating MSE2Collector " <<
id
197 <<
" endPos = " << endPos
199 <<
" startPos = " << startPos
200 <<
" haltingTimeThreshold = " << haltingTimeThreshold
201 <<
" haltingSpeedThreshold = " << haltingSpeedThreshold
202 <<
" jamDistThreshold = " << jamDistThreshold
213 if (
myEndPos > lanes[lanes.size() - 1]->getLength() - POSITION_EPS) {
214 myEndPos = lanes[lanes.size() - 1]->getLength();
227 if (desiredLength > 0 &&
myDetectorLength < desiredLength - NUMERICAL_EPS) {
228 std::stringstream ss;
229 ss <<
"Cannot build detector of length " << desiredLength
244 WRITE_WARNING(
"Adjusted detector positioning to meet requirement length >= " +
toString(POSITION_EPS)
257 #ifdef DEBUG_E2_CONSTRUCTOR
259 std::stringstream ss;
262 std::cout <<
"myStartPos = " <<
myStartPos << std::endl;
263 std::cout <<
"myEndPos = " <<
myEndPos << std::endl;
277 if (fabs(value - snapPoint) < snapDist) {
287 std::vector<std::string>::const_iterator i;
288 std::vector<MSLane*> lanes;
292 lanes.push_back(lane);
296 std::vector<MSLane*>::const_iterator j;
297 MSLane* previous =
nullptr;
299 for (j = lanes.begin(); j != lanes.end(); ++j) {
312 #ifdef DEBUG_E2_CONSTRUCTOR
314 std::cout <<
"Total detector length after recalculation = " <<
myDetectorLength << std::endl;
329 assert(dir ==
"fw" || dir ==
"bw");
330 bool fw = dir ==
"fw";
331 double linkLength = 0;
332 bool substractedLinkLength =
false;
334 #ifdef DEBUG_E2_CONSTRUCTOR
336 std::cout <<
"\n" <<
"selectLanes()" << (fw ?
"(forward)" :
"(backward)") << std::endl;
339 std::vector<MSLane*> lanes;
345 assert(
myStartPos != std::numeric_limits<double>::max());
348 assert(
myEndPos != std::numeric_limits<double>::max());
351 length =
MAX2(POSITION_EPS, length);
352 while (length >= POSITION_EPS && lane !=
nullptr) {
355 lanes.push_back(lane);
356 #ifdef DEBUG_E2_CONSTRUCTOR
358 std::cout <<
"Added lane " << lane->
getID()
359 <<
" (length: " << lane->
getLength() <<
")" << std::endl;
373 substractedLinkLength =
false;
383 length -= linkLength;
384 substractedLinkLength =
true;
388 #ifdef DEBUG_E2_CONSTRUCTOR
391 std::cout << (fw ?
"Successor lane: " :
"Predecessor lane: ") <<
"'" << lane->
getID() <<
"'";
393 std::cout << std::endl;
398 if (substractedLinkLength) {
402 length += linkLength;
415 if (length > -POSITION_EPS) {
416 myEndPos = lanes[lanes.size() - 1]->getLength();
417 }
else if (length < 0) {
418 myEndPos = lanes[lanes.size() - 1]->getLength() + length;
421 if (length > -POSITION_EPS) {
423 }
else if (length < 0) {
430 std::reverse(lanes.begin(), lanes.end());
438 #ifdef DEBUG_E2_CONSTRUCTOR
440 std::cout <<
"\n" <<
"Adding detector " <<
myID <<
" to lanes:" << std::endl;
443 for (std::vector<MSLane*>::iterator l = lanes.begin(); l != lanes.end(); ++l) {
444 (*l)->addMoveReminder(
this);
445 #ifdef DEBUG_E2_CONSTRUCTOR
447 std::cout << (*l)->getID() << std::endl;
459 #ifdef DEBUG_E2_CONSTRUCTOR
461 std::cout <<
"\n" <<
"Initializing auxiliaries:"
481 std::vector<MSLane*>::iterator il = lanes.begin();
488 #ifdef DEBUG_E2_CONSTRUCTOR
490 std::cout <<
"\n" <<
"Initializing offsets:" << std::endl;
495 #pragma warning(push)
496 #pragma warning(disable: 4127)
503 while (
internal !=
nullptr) {
504 myLanes.push_back(internal->getID());
507 #ifdef DEBUG_E2_CONSTRUCTOR
509 std::cout <<
"Offset for lane " <<
internal->getID() <<
" = " <<
myDetectorLength
520 assert(internal->getLinkCont().size() == 1);
522 internal =
internal->getLinkCont()[0]->getViaLaneOrLane();
523 if (!internal->isInternal()) {
535 while (il != lanes.end() && (*il)->isInternal()) {
538 if (il == lanes.end()) {
546 #ifdef DEBUG_E2_CONSTRUCTOR
560 if (++il == lanes.end()) {
564 if ((*il)->isInternal()) {
572 if (link ==
nullptr) {
573 throw InvalidArgument(
"Lanes '" + lane->
getID() +
"' and '" + (*il)->getID() +
"' are not consecutive in defintion of e2Detector '" +
getID() +
"'");
584 bool fw =
myEndPos == std::numeric_limits<double>::max();
591 #ifdef DEBUG_E2_CONSTRUCTOR
593 std::cout <<
"Total detector length after initAuxiliaries() = " <<
myDetectorLength << std::endl;
604 std::vector<MSLane*> res;
605 for (std::vector<std::string>::const_iterator i =
myLanes.begin(); i !=
myLanes.end(); ++i) {
614 double newPos,
double newSpeed) {
620 keep =
notifyMove(*p, oldPos, newPos, newSpeed);
630 const std::string& vehID = veh.
getID();
639 #ifdef DEBUG_E2_NOTIFY_MOVE
642 <<
" MSE2Collector::notifyMove() (detID = " <<
myID <<
" on lane '" <<
myLane->
getID() <<
"')"
643 <<
" called by vehicle '" << vehID <<
"'"
644 <<
" at relative position " << relPos
652 #ifdef DEBUG_E2_NOTIFY_MOVE
654 std::cout <<
"Vehicle has not yet reached the detector start position." << std::endl;
671 if (vehicleEnteredLaneAfterDetector) {
672 #ifdef DEBUG_E2_NOTIFY_MOVE
674 std::cout <<
"Vehicle entered lane behind detector." << std::endl;
682 if (vehPassedDetectorEnd) {
683 #ifdef DEBUG_E2_NOTIFY_MOVE
685 std::cout <<
"Vehicle has left the detector longitudinally." << std::endl;
699 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
701 std::cout <<
"\n" <<
SIMTIME <<
" notifyLeave() (detID = " <<
myID <<
" on lane '" <<
myLane->
getID() <<
"')"
702 <<
"called by vehicle '" << veh.
getID() <<
"'" << std::endl;
712 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
714 std::cout <<
SIMTIME <<
" Left longitudinally (along junction) -> keep subscription [handle exit in notifyMove()]" << std::endl;
722 double exitOffset = vi->second->entryOffset -
myOffsets[vi->second->currentOffsetIndex] - vi->second->currentLane->getLength();
723 vi->second->exitOffset =
MAX2(vi->second->exitOffset, exitOffset);
724 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
726 std::cout <<
SIMTIME <<
" Vehicle '" << veh.
getID() <<
"' leaves the detector. Exit offset = " << vi->second->exitOffset << std::endl;
736 if (vi->second->hasEntered) {
741 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
743 std::cout <<
SIMTIME <<
" Left non-longitudinally (lanechange, teleport, parking, etc) -> discard subscription" << std::endl;
756 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
758 std::cout << std::endl <<
SIMTIME <<
" notifyEnter() (detID = " <<
myID <<
" on lane '" <<
myLane->
getID() <<
"')"
759 <<
" called by vehicle '" << veh.
getID()
760 <<
"' entering lane '" << (enteredLane != 0 ? enteredLane->
getID() :
"NULL") <<
"'" << std::endl;
765 assert(veh.
getLane() == enteredLane);
785 bool vehEnteredBehindDetectorEnd = (enteredLane ==
myLastLane) &&
myEndPos <= vehBackPos;
786 if (vehEnteredBehindDetectorEnd) {
789 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
791 std::cout <<
"Vehicle entered the lane behind the detector, ignoring it." << std::endl;
792 std::cout <<
"(myEndPos = " << this->
myEndPos <<
", veh.getBackPositionOnLane() = " << vehBackPos <<
")" << std::endl;
799 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
803 std::cout <<
"Vehicle is off road (teleporting over edge)..." << std::endl;
811 const std::string& vehID = veh.
getID();
815 if (vi->second->currentLane != enteredLane) {
816 vi->second->currentOffsetIndex++;
817 vi->second->currentLane = enteredLane;
820 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
823 <<
"' already known. No new VehicleInfo is created.\n"
824 <<
"enteredLane = " << enteredLane->
getID() <<
"\nmyLanes[vi->offset] = " <<
myLanes[vi->second->currentOffsetIndex]
828 assert(
myLanes[vi->second->currentOffsetIndex] == enteredLane->
getID());
836 #ifdef DEBUG_E2_NOTIFY_ENTER_AND_LEAVE
838 std::cout <<
SIMTIME <<
" Adding VehicleInfo for vehicle '" << veh.
getID() <<
"'." << std::endl;
853 assert(j >= 0 && j < (
int)
myLanes.size());
858 #ifdef DEBUG_E2_MAKE_VEHINFO
860 std::cout <<
SIMTIME <<
" Making VehicleInfo for vehicle '" << veh.
getID() <<
"'."
861 <<
"\ndistToDetectorEnd = " << distToDetectorEnd
863 <<
"\nentry lane offset (lane begin from detector begin) = " << entryOffset
875 const double newSpeed = p->
getSpeed();
880 const double oldPos = newPos -
SPEED2DIST(newSpeed);
895 throw ProcessError(
"Multi-lane e2Detector does not support detecting persons yet");
898 if (lane->hasPedestrians()) {
908 #ifdef DEBUG_E2_DETECTOR_UPDATE
910 std::cout <<
"\n" <<
SIMTIME <<
" detectorUpdate() for detector '" <<
myID <<
"'"
932 std::vector<JamInfo*> jams;
933 std::map<std::string, SUMOTime> haltingVehicles;
934 std::map<std::string, SUMOTime> intervalHaltingVehicles;
939 const std::string& vehID = (*i)->id;
950 bool isInJam =
checkJam(i, haltingVehicles, intervalHaltingVehicles);
951 buildJam(isInJam, i, currentJam, jams);
964 #ifdef DEBUG_E2_DETECTOR_UPDATE
966 std::cout <<
"\n" <<
SIMTIME <<
" Current lanes for vehicles still on or approaching the detector:" << std::endl;
970 VehicleInfoMap::iterator iv;
972 #ifdef DEBUG_E2_DETECTOR_UPDATE
974 std::cout <<
" Vehicle '" << iv->second->id <<
"'" <<
": '"
975 << iv->second->currentLane->getID() <<
"'"
981 #ifdef DEBUG_E2_DETECTOR_UPDATE
983 std::cout <<
SIMTIME <<
" Discarding vehicles that have left the detector:" << std::endl;
987 std::set<std::string>::const_iterator i;
993 #ifdef DEBUG_E2_DETECTOR_UPDATE
995 std::cout <<
"Erased vehicle '" << *i <<
"'" << std::endl;
1036 #ifdef DEBUG_E2_DETECTOR_UPDATE
1038 std::cout <<
SIMTIME <<
" integrateMoveNotification() for vehicle '" << mni->
id <<
"'"
1041 <<
"\ntimeLoss = " << mni->
timeLoss
1042 <<
"\nspeed = " << mni->
speed
1055 if (vi !=
nullptr) {
1072 #ifdef DEBUG_E2_NOTIFY_MOVE
1074 std::cout <<
SIMTIME <<
" makeMoveNotification() for vehicle '" << veh.
getID() <<
"'"
1075 <<
" oldPos = " << oldPos <<
" newPos = " << newPos <<
" newSpeed = " << newSpeed
1081 double timeOnDetector;
1093 double distToExit = -vehInfo.
exitOffset - newPos;
1095 lengthOnDetector =
MAX2(0., lengthOnDetector +
MIN2(0., distToExit));
1098 bool stillOnDetector = -distToExit < vehInfo.
length;
1100 #ifdef DEBUG_E2_NOTIFY_MOVE
1102 std::cout <<
SIMTIME <<
" lengthOnDetector = " << lengthOnDetector
1103 <<
"\nvehInfo.exitOffset = " << vehInfo.
exitOffset
1104 <<
" vehInfo.entryOffset = " << vehInfo.
entryOffset
1105 <<
" distToExit = " << distToExit
1113 timeOnDetector, lengthOnDetector, timeLoss, stillOnDetector);
1118 #ifdef DEBUG_E2_JAMS
1120 std::cout <<
SIMTIME <<
" buildJam() for vehicle '" << (*mni)->id <<
"'" << std::endl;
1126 if (currentJam ==
nullptr) {
1127 #ifdef DEBUG_E2_JAMS
1129 std::cout <<
SIMTIME <<
" vehicle '" << (*mni)->id <<
"' forms the start of the first jam" << std::endl;
1142 #ifdef DEBUG_E2_JAMS
1144 std::cout <<
SIMTIME <<
" vehicle '" << (*mni)->id <<
"' forms the start of a new jam" << std::endl;
1149 jams.push_back(currentJam);
1158 if (currentJam !=
nullptr) {
1159 #ifdef DEBUG_E2_JAMS
1161 std::cout <<
SIMTIME <<
" Closing current jam." << std::endl;
1164 jams.push_back(currentJam);
1165 currentJam =
nullptr;
1172 MSE2Collector::checkJam(std::vector<MoveNotificationInfo*>::const_iterator mni, std::map<std::string, SUMOTime>& haltingVehicles, std::map<std::string, SUMOTime>& intervalHaltingVehicles) {
1173 #ifdef DEBUG_E2_JAMS
1175 std::cout <<
SIMTIME <<
" CheckJam() for vehicle '" << (*mni)->id <<
"'" << std::endl;
1179 bool isInJam =
false;
1190 #ifdef DEBUG_E2_JAMS
1192 std::cout <<
SIMTIME <<
" vehicle '" << (*mni)->id <<
"' starts halting." << std::endl;
1195 haltingVehicles[(*mni)->id] =
DELTA_T;
1196 intervalHaltingVehicles[(*mni)->id] =
DELTA_T;
1218 #ifdef DEBUG_E2_JAMS
1220 std::cout <<
SIMTIME <<
" vehicle '" << (*mni)->id <<
"'" << (isInJam ?
"is jammed." :
"is not jammed.") << std::endl;
1230 if (currentJam !=
nullptr) {
1231 jams.push_back(currentJam);
1232 currentJam =
nullptr;
1235 #ifdef DEBUG_E2_JAMS
1237 std::cout <<
"\n" <<
SIMTIME <<
" processJams()"
1238 <<
"\nNumber of jams: " << jams.size() << std::endl;
1247 for (std::vector<JamInfo*>::const_iterator i = jams.begin(); i != jams.end(); ++i) {
1254 const int jamLengthInVehicles = (int) distance((*i)->firstStandingVehicle, (*i)->lastStandingVehicle) + 1;
1262 #ifdef DEBUG_E2_JAMS
1264 std::cout <<
SIMTIME <<
" processing jam nr." << ((int) distance((std::vector<JamInfo*>::const_iterator) jams.begin(), i) + 1)
1265 <<
"\njamLengthInMeters = " << jamLengthInMeters
1266 <<
" jamLengthInVehicles = " << jamLengthInVehicles
1274 for (std::vector<JamInfo*>::iterator i = jams.begin(); i != jams.end(); ++i) {
1284 if (oldPos == newPos) {
1287 timeOnDetector =
TS;
1294 double entryTime = 0;
1296 if (oldPos < entryPos) {
1304 assert(entryPos < exitPos);
1308 if (exitPos == newPos) {
1323 timeOnDetector = exitTime - entryTime;
1324 timeLoss =
MAX2(0., timeOnDetector * (vmax - (entrySpeed + exitSpeed) / 2) / vmax);
1326 #ifdef DEBUG_E2_TIME_ON_DETECTOR
1328 std::cout <<
SIMTIME <<
" calculateTimeLoss() for vehicle '" << veh.
getID() <<
"'"
1329 <<
" oldPos = " << oldPos <<
" newPos = " << newPos
1330 <<
" entryPos = " << entryPos <<
" exitPos = " << exitPos
1331 <<
" timeOnDetector = " << timeOnDetector
1332 <<
" timeLoss = " << timeLoss
1350 dev <<
" <interval begin=\"" <<
time2string(startTime) <<
"\" end=\"" <<
time2string(stopTime) <<
"\" " <<
"id=\"" <<
getID() <<
"\" ";
1363 haltingDurationSum += (*i);
1364 maxHaltingDuration =
MAX2(maxHaltingDuration, (*i));
1368 haltingDurationSum += (*i).second;
1369 maxHaltingDuration =
MAX2(maxHaltingDuration, (*i).second);
1372 const SUMOTime meanHaltingDuration = haltingNo != 0 ? haltingDurationSum / haltingNo : 0;
1374 SUMOTime intervalHaltingDurationSum = 0;
1375 SUMOTime intervalMaxHaltingDuration = 0;
1376 int intervalHaltingNo = 0;
1378 intervalHaltingDurationSum += (*i);
1379 intervalMaxHaltingDuration =
MAX2(intervalMaxHaltingDuration, (*i));
1380 intervalHaltingNo++;
1383 intervalHaltingDurationSum += (*i).second;
1384 intervalMaxHaltingDuration =
MAX2(intervalMaxHaltingDuration, (*i).second);
1385 intervalHaltingNo++;
1387 const SUMOTime intervalMeanHaltingDuration = intervalHaltingNo != 0 ? intervalHaltingDurationSum / intervalHaltingNo : 0;
1389 #ifdef DEBUG_E2_XML_OUT
1391 std::stringstream ss;
1397 <<
"meanSpeed=\"" << meanSpeed <<
"\"";
1398 std::cout << ss.str() << std::endl;
1407 <<
"meanSpeed=\"" << meanSpeed <<
"\" "
1408 <<
"meanTimeLoss=\"" << meanTimeLoss <<
"\" "
1409 <<
"meanOccupancy=\"" << meanOccupancy <<
"\" "
1411 <<
"meanMaxJamLengthInVehicles=\"" << meanJamLengthInVehicles <<
"\" "
1412 <<
"meanMaxJamLengthInMeters=\"" << meanJamLengthInMeters <<
"\" "
1417 <<
"meanHaltingDuration=\"" <<
STEPS2TIME(meanHaltingDuration) <<
"\" "
1418 <<
"maxHaltingDuration=\"" <<
STEPS2TIME(maxHaltingDuration) <<
"\" "
1419 <<
"haltingDurationSum=\"" <<
STEPS2TIME(haltingDurationSum) <<
"\" "
1420 <<
"meanIntervalHaltingDuration=\"" <<
STEPS2TIME(intervalMeanHaltingDuration) <<
"\" "
1421 <<
"maxIntervalHaltingDuration=\"" <<
STEPS2TIME(intervalMaxHaltingDuration) <<
"\" "
1422 <<
"intervalHaltingDurationSum=\"" <<
STEPS2TIME(intervalHaltingDurationSum) <<
"\" "
1424 <<
"meanVehicleNumber=\"" << meanVehicleNumber <<
"\" "
1463 if (it->second->onDetector) {
1472 std::vector<std::string>
1474 std::vector<std::string> ret;
1476 if (i->second->onDetector) {
1477 ret.push_back(i->second->id);
1480 std::sort(ret.begin(), ret.end());
1485 std::vector<MSE2Collector::VehicleInfo*>
1487 std::vector<VehicleInfo*> res;
1488 VehicleInfoMap::const_iterator i;
1490 if (i->second->onDetector) {
1491 res.push_back(i->second);
1508 if (it->second->onDetector) {
1513 const double realDistance = it->second->distToDetectorEnd;
1514 if (it->second->lastSpeed <= thresholdSpeed || it->second->lastAccel > 0) {
1515 count = (int)(realDistance / (it->second->length + it->second->minGap)) + 1;
1530 double distance = std::numeric_limits<double>::max();
1531 double realDistance = 0;
1532 bool flowing =
true;
1535 if (it->second->onDetector) {
1536 distance =
MIN2(it->second->lastPos, distance);
1538 if (it->second->lastSpeed <= 0.5) {
1539 realDistance = distance - it->second->length + it->second->minGap;
#define WRITE_WARNING(msg)
std::string time2string(SUMOTime t)
convert SUMOTime to string
std::string toString(const T &t, std::streamsize accuracy=gPrecision)
The base class for microscopic and mesoscopic vehicles.
const std::vector< MSTransportable * > & getPersons() const
retrieve riding persons
static double speedAfterTime(const double t, const double oldSpeed, const double dist)
Calculates the speed after a time t \in [0,TS] given the initial speed and the distance traveled in a...
static double passingTime(const double lastPos, const double passedPos, const double currentPos, const double lastSpeed, const double currentSpeed)
Calculates the time at which the position passedPosition has been passed In case of a ballistic updat...
Base of value-generating classes (detectors)
bool vehicleApplies(const SUMOTrafficObject &veh) const
Checks whether the detector measures vehicles of the given type.
const int myDetectPersons
Whether pedestrians shall be detected instead of vehicles.
bool personApplies(const MSTransportable &p, int dir) const
void checkPositioning(bool posGiven=false, double desiredLength=0.)
Adjusts positioning if the detector length is less than POSITION_EPS and tests some assertions.
void notifyMovePerson(MSTransportable *p, int dir, double pos)
double myCurrentMaxJamLengthInMeters
the current maximum jam length in meters
VehicleInfo * makeVehicleInfo(const SUMOTrafficObject &veh, const MSLane *enteredLane) const
Creates and returns a VehicleInfo (called at the vehicle's entry)
bool checkJam(std::vector< MoveNotificationInfo * >::const_iterator mni, std::map< std::string, SUMOTime > &haltingVehicles, std::map< std::string, SUMOTime > &intervalHaltingVehicles)
checks whether the vehicle stands in a jam
void buildJam(bool isInJam, std::vector< MoveNotificationInfo * >::const_iterator mni, JamInfo *¤tJam, std::vector< JamInfo * > &jams)
Either adds the vehicle to the end of an existing jam, or closes the last jam, and/or creates a new j...
std::map< std::string, SUMOTime > myHaltingVehicleDurations
Storage for halting durations of known vehicles (for halting vehicles)
int myJamLengthInVehiclesSum
The sum of jam lengths [#veh].
int myMeanVehicleNumber
The mean number of vehicles [#veh].
int myCurrentStartedHalts
The number of started halts in the last step.
int myTimeSamples
The current aggregation duration [#steps].
static bool compareMoveNotification(MoveNotificationInfo *mni1, MoveNotificationInfo *mni2)
int myNumberOfSeenVehicles
The number of vehicles, present on the detector at the last reset.
int myCurrentMaxJamLengthInVehicles
The current maximum jam length in vehicles.
std::vector< MSLane * > getLanes()
Returns a vector containing pointers to the lanes covered by the detector ordered from its first to i...
int myNumberOfLeftVehicles
The number of vehicles, which have left the detector since the last reset.
std::vector< SUMOTime > myPastStandingDurations
Halting durations of ended halts [s].
void processJams(std::vector< JamInfo * > &jams, JamInfo *currentJam)
Calculates aggregated values from the given jam structure, deletes all jam-pointers.
std::vector< double > myOffsets
The distances of the lane-beginnings from the detector start-point.
int myMaxJamInVehicles
The max jam length [#veh].
virtual void reset()
Resets all values.
virtual bool notifyMove(SUMOTrafficObject &veh, double oldPos, double newPos, double newSpeed)
Adds/removes vehicles from the list of vehicles to regard.
std::vector< VehicleInfo * > getCurrentVehicles() const
Returns the VehicleInfos for the vehicles currently on the detector.
double myJamHaltingSpeedThreshold
A vehicle must driver slower than this to be counted as a part of a jam.
virtual bool notifyEnter(SUMOTrafficObject &veh, MSMoveReminder::Notification reason, const MSLane *enteredLane)
Adds the vehicle to known vehicles if not beyond the dector.
VehicleInfoMap myVehicleInfos
int myNumberOfEnteredVehicles
static double snap(double value, double snapPoint, double snapDist)
Snaps value to snpPoint if they are closer than snapDist.
void initAuxiliaries(std::vector< MSLane * > &lanes)
Checks integrity of myLanes, adds internal-lane information, inits myLength, myFirstLane,...
MSLane * myFirstLane
The first lane of the detector's lane sequence.
std::vector< std::string > getCurrentVehicleIDs() const
Returns the IDs of the vehicles within the area.
double mySpeedSum
The sum of collected vehicle speeds [m/s].
std::set< std::string > myLeftVehicles
Keep track of vehicles that left the detector by a regular move along a junction (not lanechange,...
double myEndPos
The position the detector ends at on the last lane.
double myDetectorLength
The total detector length.
std::vector< MSLane * > selectLanes(MSLane *endLane, double length, std::string dir)
This is called if no lane sequence is given to the constructor. Builds myLanes from the given informa...
int getCurrentVehicleNumber() const
Returns the number of vehicles currently on the detector.
double myCurrentMeanSpeed
The current mean speed.
double myStartPos
The position the detector starts at on the first lane.
std::vector< MoveNotificationInfo * > myMoveNotifications
Temporal storage for notifications from vehicles that did call the detector's notifyMove() in the las...
void addDetectorToLanes(std::vector< MSLane * > &lanes)
This adds the detector as a MoveReminder to the associated lanes.
SUMOTime myJamHaltingTimeThreshold
A vehicle must be that long beyond myJamHaltingSpeedThreshold to be counted as a part of a jam.
int myMaxVehicleNumber
The maximal number of vehicles located on the detector simultaneously since the last reset.
void recalculateDetectorLength()
Updates the detector length after myStartPos and myEndPos have been modified.
double myMaxOccupancy
The maximum occupancy [%].
virtual void detectorUpdate(const SUMOTime step)
Computes the detector values in each time step.
int myCurrentJamNo
The current jam number.
double myCurrentVehicleSamples
The current vehicle samples.
virtual bool notifyLeave(SUMOTrafficObject &veh, double lastPos, MSMoveReminder::Notification reason, const MSLane *enteredLane=0)
Removes a known vehicle due to its lane-change.
double myStartedHalts
The number of started halts [#].
double getEstimateQueueLength() const
Returns an estimate of the length of the queue of vehicles currently stopped on the detector.
MSE2Collector(const std::string &id, DetectorUsage usage, MSLane *lane, double startPos, double endPos, double length, SUMOTime haltingTimeThreshold, double haltingSpeedThreshold, double jamDistThreshold, const std::string &vTypes, int detectPersons)
Constructor with given end position and detector length.
virtual void writeXMLOutput(OutputDevice &dev, SUMOTime startTime, SUMOTime stopTime)
Write the generated output to the given device.
double myMeanMaxJamInMeters
The mean jam length [m].
double myCurrentJamLengthInMeters
The overall jam length in meters.
double myCurrentMeanLength
The current mean length.
double myMaxJamInMeters
The max jam length [m].
std::vector< std::string > myLanes
int myMeanMaxJamInVehicles
The mean jam length [#veh].
int myCurrentJamLengthInVehicles
The overall jam length in vehicles.
void calculateTimeLossAndTimeOnDetector(const SUMOTrafficObject &veh, double oldPos, double newPos, const VehicleInfo &vi, double &timeOnDetector, double &timeLoss) const
Calculates the time spent on the detector in the last step and the timeloss suffered in the last step...
double myJamLengthInMetersSum
The sum of jam lengths [m].
double myJamDistanceThreshold
Two standing vehicles must be closer than this to be counted into the same jam.
int getEstimatedCurrentVehicleNumber(double speedThreshold) const
Returns an estimate of the number of vehicles currently on the detector.
double getLength() const
Returns the length of the detector.
std::vector< SUMOTime > myPastIntervalStandingDurations
Halting durations of ended halts for the current interval [s].
virtual ~MSE2Collector()
Destructor.
MSLane * myLastLane
The last lane of the detector's lane sequence.
double myCurrentOccupancy
The current occupancy.
double myOccupancySum
The sum of occupancies [%].
int myCurrentHaltingsNumber
The number of halted vehicles [#].
virtual void clearState()
Remove all vehicles before quick-loading state.
virtual void writeXMLDetectorProlog(OutputDevice &dev) const
Open the XML-output.
double myTotalTimeLoss
The total amount of all time losses [time x vehicle] since the last reset.
void integrateMoveNotification(VehicleInfo *vi, const MoveNotificationInfo *mni)
This updates the detector values and the VehicleInfo of a vehicle on the detector with the given Move...
std::map< std::string, SUMOTime > myIntervalHaltingVehicleDurations
Storage for halting durations of known vehicles (current interval)
MoveNotificationInfo * makeMoveNotification(const SUMOTrafficObject &veh, double oldPos, double newPos, double newSpeed, const VehicleInfo &vehInfo) const
Creates and returns a MoveNotificationInfo containing detector specific information on the vehicle's ...
void aggregateOutputValues()
Aggregates and normalize some values for the detector output during detectorUpdate()
const std::set< MSTransportable * > & getPersons() const
Returns this edge's persons set.
static int gNumSimThreads
how many threads to use for simulation
static bool gUsingInternalLanes
Information whether the simulation regards internal lanes.
Representation of a lane in the micro simulation.
const MSLink * getLinkTo(const MSLane *const) const
returns the link to the given lane or nullptr, if it is not connected
double getSpeedLimit() const
Returns the lane's maximum allowed speed.
MSLane * getCanonicalPredecessorLane() const
double getLength() const
Returns the lane's length.
double getVehicleMaxSpeed(const SUMOTrafficObject *const veh) const
Returns the lane's maximum speed, given a vehicle's speed limit adaptation.
MSLane * getCanonicalSuccessorLane() const
static bool dictionary(const std::string &id, MSLane *lane)
Static (sic!) container methods {.
MSEdge & getEdge() const
Returns the lane's edge.
MSLane * getViaLane() const
Returns the following inner lane.
double getLength() const
Returns the length of this link.
Something on a lane to be noticed about vehicle movement.
MSLane *const myLane
Lane on which the reminder works.
Notification
Definition of a vehicle state.
@ NOTIFICATION_JUNCTION
The vehicle arrived at a junction.
virtual double getSpeed() const
the current speed of the transportable
const MSVehicleType & getVehicleType() const
Returns the object's "vehicle" type.
double getMinGap() const
Get the free space in front of vehicles of this class.
const std::string & getID() const
Returns the name of the vehicle type.
double getLength() const
Get vehicle's length [m].
std::string myID
The name of the object.
const std::string & getID() const
Returns the id.
Static storage of an output device and its base (abstract) implementation.
virtual bool isNull()
returns the information whether the device will discard all output
bool writeXMLHeader(const std::string &rootElement, const std::string &schemaFile, std::map< SumoXMLAttr, std::string > attrs=std::map< SumoXMLAttr, std::string >(), bool includeConfig=true)
Writes an XML header with optional configuration.
Representation of a vehicle, person, or container.
virtual bool isVehicle() const
Whether it is a vehicle.
virtual double getAcceleration() const =0
Returns the object's acceleration.
virtual double getPreviousSpeed() const =0
Returns the object's previous speed.
virtual double getSpeed() const =0
Returns the object's current speed.
virtual bool isPerson() const
Whether it is a person.
virtual const MSVehicleType & getVehicleType() const =0
Returns the object's "vehicle" type.
virtual double getBackPositionOnLane(const MSLane *lane) const =0
Get the object's back position along the given lane.
virtual const MSLane * getLane() const =0
Returns the lane the object is currently at.
virtual double getPositionOnLane() const =0
Get the object's position along the lane.
Representation of a vehicle.
A scoped lock which only triggers on condition.
Internal representation of a jam.
std::vector< MoveNotificationInfo * >::const_iterator lastStandingVehicle
The last standing vehicle.
std::vector< MoveNotificationInfo * >::const_iterator firstStandingVehicle
The first standing vehicle.
Values collected in notifyMove and needed in detectorUpdate() to calculate the accumulated quantities...
double speed
Speed after the last integration step.
double newPos
Position after the last integration step (relative to the vehicle's entry lane on the detector)
double distToDetectorEnd
Distance left till the detector end after the last integration step (may become negative if the vehic...
double accel
Acceleration in the last integration step.
double timeLoss
timeloss during the last integration step
double timeOnDetector
Time spent on the detector during the last integration step.
double lengthOnDetector
The length of the part of the vehicle on the detector at the end of the last time step.
bool onDetector
whether the vehicle is on the detector at the end of the current timestep
std::string id
Vehicle's id.
A VehicleInfo stores values that are tracked for the individual vehicles on the detector,...
double lastAccel
Last value of the acceleration.
double length
vehicle's length
double accumulatedTimeLoss
Accumulated time loss that this vehicle suffered since it entered the detector.
bool onDetector
whether the vehicle is on the detector at the end of the current timestep
double distToDetectorEnd
Distance left till the detector end after the last integration step (may become negative if the vehic...
double lastSpeed
Last value of the speed.
bool hasEntered
Whether the vehicle has already entered the detector (don't count twice!)
std::string id
vehicle's ID
double totalTimeOnDetector
Accumulated time that this vehicle has spent on the detector since its last entry.