84 #define DEBUG_COND (true) 86 #define DEBUG_COND2(obj) ((obj != 0 && (obj)->isSelected())) 193 for (MSLinkCont::iterator i =
myLinks.begin(); i !=
myLinks.end(); ++i) {
222 (*veh)->addReminder(rem);
232 std::cout <<
SIMTIME <<
" setPartialOccupation. lane=" <<
getID() <<
" veh=" << v->
getID() <<
"\n";
245 std::cout <<
SIMTIME <<
" resetPartialOccupation. lane=" <<
getID() <<
" veh=" << v->
getID() <<
"\n";
264 std::cout <<
SIMTIME <<
" setManeuverReservation. lane=" <<
getID() <<
" veh=" << v->
getID() <<
"\n";
275 std::cout <<
SIMTIME <<
" resetManeuverReservation(): lane=" <<
getID() <<
" veh=" << v->
getID() <<
"\n";
320 leader = leaderInfo.first;
332 if (leaderBack >= frontGapNeeded) {
333 pos =
MIN2(pos, leaderBack - frontGapNeeded);
347 bool adaptableSpeed =
true;
356 if (missingRearGap > 0) {
357 if (minPos + missingRearGap <=
myLength) {
364 return isInsertionSuccess(&veh, mspeed, minPos + missingRearGap, posLat, adaptableSpeed, notification);
369 return isInsertionSuccess(&veh, mspeed, minPos, posLat, adaptableSpeed, notification);
376 const double speed = adaptableSpeed ? leader->
getSpeed() : mspeed;
378 if (leaderPos >= frontGapNeeded) {
388 MSLane::VehCont::iterator predIt =
myVehicles.begin();
399 double speed = mspeed;
400 if (adaptableSpeed && leader != 0) {
409 frontMax = leaderRearPos - frontGapNeeded;
417 if (frontMax > minPos && backMin +
POSITION_EPS < frontMax) {
486 bool patchSpeed =
true;
503 for (
int i = 0; i < 10; i++) {
529 for (
int i = 0; i < 10; i++) {
564 MSLane::checkFailure(
const MSVehicle* aVehicle,
double& speed,
double& dist,
const double nspeed,
const bool patchSpeed,
const std::string errorMsg)
const {
565 if (nspeed < speed) {
567 speed =
MIN2(nspeed, speed);
569 }
else if (speed > 0) {
570 if (errorMsg !=
"") {
571 WRITE_ERROR(
"Vehicle '" + aVehicle->
getID() +
"' will not be able to depart using the given velocity (" + errorMsg +
")!");
583 double speed,
double pos,
double posLat,
bool patchSpeed,
588 aVehicle->
getID() +
"'. Inserting at lane end instead.");
592 #ifdef DEBUG_INSERTION 594 std::cout <<
"\nIS_INSERTION_SUCCESS\n" 596 <<
" veh '" << aVehicle->
getID() <<
"'\n";
604 std::vector<MSLane*>::const_iterator ri = bestLaneConts.begin();
612 if (nextStop.
lane ==
this) {
613 std::stringstream msg;
614 msg <<
"scheduled stop on lane '" <<
myID <<
"' too close";
615 const double distToStop = nextStop.
pars.
endPos - pos;
617 patchSpeed, msg.str())) {
627 MSLane* currentLane =
this;
630 while (seen < dist && ri != bestLaneConts.end()) {
632 MSLinkCont::const_iterator link =
succLinkSec(*aVehicle, nRouteSuccs, *currentLane, bestLaneConts);
638 patchSpeed,
"arrival speed too low")) {
646 patchSpeed,
"junction too close")) {
655 || !(*link)->havePriority()) {
657 std::string errorMsg =
"";
658 const LinkState state = (*link)->getState();
664 errorMsg =
"unpriorised junction too close";
667 patchSpeed, errorMsg)) {
671 #ifdef DEBUG_INSERTION 673 std::cout <<
"trying insertion before minor link: " 674 <<
"insertion speed = " << speed <<
" dist=" << dist
681 nextLane = (*link)->getViaLaneOrLane();
689 if (nextStop.
lane == nextLane) {
690 std::stringstream msg;
691 msg <<
"scheduled stop on lane '" << nextStop.
lane->
getID() <<
"' too close";
692 const double distToStop = seen + nextStop.
pars.
endPos;
694 patchSpeed, msg.str())) {
705 #ifdef DEBUG_INSERTION 707 <<
" leader on lane '" << nextLane->
getID() <<
"': " << leaders.
toString() <<
" nspeed=" << nspeed <<
"\n";
711 #ifdef DEBUG_INSERTION 713 <<
" isInsertionSuccess lane=" <<
getID()
714 <<
" veh=" << aVehicle->
getID()
716 <<
" posLat=" << posLat
717 <<
" patchSpeed=" << patchSpeed
718 <<
" speed=" << speed
719 <<
" nspeed=" << nspeed
720 <<
" nextLane=" << nextLane->
getID()
723 <<
" failed (@641)!\n";
733 if (nspeed < speed) {
739 WRITE_ERROR(
"Vehicle '" + aVehicle->
getID() +
"' will not be able to depart using the given velocity (slow lane ahead)!");
748 if ((*link)->hasApproachingFoe(arrivalTime, leaveTime, speed, cfModel.
getMaxDecel())) {
756 currentLane = nextLane;
757 if ((*link)->getViaLane() == 0) {
771 #ifdef DEBUG_INSERTION 773 <<
" isInsertionSuccess lane=" <<
getID()
774 <<
" veh=" << aVehicle->
getID()
776 <<
" posLat=" << posLat
777 <<
" patchSpeed=" << patchSpeed
778 <<
" speed=" << speed
779 <<
" nspeed=" << nspeed
780 <<
" nextLane=" << nextLane->
getID()
781 <<
" leaders=" << leaders.
toString()
782 <<
" failed (@700)!\n";
786 #ifdef DEBUG_INSERTION 788 <<
" speed = " << speed
789 <<
" nspeed = " << nspeed
794 for (
int i = 0; i < followers.
numSublanes(); ++i) {
795 const MSVehicle* follower = followers[i].first;
798 if (followers[i].second < backGapNeeded) {
800 #ifdef DEBUG_INSERTION 802 <<
" isInsertionSuccess lane=" <<
getID()
803 <<
" veh=" << aVehicle->
getID()
805 <<
" posLat=" << posLat
806 <<
" patchSpeed=" << patchSpeed
807 <<
" speed=" << speed
808 <<
" nspeed=" << nspeed
809 <<
" follower=" << follower->
getID()
810 <<
" backGapNeeded=" << backGapNeeded
811 <<
" gap=" << followers[i].second
812 <<
" failure (@719)!\n";
824 #ifdef DEBUG_INSERTION 829 if (shadowLane != 0) {
831 for (
int i = 0; i < followers.
numSublanes(); ++i) {
832 const MSVehicle* follower = followers[i].first;
835 if (followers[i].second < backGapNeeded) {
837 #ifdef DEBUG_INSERTION 839 <<
" isInsertionSuccess shadowlane=" << shadowLane->
getID()
840 <<
" veh=" << aVehicle->
getID()
842 <<
" posLat=" << posLat
843 <<
" patchSpeed=" << patchSpeed
844 <<
" speed=" << speed
845 <<
" nspeed=" << nspeed
846 <<
" follower=" << follower->
getID()
847 <<
" backGapNeeded=" << backGapNeeded
848 <<
" gap=" << followers[i].second
849 <<
" failure (@812)!\n";
861 if (gap < gapNeeded) {
863 #ifdef DEBUG_INSERTION 865 <<
" isInsertionSuccess shadowlane=" << shadowLane->
getID()
866 <<
" veh=" << aVehicle->
getID()
868 <<
" posLat=" << posLat
869 <<
" patchSpeed=" << patchSpeed
870 <<
" speed=" << speed
871 <<
" nspeed=" << nspeed
872 <<
" leader=" << veh->
getID()
873 <<
" gapNeeded=" << gapNeeded
875 <<
" failure (@842)!\n";
886 if (missingRearGap > 0) {
888 #ifdef DEBUG_INSERTION 890 <<
" isInsertionSuccess lane=" <<
getID()
891 <<
" veh=" << aVehicle->
getID()
893 <<
" posLat=" << posLat
894 <<
" patchSpeed=" << patchSpeed
895 <<
" speed=" << speed
896 <<
" nspeed=" << nspeed
897 <<
" missingRearGap=" << missingRearGap
898 <<
" failure (@728)!\n";
905 #ifdef DEBUG_INSERTION 907 <<
" isInsertionSuccess lane=" <<
getID()
908 <<
" veh=" << aVehicle->
getID()
910 <<
" posLat=" << posLat
911 <<
" patchSpeed=" << patchSpeed
912 <<
" speed=" << speed
913 <<
" nspeed=" << nspeed
914 <<
" failed (@733)!\n";
920 #ifdef DEBUG_INSERTION 922 <<
" isInsertionSuccess lane=" <<
getID()
923 <<
" veh=" << aVehicle->
getID()
925 <<
" posLat=" << posLat
926 <<
" patchSpeed=" << patchSpeed
927 <<
" speed=" << speed
928 <<
" nspeed=" << nspeed
932 <<
"\n leaders=" << leaders.
toString()
950 double nspeed = speed;
958 nspeed =
MIN2(nspeed,
972 int freeSublanes = 1;
977 while (freeSublanes > 0 && veh != 0) {
978 #ifdef DEBUG_PLAN_MOVE 981 std::cout <<
" getLastVehicleInformation lane=" <<
getID() <<
" minPos=" << minPos <<
" veh=" << veh->
getID() <<
" pos=" << veh->
getPositionOnLane(
this) <<
"\n";
987 #ifdef DEBUG_PLAN_MOVE 995 if (ego == 0 && minPos == 0) {
1000 #ifdef DEBUG_PLAN_MOVE 1026 int freeSublanes = 1;
1028 while (freeSublanes > 0 && veh != 0) {
1029 #ifdef DEBUG_PLAN_MOVE 1031 std::cout <<
" veh=" << veh->
getID() <<
" pos=" << veh->
getPositionOnLane(
this) <<
" maxPos=" << maxPos <<
"\n";
1038 #ifdef DEBUG_PLAN_MOVE 1040 std::cout <<
" veh=" << veh->
getID() <<
" latOffset=" << latOffset <<
"\n";
1047 if (ego == 0 && maxPos == std::numeric_limits<double>::max()) {
1052 #ifdef DEBUG_PLAN_MOVE 1075 double cumulatedVehLength = 0.;
1079 VehCont::reverse_iterator veh =
myVehicles.rbegin();
1082 #ifdef DEBUG_PLAN_MOVE 1086 <<
" planMovements() lane=" <<
getID()
1094 #ifdef DEBUG_PLAN_MOVE 1096 std::cout <<
" plan move for: " << (*veh)->getID() <<
" leaders=" << leaders.
toString() <<
"\n";
1099 (*veh)->planMove(t, leaders, cumulatedVehLength);
1100 cumulatedVehLength += (*veh)->getVehicleType().getLengthWithGap();
1110 bool nextToConsiderIsPartial;
1113 while (moreReservationsAhead || morePartialVehsAhead) {
1114 if ((!moreReservationsAhead || (*vehRes)->getPositionOnLane(
this) <= veh->
getPositionOnLane())
1115 && (!morePartialVehsAhead || (*vehPart)->getPositionOnLane(
this) <= veh->
getPositionOnLane())) {
1121 if (moreReservationsAhead && !morePartialVehsAhead) {
1122 nextToConsiderIsPartial =
false;
1123 }
else if (morePartialVehsAhead && !moreReservationsAhead) {
1124 nextToConsiderIsPartial =
true;
1126 assert(morePartialVehsAhead && moreReservationsAhead);
1128 nextToConsiderIsPartial = (*vehPart)->getPositionOnLane(
this) > (*vehRes)->getPositionOnLane(
this);
1131 if (nextToConsiderIsPartial) {
1132 const double latOffset = (*vehPart)->getLatOffset(
this);
1133 #ifdef DEBUG_PLAN_MOVE 1135 std::cout <<
" partial ahead: " << (*vehPart)->getID() <<
" latOffset=" << latOffset <<
"\n";
1138 ahead.
addLeader(*vehPart,
false, latOffset);
1142 const double latOffset = (*vehRes)->getLatOffset(
this);
1143 #ifdef DEBUG_PLAN_MOVE 1145 std::cout <<
" reservation ahead: " << (*vehRes)->getID() <<
" latOffset=" << latOffset <<
"\n";
1148 ahead.
addLeader(*vehRes,
false, latOffset);
1158 #ifdef DEBUG_COLLISIONS 1160 std::vector<const MSVehicle*> all;
1162 all.push_back(*last);
1164 std::cout <<
SIMTIME <<
" detectCollisions stage=" << stage <<
" lane=" <<
getID() <<
":\n" 1167 <<
" all=" <<
toString(all) <<
"\n" 1175 std::set<const MSVehicle*, ComparatorIdLess> toRemove;
1176 std::set<const MSVehicle*> toTeleport;
1179 VehCont::iterator lastVeh =
myVehicles.end() - 1;
1180 for (VehCont::iterator veh =
myVehicles.begin(); veh != lastVeh; ++veh) {
1181 VehCont::iterator pred = veh + 1;
1201 if (lead == follow) {
1220 if (lead != 0 && lead != follow && shadowLane->
detectCollisionBetween(timestep, stage, follow, lead, toRemove, toTeleport)) {
1229 #ifdef DEBUG_JUNCTION_COLLISIONS 1231 std::cout <<
SIMTIME <<
" detect junction Collisions stage=" << stage <<
" lane=" <<
getID() <<
":\n" 1239 const std::vector<const MSLane*>& foeLanes =
myLinks.front()->getFoeLanes();
1244 for (std::vector<const MSLane*>::const_iterator it = foeLanes.begin(); it != foeLanes.end(); ++it) {
1245 const MSLane* foeLane = *it;
1250 if (victim == collider) {
1255 #ifdef DEBUG_JUNCTION_COLLISIONS 1257 std::cout <<
SIMTIME <<
" foe=" << victim->
getID() <<
" bound=" << colliderBoundary <<
" foeBound=" << victim->
getBoundingBox() <<
"\n";
1269 if (
myLinks.front()->getWalkingAreaFoe() != 0) {
1276 #ifdef DEBUG_PEDESTRIAN_COLLISIONS 1278 std::cout <<
SIMTIME <<
" detect pedestrian collisions stage=" << stage <<
" lane=" <<
getID() <<
"\n";
1288 #ifdef DEBUG_PEDESTRIAN_COLLISIONS 1290 std::cout <<
SIMTIME <<
" back=" << back <<
" right=" << right <<
" person=" <<
Named::getIDSecure(leader.first) <<
" dist=" << leader.second <<
"\n";
1293 if (leader.first != 0 && leader.second < length) {
1295 "Vehicle '" + v->
getID()
1296 +
"' collision with person '" + leader.first->getID()
1297 +
"', lane='" +
getID()
1298 +
"', gap=" +
toString(leader.second - length)
1300 +
" stage=" + stage +
".");
1307 for (std::set<const MSVehicle*, ComparatorIdLess>::iterator it = toRemove.begin(); it != toRemove.end(); ++it) {
1311 if (toTeleport.count(veh) > 0) {
1323 SUMOTime timestep,
const std::string& stage) {
1325 #ifdef DEBUG_PEDESTRIAN_COLLISIONS 1327 std::cout <<
SIMTIME <<
" detect pedestrian junction collisions stage=" << stage <<
" lane=" <<
getID() <<
" foeLane=" << foeLane->
getID() <<
"\n";
1331 for (std::vector<MSTransportable*>::const_iterator it_p = persons.begin(); it_p != persons.end(); ++it_p) {
1332 #ifdef DEBUG_PEDESTRIAN_COLLISIONS 1334 std::cout <<
" collider=" << collider->
getID()
1335 <<
" ped=" << (*it_p)->getID()
1336 <<
" colliderBoundary=" << colliderBoundary
1337 <<
" pedBoundary=" << (*it_p)->getBoundingBox()
1341 if (colliderBoundary.
overlapsWith((*it_p)->getBoundingBox())) {
1343 "Vehicle '" + collider->
getID()
1344 +
"' collision with person '" + (*it_p)->getID()
1345 +
"', lane='" +
getID()
1347 +
" stage=" + stage +
".");
1356 std::set<const MSVehicle*, ComparatorIdLess>& toRemove,
1357 std::set<const MSVehicle*>& toTeleport)
const {
1366 assert(collider != victim);
1371 std::swap(victim, collider);
1378 #ifdef DEBUG_COLLISIONS 1381 <<
" thisLane=" <<
getID()
1382 <<
" collider=" << collider->
getID()
1383 <<
" victim=" << victim->
getID()
1386 <<
" colliderPos=" << colliderPos
1406 && victim->
getLane() !=
this) {
1419 double gap,
double latGap, std::set<const MSVehicle*, ComparatorIdLess>& toRemove,
1420 std::set<const MSVehicle*>& toTeleport)
const {
1421 std::string prefix =
"Vehicle '" + collider->
getID() +
"'; collision with vehicle '" + victim->
getID() ;
1426 std::string dummyError;
1446 victim->
addStop(stop, dummyError, 0,
true);
1453 collider->
addStop(stop, dummyError, 0,
true);
1460 prefix =
"Teleporting vehicle '" + collider->
getID() +
"'; collision with vehicle '" + victim->
getID() ;
1461 toRemove.insert(collider);
1462 toTeleport.insert(collider);
1465 prefix =
"Removing collision participants: vehicle '" + collider->
getID() +
"', vehicle '" + victim->
getID();
1466 bool removeCollider =
true;
1467 bool removeVictim =
true;
1472 toRemove.insert(victim);
1474 if (removeCollider) {
1475 toRemove.insert(collider);
1477 if (!removeVictim) {
1478 if (!removeCollider) {
1479 prefix =
"Keeping remote-controlled collision participants: vehicle '" + collider->
getID() +
"', vehicle '" + victim->
getID();
1481 prefix =
"Removing collision participant: vehicle '" + collider->
getID() +
"', keeping remote-controlled vehicle '" + victim->
getID();
1483 }
else if (!removeCollider) {
1484 prefix =
"Keeping remote-controlled collision participant: vehicle '" + collider->
getID() +
"', removing vehicle '" + victim->
getID();
1487 toRemove.insert(victim);
1488 toRemove.insert(collider);
1497 +
"', lane='" +
getID()
1499 + (latGap == 0 ?
"" :
"', latGap=" +
toString(latGap))
1501 +
" stage=" + stage +
".");
1518 #ifdef DEBUG_EXEC_MOVE 1520 std::cout <<
SIMTIME <<
" veh " << veh->
getID() <<
" has arrived." << std::endl;
1525 }
else if (target != 0 && moved) {
1533 lanesWithVehiclesToIntegrate.push_back(target);
1543 WRITE_WARNING(
"Teleporting vehicle '" + veh->
getID() +
"'; beyond end of lane, target lane='" +
getID() +
"', time=" +
1569 i = VehCont::reverse_iterator(
myVehicles.erase(i.base()));
1580 const bool minorLink = !wrongLane && (link !=
myLinks.end()) && !((*link)->havePriority());
1581 const std::string reason = (wrongLane ?
" (wrong lane)" : (minorLink ?
" (yield)" :
" (jam)"));
1588 + (r2 ?
" (highway)" :
"")
1592 }
else if (minorLink) {
1604 lanesWithVehiclesToIntegrate.push_back(
this);
1626 const MSLane* firstInternal =
this;
1629 firstInternal = pred;
1633 return firstInternal;
1640 DictType::iterator it =
myDict.find(
id);
1641 if (it ==
myDict.end()) {
1643 myDict.insert(DictType::value_type(
id, ptr));
1652 DictType::iterator it =
myDict.find(
id);
1653 if (it ==
myDict.end()) {
1663 for (DictType::iterator i =
myDict.begin(); i !=
myDict.end(); ++i) {
1672 for (DictType::iterator i =
myDict.begin(); i !=
myDict.end(); ++i) {
1673 into.push_back((*i).first);
1678 template<
class RTREE>
void 1680 for (DictType::iterator i =
myDict.begin(); i !=
myDict.end(); ++i) {
1684 const float cmin[2] = {(float) b.
xmin(), (float) b.
ymin()};
1685 const float cmax[2] = {(float) b.
xmax(), (float) b.
ymax()};
1686 into.Insert(cmin, cmax, l);
1690 template void MSLane::fill<NamedRTree>(
NamedRTree& into);
1710 return (link !=
myLinks.end());
1720 assert(veh->
getLane() ==
this);
1733 #ifdef DEBUG_VEHICLE_CONTAINER 1737 return wasInactive &&
myVehicles.size() != 0;
1824 MSLinkCont::const_iterator
1826 const MSLane& succLinkSource,
const std::vector<MSLane*>& conts) {
1829 if (nRouteEdge == 0) {
1831 return succLinkSource.
myLinks.end();
1835 assert(succLinkSource.
myLinks.size() == 1);
1838 return succLinkSource.
myLinks.begin();
1849 MSLinkCont::const_iterator link;
1850 if (nRouteSuccs < (
int)conts.size()) {
1852 for (link = succLinkSource.
myLinks.begin(); link != succLinkSource.
myLinks.end(); ++link) {
1853 if ((*link)->getLane() != 0 && (*link)->getLane()->myEdge == nRouteEdge && (*link)->getLane()->allowsVehicleClass(veh.
getVehicleType().
getVehicleClass())) {
1855 if ((*link)->getLane() == conts[nRouteSuccs]) {
1862 return succLinkSource.
myLinks.end();
1867 WRITE_WARNING(
"Could not find connection between lane " + succLinkSource.
getID() +
" and lane " + conts[nRouteSuccs]->getID() +
1870 return succLinkSource.
myLinks.end();
1882 MSLinkCont::const_iterator l =
myLinks.begin();
1885 if ((*l)->getViaLane()->getID() == target->
getID()) {
1892 if ((*l)->getLane()->getID() == target->
getID()) {
1906 const MSLane*
internal =
this;
1945 assert(remVehicle->
getLane() ==
this);
1947 if (remVehicle == *it) {
1982 }
else if (!approachingEdge->
isInternal() && warnMultiCon) {
1985 WRITE_WARNING(
"Lane '" +
getID() +
"' is approached multiple times from edge '" + approachingEdge->
getID() +
"'. This may cause collisions.");
1999 std::map<MSEdge*, std::vector<MSLane*> >::const_iterator i =
myApproachingLanes.find(edge);
2003 const std::vector<MSLane*>& lanes = (*i).second;
2004 return find(lanes.begin(), lanes.end(), lane) != lanes.end();
2010 inline int operator()(
const std::pair<const MSVehicle*, double>& p1,
const std::pair<const MSVehicle*, double>& p2)
const {
2011 return p1.second < p2.second;
2023 const MSVehicle* v = followerInfo.first;
2041 std::pair<MSVehicle* const, double>
2042 MSLane::getLeader(
const MSVehicle* veh,
const double vehPos,
const std::vector<MSLane*>& bestLaneConts,
double dist,
bool checkTmpVehicles)
const {
2045 #ifdef DEBUG_CONTEXT 2050 if (checkTmpVehicles) {
2057 #ifdef DEBUG_CONTEXT 2059 std::cout <<
" getLeader lane=" <<
getID() <<
" ego=" << veh->
getID() <<
" egoPos=" << vehPos <<
" pred=" << pred->
getID() <<
" predPos=" << pred->
getPositionOnLane() <<
"\n";
2073 #ifdef DEBUG_CONTEXT 2075 std::cout <<
" getLeader lane=" <<
getID() <<
" ego=" << veh->
getID() <<
" egoPos=" << vehPos
2085 if (bestLaneConts.size() > 0) {
2091 #ifdef DEBUG_CONTEXT 2093 std::cout <<
" getLeader lane=" <<
getID() <<
" seen=" << seen <<
" dist=" << dist <<
"\n";
2097 return std::pair<MSVehicle* const, double>(
static_cast<MSVehicle*
>(0), -1);
2101 return std::make_pair(static_cast<MSVehicle*>(0), -1);
2106 std::pair<MSVehicle* const, double>
2108 const std::vector<MSLane*>& bestLaneConts)
const {
2109 #ifdef DEBUG_CONTEXT 2111 std::cout <<
" getLeaderOnConsecutive lane=" <<
getID() <<
" ego=" << veh.
getID() <<
" seen=" << seen <<
" dist=" << dist <<
" conts=" <<
toString(bestLaneConts) <<
"\n";
2115 return std::make_pair(static_cast<MSVehicle*>(0), -1);
2122 #ifdef DEBUG_CONTEXT 2129 const MSLane* nextLane =
this;
2132 nextLane->getVehiclesSecure();
2134 MSLinkCont::const_iterator link =
succLinkSec(veh, view, *nextLane, bestLaneConts);
2135 if (nextLane->isLinkEnd(link) || !(*link)->opened(arrivalTime, speed, speed, veh.
getVehicleType().
getLength(),
2137 #ifdef DEBUG_CONTEXT 2139 std::cout <<
" cannot continue after nextLane=" << nextLane->getID() <<
"\n";
2142 nextLane->releaseVehicles();
2147 nextLane->releaseVehicles();
2148 if (linkLeaders.size() > 0) {
2151 #ifdef DEBUG_CONTEXT 2153 std::cout <<
" found linkLeader after nextLane=" << nextLane->getID() <<
"\n";
2156 return linkLeaders[0].vehAndGap;
2158 bool nextInternal = (*link)->getViaLane() != 0;
2159 nextLane = (*link)->getViaLaneOrLane();
2160 if (nextLane == 0) {
2163 nextLane->getVehiclesSecure();
2164 MSVehicle* leader = nextLane->getLastAnyVehicle();
2166 #ifdef DEBUG_CONTEXT 2168 std::cout <<
" found leader " << leader->
getID() <<
" on nextLane=" << nextLane->getID() <<
"\n";
2172 nextLane->releaseVehicles();
2173 return std::make_pair(leader, dist);
2175 nextLane->releaseVehicles();
2176 if (nextLane->getVehicleMaxSpeed(&veh) < speed) {
2179 seen += nextLane->getLength();
2184 if (!nextInternal) {
2187 }
while (seen <= dist);
2188 return std::make_pair(static_cast<MSVehicle*>(0), -1);
2192 std::pair<MSVehicle* const, double>
2195 std::pair<MSVehicle*, double> result = std::make_pair(static_cast<MSVehicle*>(0), -1);
2196 double safeSpeed = std::numeric_limits<double>::max();
2201 const MSLane* nextLane =
this;
2205 MSLinkCont::const_iterator link =
succLinkSec(veh, view, *nextLane, bestLaneConts);
2212 for (MSLink::LinkLeaders::const_iterator it = linkLeaders.begin(); it != linkLeaders.end(); ++it) {
2213 const MSVehicle* leader = (*it).vehAndGap.first;
2214 if (leader != 0 && leader != result.first) {
2218 const double tmpSpeed = veh.
getSafeFollowSpeed((*it).vehAndGap, seen, nextLane, (*it).distToCrossing);
2219 if (tmpSpeed < safeSpeed) {
2220 safeSpeed = tmpSpeed;
2221 result = (*it).vehAndGap;
2225 bool nextInternal = (*link)->getViaLane() != 0;
2226 nextLane = (*link)->getViaLaneOrLane();
2227 if (nextLane == 0) {
2231 if (leader != 0 && leader != result.first) {
2234 if (tmpSpeed < safeSpeed) {
2235 safeSpeed = tmpSpeed;
2236 result = std::make_pair(leader, gap);
2247 if (!nextInternal) {
2250 }
while (seen <= dist);
2263 for (MSEdgeVector::iterator i = pred.begin(); i != pred.end();) {
2272 if (pred.size() != 0) {
2274 MSEdge* best = *pred.begin();
2286 MSLane* cand = (*i).lane;
2287 if (&(cand->
getEdge()) == &fromEdge) {
2307 #ifdef DEBUG_LANE_SORTER 2308 std::cout <<
"\nBest predecessor lane for lane '" <<
myID <<
"': '" << best.lane->getID() <<
"'" << std::endl;
2323 std::vector<MSLink*> candidateLinks =
myLinks;
2326 MSLane* best = (*candidateLinks.begin())->getViaLaneOrLane();
2327 #ifdef DEBUG_LANE_SORTER 2328 std::cout <<
"\nBest successor lane for lane '" <<
myID <<
"': '" << best->getID() <<
"'" << std::endl;
2346 std::vector<const MSLane*>
2348 std::vector<const MSLane*> result;
2349 for (MSLinkCont::const_iterator i =
myLinks.begin(); i !=
myLinks.end(); ++i) {
2350 assert((*i)->getLane() != 0);
2351 result.push_back((*i)->getLane());
2373 for (MSLinkCont::const_iterator i =
myLinks.begin(); i !=
myLinks.end(); ++i) {
2374 if ((*i)->getLane()->getEdge().isCrossing()) {
2375 return (
int)(i -
myLinks.begin());
2419 wtime += (*i)->getWaitingSeconds();
2432 for (VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2433 v += (*i)->getSpeed();
2445 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2446 ret += (*i)->getCO2Emissions();
2457 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2458 ret += (*i)->getCOEmissions();
2469 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2470 ret += (*i)->getPMxEmissions();
2481 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2482 ret += (*i)->getNOxEmissions();
2493 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2494 ret += (*i)->getHCEmissions();
2505 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2506 ret += (*i)->getFuelConsumption();
2517 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2518 ret += (*i)->getElectricityConsumption();
2529 if (vehs.size() == 0) {
2533 for (MSLane::VehCont::const_iterator i = vehs.begin(); i != vehs.end(); ++i) {
2534 double sv = (*i)->getHarmonoise_NoiseEmissions();
2535 ret += (double) pow(10., (sv / 10.));
2566 myLaneDir(e->getLanes()[0]->
getShape().angleAt2D(0)) {
2577 if (ae1 != 0 && ae1->size() != 0) {
2587 if (ae2 != 0 && ae2->size() != 0) {
2625 #ifdef DEBUG_LANE_SORTER 2626 std::cout <<
"\nincoming_lane_priority sorter()\n" 2627 <<
"noninternal predecessor for lane '" << laneInfo1.
lane->
getID()
2628 <<
"': '" << noninternal1->
getID() <<
"'\n" 2629 <<
"noninternal predecessor for lane '" << laneInfo2.
lane->
getID()
2630 <<
"': '" << noninternal2->
getID() <<
"'\n";
2638 bool priorized1 =
true;
2639 bool priorized2 =
true;
2641 std::vector<MSLink*>::const_iterator j;
2642 #ifdef DEBUG_LANE_SORTER 2643 std::cout <<
"FoeLinks of '" << noninternal1->
getID() <<
"'" << std::endl;
2646 #ifdef DEBUG_LANE_SORTER 2647 std::cout << (*j)->getLaneBefore()->getID() << std::endl;
2655 #ifdef DEBUG_LANE_SORTER 2656 std::cout <<
"FoeLinks of '" << noninternal2->
getID() <<
"'" << std::endl;
2659 #ifdef DEBUG_LANE_SORTER 2660 std::cout << (*j)->getLaneBefore()->getID() << std::endl;
2669 assert(priorized1 || priorized2);
2670 if (priorized1 != priorized2) {
2698 #ifdef DEBUG_LANE_SORTER 2699 std::cout <<
"\noutgoing_lane_priority sorter()\n" 2700 <<
"noninternal successors for lane '" <<
myLane->
getID()
2701 <<
"': '" << target1->
getID() <<
"' and " 2702 <<
"'" << target2->
getID() <<
"'\n";
2709 if (priority1 != priority2) {
2710 return priority1 > priority2;
2746 for (std::vector<std::string>::const_iterator it = vehIds.begin(); it != vehIds.end(); ++it) {
2760 bool allSublanes,
double searchDist,
bool ignoreMinorLinks)
const {
2763 #ifdef DEBUG_CONTEXT 2765 std::cout <<
SIMTIME <<
" getFollowers lane=" <<
getID() <<
" ego=" << ego->
getID() <<
" pos=" << egoPos <<
"\n";
2774 #ifdef DEBUG_CONTEXT 2784 #ifdef DEBUG_CONTEXT 2786 std::cout <<
" (1) added veh=" << veh->
getID() <<
" latOffset=" << latOffset <<
" result=" << result.
toString() <<
"\n";
2791 #ifdef DEBUG_CONTEXT 2793 std::cout <<
" result.numFreeSublanes=" << result.
numFreeSublanes() <<
"\n";
2801 if (searchDist == -1) {
2805 std::set<MSLane*> visited;
2806 std::vector<MSLane::IncomingLaneInfo> newFound;
2808 while (toExamine.size() != 0) {
2809 for (std::vector<MSLane::IncomingLaneInfo>::iterator it = toExamine.begin(); it != toExamine.end(); ++it) {
2810 MSLane* next = (*it).lane;
2814 #ifdef DEBUG_CONTEXT 2816 std::cout <<
" next=" << next->
getID() <<
" first=" << first.toString() <<
" firstFront=" << firstFront.
toString() <<
"\n";
2819 for (
int i = 0; i < first.numSublanes(); ++i) {
2822 if (v != 0 && v != ego) {
2829 agap = (*it).length - next->
getLength() + backOffset
2836 if (v != 0 && v != ego) {
2844 if (!(*it).viaLink->havePriority() && !ego->onFurtherEdge(&(*it).lane->getEdge())
2848 agap =
MAX2(agap, 0.0);
2852 #ifdef DEBUG_CONTEXT 2859 if ((*it).length < searchDist) {
2860 const std::vector<MSLane::IncomingLaneInfo>& followers = next->
getIncomingLanes();
2861 for (std::vector<MSLane::IncomingLaneInfo>::const_iterator j = followers.begin(); j != followers.end(); ++j) {
2862 if (visited.find((*j).lane) == visited.end() && ((*j).viaLink->havePriority() || !ignoreMinorLinks)) {
2863 visited.insert((*j).lane);
2865 ili.
lane = (*j).lane;
2866 ili.
length = (*j).length + (*it).length;
2868 newFound.push_back(ili);
2874 swap(newFound, toExamine);
2899 const MSLane* nextLane =
this;
2905 MSLinkCont::const_iterator link =
succLinkSec(*ego, view, *nextLane, bestLaneConts);
2912 if (linkLeaders.size() > 0) {
2918 #ifdef DEBUG_CONTEXT 2920 std::cout <<
" linkleader=" << veh->
getID() <<
" gap=" << ll.
vehAndGap.second <<
"\n";
2928 bool nextInternal = (*link)->getViaLane() != 0;
2929 nextLane = (*link)->getViaLaneOrLane();
2930 if (nextLane == 0) {
2935 #ifdef DEBUG_CONTEXT 2937 std::cout <<
SIMTIME <<
" getLeadersOnConsecutive lane=" <<
getID() <<
" nextLane=" << nextLane->
getID() <<
" leaders=" << leaders.
toString() <<
"\n";
2942 for (
int i = 0; i < iMax; ++i) {
2945 #ifdef DEBUG_CONTEXT 2965 if (!nextInternal) {
2980 #ifdef DEBUG_CONTEXT 2982 std::cout <<
SIMTIME <<
" getPartialBehind lane=" <<
getID() <<
" ego=" << ego->
getID() <<
" found=" << veh->
getID() <<
"\n";
2988 #ifdef DEBUG_CONTEXT 3023 if (opposite == 0) {
3025 throw ProcessError(
"Lane '" +
getID() +
"' cannot compute oppositePos as there is no opposite lane.");
3032 std::pair<MSVehicle* const, double>
3037 #ifdef DEBUG_CONTEXT 3039 std::cout <<
" getFollower lane=" <<
getID() <<
" egoPos=" << egoPos <<
" pred=" << pred->
getID() <<
" predPos=" << pred->
getPositionOnLane(
this) <<
"\n";
3048 return std::make_pair(const_cast<MSVehicle*>(result.first), result.second);
3051 std::pair<MSVehicle* const, double>
3053 #ifdef DEBUG_OPPOSITE 3055 <<
" ego=" << ego->
getID()
3059 <<
" oppositeDir=" << oppositeDir
3067 std::pair<MSVehicle* const, double> result =
getFollower(ego, egoPos + egoLength, dist,
true);
3074 std::pair<MSVehicle* const, double>
3076 #ifdef DEBUG_OPPOSITE 3078 <<
" ego=" << ego->
getID()
3088 if (result.second > 0) {
3090 return std::make_pair(static_cast<MSVehicle*>(0), -1);
3100 const std::string action = oc.
getString(
"collision.action");
3101 if (action ==
"none") {
3103 }
else if (action ==
"warn") {
3105 }
else if (action ==
"teleport") {
3107 }
else if (action ==
"remove") {
3110 WRITE_ERROR(
"Invalid collision.action '" + action +
"'.");
3148 #ifdef DEBUG_INSERTION 3150 std::cout <<
SIMTIME <<
" check for pedestrians on lane=" <<
getID() <<
" pos=" << pos <<
"\n";
3155 if (leader.first != 0) {
3158 if (gap < 0 ||
checkFailure(aVehicle, speed, dist, stopSpeed, patchSpeed,
"")) {
3160 #ifdef DEBUG_INSERTION 3162 <<
" isInsertionSuccess lane=" <<
getID()
3163 <<
" veh=" << aVehicle->
getID()
3166 <<
" patchSpeed=" << patchSpeed
3167 <<
" speed=" << speed
3168 <<
" stopSpeed=" << stopSpeed
3169 <<
" pedestrianLeader=" << leader.first->getID()
3170 <<
" failed (@796)!\n";
void detectPedestrianJunctionCollision(const MSVehicle *collider, const PositionVector &colliderBoundary, const MSLane *foeLane, SUMOTime timestep, const std::string &stage)
detect whether a vehicle collids with pedestrians on the junction
const std::vector< IncomingLaneInfo > & getIncomingLanes() const
bool gDebugFlag1
global utility flags for debugging
std::pair< MSVehicle *const, double > getFollower(const MSVehicle *ego, double egoPos, double dist, bool ignoreMinorLinks) const
Find follower vehicle for the given ego vehicle (which may be on the opposite direction lane) ...
bool isChangingLanes() const
return true if the vehicle currently performs a lane change maneuver
double getBruttoOccupancy() const
Returns the brutto (including minGaps) occupancy of this lane during the last step.
double getLengthWithGap() const
Get vehicle's length including the minimum gap [m].
void loadState(std::vector< std::string > &vehIDs, MSVehicleControl &vc)
Loads the state of this segment with the given parameters.
static double gLateralResolution
OutputDevice & writeAttr(const SumoXMLAttr attr, const T &val)
writes a named attribute
SVCPermissions myPermissions
The vClass permissions for this lane.
MSLane * getLogicalPredecessorLane() const
get the most likely precedecessor lane (sorted using by_connections_to_sorter). The result is cached ...
double ymin() const
Returns minimum y-coordinate.
VehCont myVehicles
The lane's vehicles. This container holds all vehicles that have their front (longitudinally) and the...
double getVehicleMaxSpeed(const SUMOVehicle *const veh) const
Returns the lane's maximum speed, given a vehicle's speed limit adaptation.
double brakeGap(const double speed) const
Returns the distance the vehicle needs to halt including driver's reaction time tau (i...
saves leader/follower vehicles and their distances relative to an ego vehicle
virtual double freeSpeed(const MSVehicle *const veh, double speed, double seen, double maxSpeed, const bool onInsertion=false) const
Computes the vehicle's safe speed without a leader.
double xmax() const
Returns maximum x-coordinate.
double getNOxEmissions() const
Returns the sum of last step NOx emissions.
MSEdge & getEdge() const
Returns the lane's edge.
A free lateral position is chosen.
Representation of a vehicle in the micro simulation.
MSVehicle * getFirstFullVehicle() const
returns the first vehicle for which this lane is responsible or 0
void resetPermissions(long transientID)
At the leftmost side of the lane.
virtual int addLeader(const MSVehicle *veh, bool beyond, double latOffset=0)
MSLane(const std::string &id, double maxSpeed, double length, MSEdge *const edge, int numericalID, const PositionVector &shape, double width, SVCPermissions permissions, int index, bool isRampAccel)
Constructor.
int getPriority() const
Returns the priority of the edge.
PositionVector getBoundingPoly() const
get bounding polygon
int operator()(MSVehicle *v1, MSVehicle *v2) const
Comparing operator.
void sortManeuverReservations()
sorts myManeuverReservations
SUMOTime getWaitingTime() const
Returns the SUMOTime waited (speed was lesser than 0.1m/s)
const MSEdge * getNextNormal() const
Returns the lane's follower if it is an internal lane, the edge of the lane otherwise.
std::string containerstop
(Optional) container stop if one is assigned to the stop
static void insertIDs(std::vector< std::string > &into)
Adds the ids of all stored lanes into the given vector.
void enterLaneAtInsertion(MSLane *enteredLane, double pos, double speed, double posLat, MSMoveReminder::Notification notification)
Update when the vehicle enters a new lane in the emit step.
void updateLeaderInfo(const MSVehicle *veh, VehCont::reverse_iterator &vehPart, VehCont::reverse_iterator &vehRes, MSLeaderInfo &ahead) const
This updates the MSLeaderInfo argument with respect to the given MSVehicle. All leader-vehicles on th...
Sorts lanes (IncomingLaneInfos) by their priority or, if this doesn't apply, wrt. the angle differenc...
MSLane * parallelLane(const MSLane *const lane, int offset) const
Returns the lane with the given offset parallel to the given lane one or 0 if it does not exist...
virtual bool hasPedestrians(const MSLane *lane)
whether the given lane has pedestrians on it
virtual void removeParking(MSVehicle *veh)
remove parking vehicle. This must be syncrhonized when running with GUI
std::pair< MSVehicle *const, double > getOppositeLeader(const MSVehicle *ego, double dist, bool oppositeDir) const
bool parking
whether the vehicle is removed from the net while stopping
MSLane * getLane() const
Returns the connected lane.
double getMaxSpeedFactor() const
return the maximum speed factor for all vehicles that ever entered the network
begin/end of the description of a single lane
bool hasDeparted() const
Returns whether this vehicle has already departed.
bool checkFailure(const MSVehicle *aVehicle, double &speed, double &dist, const double nspeed, const bool patchSpeed, const std::string errorMsg) const
int myI2
index for myPartialVehicles
bool resumeFromStopping()
MSLane * getLane() const
Returns the lane the vehicle is on.
double getFuelConsumption() const
Returns the sum of last step fuel consumption.
SUMOTime duration
The stopping duration.
bool isInsertionSuccess(MSVehicle *vehicle, double speed, double pos, double posLat, bool recheckNextLanes, MSMoveReminder::Notification notification)
Tries to insert the given vehicle with the given state (speed and pos)
void registerTeleportYield()
register one non-collision-related teleport
static void fill(RTREE &into)
Fills the given RTree with lane instances.
double getMaximumBrakeDist() const
compute maximum braking distance on this lane
The vehicle arrived at a junction.
void setMaxSpeed(double val)
Sets a new maximum speed for the lane (used by TraCI and MSCalibrator)
const SUMOVehicleParameter::Stop pars
The stop parameter.
void recalcCache()
Recalculates the cached values.
This is an uncontrolled, minor link, has to stop.
const MSEdgeVector & getPredecessors() const
std::vector< IncomingLaneInfo > myIncomingLanes
All direct predecessor lanes.
The car-following model abstraction.
int SVCPermissions
bitset where each bit declares whether a certain SVC may use this edge/lane
int myI2End
end index for myPartialVehicles
double getPositionOnLane() const
Get the vehicle's position along the lane.
void addLink(MSLink *link)
Delayed initialization.
MSLane * myCanonicalPredecessorLane
Similar to LogicalPredecessorLane,.
int myIndex
The lane index.
static double rand(std::mt19937 *rng=0)
Returns a random real number in [0, 1)
virtual bool integrateNewVehicle(SUMOTime t)
Insert buffered vehicle into the real lane.
The lateral position is chosen randomly.
const SUMOVehicleParameter & getParameter() const
Returns the vehicle's parameter (including departure definition)
static double myCollisionMinGapFactor
SUMOTime myLeaderInfoTime
time step for which myLeaderInfo was last updated
If a fixed number of random choices fails, a free lateral position is chosen.
SUMOVehicle * getVehicle(const std::string &id) const
Returns the vehicle with the given id.
bool operator()(const MSVehicle *cmp, double pos) const
compares vehicle position to the detector position
AnyVehicleIterator is a structure, which manages the iteration through all vehicles on the lane...
static SUMOTime myCollisionStopTime
Notification
Definition of a vehicle state.
virtual void resetManeuverReservation(MSVehicle *v)
Unregisters a vehicle, which previously registered for maneuvering into this lane.
std::string time2string(SUMOTime t)
std::vector< const MSLane * > getOutgoingLanes() const
get the list of outgoing lanes
A RT-tree for efficient storing of SUMO's Named objects.
virtual MSVehicle * removeVehicle(MSVehicle *remVehicle, MSMoveReminder::Notification notification, bool notify=true)
double myBruttoVehicleLengthSum
The current length of all vehicles on this lane, including their minGaps.
MSVehicle * getFirstAnyVehicle() const
returns the first vehicle that is fully or partially on this lane
const std::vector< MSLane * > * allowedLanes(const MSEdge &destination, SUMOVehicleClass vclass=SVC_IGNORING) const
Get the allowed lanes to reach the destination-edge.
const MSEdge *const myEdge
void addIncomingLane(MSLane *lane, MSLink *viaLink)
static MSNet * getInstance()
Returns the pointer to the unique instance of MSNet (singleton).
double getPMxEmissions() const
Returns the sum of last step PMx emissions.
by_connections_to_sorter(const MSEdge *const e)
constructor
double getLength() const
Returns the lane's length.
virtual const VehCont & getVehiclesSecure() const
Returns the vehicles container; locks it for microsimulation.
const PositionVector & getShape() const
Returns this lane's shape.
static std::string getIDSecure(const T *obj, const std::string &fallBack="NULL")
get an identifier for Named-like object which may be Null
The speed is chosen randomly.
PositionVector getBoundingBox() const
get bounding rectangle
bool isLinkEnd(MSLinkCont::const_iterator &i) const
static void initCollisionOptions(const OptionsCont &oc)
virtual void addMoveReminder(MSMoveReminder *rem)
Add a move-reminder to move-reminder container.
const MSRoute & getRoute() const
Returns the current route.
MSLink * getLinkTo(const MSLane *) const
returns the link to the given lane or 0, if it is not connected
The vehicle got vaporized.
void leftByLaneChange(MSVehicle *v)
SUMOTime until
The time at which the vehicle may continue its journey.
bool addStop(const SUMOVehicleParameter::Stop &stopPar, std::string &errorMsg, SUMOTime untilOffset=0, bool collision=false, MSRouteIterator *searchStart=0)
Adds a stop.
double getRightSideOnLane() const
Get the vehicle's lateral position on the lane:
const MSEdge * getLastEdge() const
returns the destination edge
MSLane * getCanonicalPredecessorLane() const
This is an uncontrolled, right-before-left link.
std::map< long, SVCPermissions > myPermissionChanges
bool executeMove()
Executes planned vehicle movements with regards to right-of-way.
double getSafeFollowSpeed(const std::pair< const MSVehicle *, double > leaderInfo, const double seen, const MSLane *const lane, double distToCrossing) const
compute safe speed for following the given leader
void addNeigh(const std::string &id)
Adds a neighbor to this lane.
bool getBool(const std::string &name) const
Returns the boolean-value of the named option (only for Option_Bool)
ArrivalSpeedDefinition arrivalSpeedProcedure
Information how the vehicle's end speed shall be chosen.
const std::string & getID() const
Returns the id.
const SVCPermissions SVCAll
all VClasses are allowed
void gotActive(MSLane *l)
Informs the control that the given lane got active.
virtual double insertionStopSpeed(const MSVehicle *const veh, double speed, double gap) const
Computes the vehicle's safe speed for approaching an obstacle at insertion without constraints due to...
virtual double setPartialOccupation(MSVehicle *v)
Sets the information about a vehicle lapping into this lane.
VehCont myPartialVehicles
The lane's partial vehicles. This container holds all vehicles that are partially on this lane but wh...
std::vector< MSTransportable * > getSortedPersons(SUMOTime timestep, bool includeRiding=false) const
Returns this edge's persons sorted by pos.
The position is chosen randomly.
static bool myCheckJunctionCollisions
This is an uncontrolled, all-way stop link.
virtual void setManeuverReservation(MSVehicle *v)
Registers the lane change intentions (towards this lane) for the given vehicle.
double getWidth() const
Returns the lane's width.
int myI1End
end index for myVehicles
bool hasArrived() const
Returns whether this vehicle has already arived (reached the arrivalPosition on its final edge) ...
A class that stores a 2D geometrical boundary.
virtual double insertionFollowSpeed(const MSVehicle *const veh, double speed, double gap2pred, double predSpeed, double predMaxDecel) const
Computes the vehicle's safe speed (no dawdling) This method is used during the insertion stage...
int myDirection
index delta
std::string parkingarea
(Optional) parking area if one is assigned to the stop
PositionVector myShape
The shape of the lane.
#define WRITE_WARNING(msg)
MSLane * getCanonicalSuccessorLane() const
std::set< const MSVehicle * > myParkingVehicles
void getLeadersOnConsecutive(double dist, double seen, double speed, const MSVehicle *ego, const std::vector< MSLane *> &bestLaneConts, MSLeaderDistanceInfo &result) const
Returns the immediate leaders and the distance to them (as getLeaderOnConsecutive but for the sublane...
bool myDownstream
iteration direction
MSAbstractLaneChangeModel & getLaneChangeModel()
bool isVaporizing() const
Returns whether vehicles on this edge shall be vaporized.
bool isFrontOnLane(const MSLane *lane) const
Returns the information whether the front of the vehicle is on the given lane.
std::vector< std::string > myNeighs
LinkState getState() const
Returns the current state of the link.
static CollisionAction myCollisionAction
the action to take on collisions
const std::string & getEdgeType() const
Returns the type of the edge.
std::map< std::string, MSLane *> DictType
definition of the static dictionary type
static CollisionAction getCollisionAction()
virtual void detectCollisions(SUMOTime timestep, const std::string &stage)
Check if vehicles are too close.
static DictType myDict
Static dictionary to associate string-ids with objects.
Sorts lanes (their origin link) by the priority of their noninternal target edges or...
std::string busstop
(Optional) bus stop if one is assigned to the stop
void addApproachingLane(MSLane *lane, bool warnMultiCon)
double departSpeed
(optional) The initial speed of the vehicle
virtual const MSEdge * succEdge(int nSuccs) const =0
Returns the nSuccs'th successor of edge the vehicle is currently at.
A road/street connecting two junctions.
void leaveLane(const MSMoveReminder::Notification reason, const MSLane *approachedLane=0)
Update of members if vehicle leaves a new lane in the lane change step or at arrival.
virtual int addLeader(const MSVehicle *veh, double gap, double latOffset=0, int sublane=-1)
double getLatOffset(const MSLane *lane) const
Get the offset that that must be added to interpret myState.myPosLat for the given lane...
bool insertVehicle(MSVehicle &v)
Tries to insert the given vehicle.
const MSCFModel & getCarFollowModel() const
Returns the vehicle's car following model definition.
double myLength
Lane length [m].
DepartSpeedDefinition departSpeedProcedure
Information how the vehicle's initial speed shall be chosen.
VehCont myTmpVehicles
Container for lane-changing vehicles. After completion of lane-change- process, the containers will b...
int operator()(const IncomingLaneInfo &lane1, const IncomingLaneInfo &lane2) const
comparing operator
MSLink * getEntryLink() const
Returns the entry link if this is an internal lane, else 0.
const MSVehicle * operator*()
std::string toString(const T &t, std::streamsize accuracy=gPrecision)
int getCrossingIndex() const
return the index of the link to the next crossing if this is walkingArea, else -1 ...
virtual void resetPartialOccupation(MSVehicle *v)
Removes the information about a vehicle lapping into this lane.
double getCO2Emissions() const
Returns the sum of last step CO2 emissions.
const bool myIsRampAccel
whether this lane is an acceleration lane
Representation of a vehicle.
double startPos
The stopping position start.
DepartPosDefinition departPosProcedure
Information how the vehicle shall choose the departure position.
int operator()(const std::pair< const MSVehicle *, double > &p1, const std::pair< const MSVehicle *, double > &p2) const
void setLength(double val)
Sets a new length for the lane (used by TraCI only)
static MSPModel * getModel()
This is an uncontrolled, minor link, has to brake.
double basePos(const MSVehicle &veh) const
departure position where the vehicle fits fully onto the lane (if possible)
Sorts vehicles by their position (descending)
double myRightSideOnEdge
the combined width of all lanes with lower index on myEdge
std::string chargingStation
(Optional) charging station if one is assigned to the stop
bool lastInsertion(MSVehicle &veh, double mspeed, double posLat, bool patchSpeed)
inserts vehicle as close as possible to the last vehicle on this lane (or at the end of the lane if t...
SVCPermissions myOriginalPermissions
The original vClass permissions for this lane (before temporary modifications)
outgoing_lane_priority_sorter(const MSLane *sourceLane)
constructor
void updateBestLanes(bool forceRebuild=false, const MSLane *startLane=0)
computes the best lanes to use in order to continue the route
void enteredByLaneChange(MSVehicle *v)
const std::vector< MSLane * > & getBestLanesContinuation() const
Returns the best sequence of lanes to continue the route starting at myLane.
const MSLeaderInfo & getLastVehicleInformation(const MSVehicle *ego, double latOffset, double minPos=0, bool allowCached=true) const
Returns the last vehicles on the lane.
MSVehicleControl & getVehicleControl()
Returns the vehicle control.
const std::set< MSTransportable * > & getPersons() const
Returns this edge's persons set.
double getCenterOnEdge(const MSLane *lane=0) const
Get the vehicle's lateral position on the edge of the given lane (or its current edge if lane == 0) ...
double getMinDeceleration() const
return the minimum deceleration capability for all vehicles that ever entered the network ...
const std::map< SUMOVehicleClass, double > * myRestrictions
The vClass speed restrictions for this lane.
bool triggered
whether an arriving person lets the vehicle continue
std::pair< MSVehicle *const, double > getOppositeFollower(const MSVehicle *ego) const
bool checkForPedestrians(const MSVehicle *aVehicle, double &speed, double &dist, double pos, bool patchSpeed) const
check whether pedestrians on this lane interfere with vehicle insertion
std::string getString(const std::string &name) const
Returns the string-value of the named option (only for Option_String)
ConstMSEdgeVector::const_iterator MSRouteIterator
The vehicle arrived at its destination (is deleted)
double safeInsertionSpeed(const MSVehicle *veh, double seen, const MSLeaderInfo &leaders, double speed)
return the maximum safe speed for insertion behind leaders (a negative value indicates that safe inse...
double getSpeedLimit() const
Returns the lane's maximum allowed speed.
const std::map< SUMOVehicleClass, double > * getRestrictions(const std::string &id) const
Returns the restrictions for an edge type If no restrictions are present, 0 is returned.
bool hasStops() const
Returns whether the vehicle has to stop somewhere.
LinkState
The right-of-way state of a link between two lanes used when constructing a NBTrafficLightLogic, in MSLink and GNEInternalLane.
int operator()(const MSLink *link1, const MSLink *link2) const
comparing operator
Sorts edges by their angle relative to the given edge (straight comes first)
The maximum speed is used.
std::string toString() const
print a debugging representation
void forceVehicleInsertion(MSVehicle *veh, double pos, MSMoveReminder::Notification notification, double posLat=0)
Inserts the given vehicle at the given position.
SUMOTime getCurrentTimeStep() const
Returns the current simulation step.
SUMOTime string2time(const std::string &r)
MSVehicle * getPartialBehind(const MSVehicle *ego) const
double xmin() const
Returns minimum x-coordinate.
AnyVehicleIterator anyVehiclesEnd() const
end iterator for iterating over all vehicles touching this lane in downstream direction ...
void add(const SUMOTime t, MSVehicle *veh)
Adds a vehicle to this transfer object.
AnyVehicleIterator anyVehiclesBegin() const
begin iterator for iterating over all vehicles touching this lane in downstream direction ...
std::vector< LinkLeader > LinkLeaders
LinkState getIncomingLinkState() const
get the state of the link from the logical predecessor to this lane
double getImpatience() const
Returns this vehicles impatience.
No information given; use default.
virtual bool executeMovements(SUMOTime t, std::vector< MSLane *> &lanesWithVehiclesToIntegrate)
Executes planned vehicle movements with regards to right-of-way.
std::pair< MSVehicle *const, double > getLeader(const MSVehicle *veh, const double vehPos, const std::vector< MSLane *> &bestLaneConts, double dist=-1, bool checkTmpVehicles=false) const
Returns the immediate leader of veh and the distance to veh starting on this lane.
void onRemovalFromNet(const MSMoveReminder::Notification reason)
Called when the vehicle is removed from the network.
std::pair< MSVehicle *, double > vehAndGap
virtual PersonDist nextBlocking(const MSLane *lane, double minPos, double minRight, double maxLeft, double stopTime=0)
returns the next pedestrian beyond minPos that is laterally between minRight and maxLeft or 0 ...
Boundary & grow(double by)
extends the boundary by the given amount
bool hasInfluencer() const
int myRightmostSublane
the index of the rightmost sublane of this lane on myEdge
MSLane * myLogicalPredecessorLane
double endPos
The stopping position end.
double getMinGap() const
Get the free space in front of vehicles of this class.
SUMOTime collisionStopTime() const
Returns the remaining time a vehicle needs to stop due to a collision. A negative value indicates tha...
Something on a lane to be noticed about vehicle movement.
double getMaxDecel() const
Get the vehicle type's maximal comfortable deceleration [m/s^2].
MSLane * getOpposite() const
return the opposite direction lane for lane changing or 0
bool overlapsWith(const AbstractPoly &poly, double offset=0) const
Returns the information whether the given polygon overlaps with this.
AnyVehicleIterator anyVehiclesUpstreamBegin() const
begin iterator for iterating over all vehicles touching this lane in upstream direction ...
virtual void swapAfterLaneChange(SUMOTime t)
moves myTmpVehicles int myVehicles after a lane change procedure
bool isInternal() const
return whether this edge is an internal edge
void registerTeleportJam()
register one non-collision-related teleport
double getHCEmissions() const
Returns the sum of last step HC emissions.
If a fixed number of random choices fails, a free position is chosen.
std::map< MSEdge *, std::vector< MSLane * > > myApproachingLanes
All direct internal and direct (disregarding internal predecessors) non-internal predecessor lanes of...
double getFloat(const std::string &name) const
Returns the double-value of the named option (only for Option_Float)
std::vector< MSVehicle * > VehCont
Container for vehicles.
const MSLane * lane
The lane to stop at.
bool containerTriggered
whether an arriving container lets the vehicle continue
static MSLinkCont::const_iterator succLinkSec(const SUMOVehicle &veh, int nRouteSuccs, const MSLane &succLinkSource, const std::vector< MSLane *> &conts)
int operator()(const MSEdge *const e1, const MSEdge *const e2) const
comparing operator
Base class for objects which have an id.
int myNumericalID
Unique numerical ID (set on reading by netload)
std::vector< MSMoveReminder *> myMoveReminders
This lane's move reminder.
VehCont myManeuverReservations
The vehicles which registered maneuvering into the lane within their current action step...
const MSLane *const myLane
double getLateralPositionOnLane() const
Get the vehicle's lateral position on the lane.
double getRightSideOnEdge() const
incoming_lane_priority_sorter(const MSLane *targetLane)
constructor
MSLeaderInfo getPartialBeyond() const
get all vehicles that are inlapping from consecutive edges
std::string lane
The lane to stop at.
void initRestrictions()
initialized vClass-specific speed limits
AnyVehicleIterator & operator++()
static MSVehicleTransfer * getInstance()
Returns the instance of this object.
double departPosLat
(optional) The lateral position the vehicle shall depart from
std::pair< const MSPerson *, double > PersonDist
MSVehicle * getLastFullVehicle() const
returns the last vehicle for which this lane is responsible or 0
void sortPartialVehicles()
sorts myPartialVehicles
double getWidth() const
Get the width which vehicles of this class shall have when being drawn.
void setPermissions(SVCPermissions permissions, long transientID)
Sets the permissions to the given value. If a transientID is given, the permissions are recored as te...
bool freeInsertion(MSVehicle &veh, double speed, double posLat, MSMoveReminder::Notification notification=MSMoveReminder::NOTIFICATION_DEPARTED)
Tries to insert the given vehicle on any place.
virtual std::string toString() const
print a debugging representation
double getElectricityConsumption() const
Returns the sum of last step electricity consumption.
double departPos
(optional) The position the vehicle shall depart from
static bool dictionary(const std::string &id, MSLane *lane)
Static (sic!) container methods {.
static SUMOTime gTimeToGridlockHighways
std::pair< const MSVehicle *, double > CLeaderDist
int addFollower(const MSVehicle *veh, const MSVehicle *ego, double gap, double latOffset=0, int sublane=-1)
std::string myID
The name of the object.
const std::vector< MSLink * > & getFoeLinks() const
The vehicle has departed (was inserted into the network)
Influencer & getInfluencer()
Returns the velocity/lane influencer.
void scheduleVehicleRemoval(SUMOVehicle *veh)
Removes a vehicle after it has ended.
double getCOEmissions() const
Returns the sum of last step CO emissions.
Structure representing possible vehicle parameter.
std::pair< MSVehicle *const, double > getLeaderOnConsecutive(double dist, double seen, double speed, const MSVehicle &veh, const std::vector< MSLane *> &bestLaneConts) const
Returns the immediate leader and the distance to him.
int myI1
index for myVehicles
double getOppositePos(double pos) const
return the corresponding position on the opposite lane
const MSVehicleType & getVehicleType() const
Returns the vehicle's type definition.
double processNextStop(double currentVelocity)
Processes stops, returns the velocity needed to reach the stop.
void setTentativeLaneAndPosition(MSLane *lane, double pos, double posLat=0)
set tentative lane and position during insertion to ensure that all cfmodels work (some of them requi...
static MSLink * getConnectingLink(const MSLane &from, const MSLane &to)
Returns the link connecting both lanes Both lanes have to be non-internal; 0 may be returned if no co...
MSInsertionControl & getInsertionControl()
Returns the insertion control.
static void clear()
Clears the dictionary.
const MSLane * getFirstInternalInConnection(double &offset) const
Returns 0 if the lane is not internal. Otherwise the first part of the connection (sequence of intern...
bool nextIsMyVehicles() const
MSEdge *const myEdge
The lane's edge, for routing only.
Definition of vehicle stop (position and duration)
At the rightmost side of the lane.
bool detectCollisionBetween(SUMOTime timestep, const std::string &stage, MSVehicle *collider, MSVehicle *victim, std::set< const MSVehicle *, ComparatorIdLess > &toRemove, std::set< const MSVehicle *> &toTeleport) const
detect whether there is a collision between the two vehicles
At the center of the lane.
const MSLane * myLane
the lane that is being iterated
A storage for options typed value containers)
double angleAt2D(int pos) const
get angle in certain position of position vector
int index
at which position in the stops list
MSVehicle * getLastAnyVehicle() const
returns the last vehicle that is fully or partially on this lane
bool isApproachedFrom(MSEdge *const edge)
double getHarmonoise_NoiseEmissions() const
Returns the sum of last step noise emissions.
const MSEdgeVector & getSuccessors() const
Returns the following edges.
std::pair< MSVehicle *const, double > getCriticalLeader(double dist, double seen, double speed, const MSVehicle &veh) const
Returns the most dangerous leader and the distance to him.
static SUMOTime gTimeToGridlock
double getLength() const
Get vehicle's length [m].
AnyVehicleIterator anyVehiclesUpstreamEnd() const
end iterator for iterating over all vehicles touching this lane in upstream direction ...
const MSLeaderInfo & getFirstVehicleInformation(const MSVehicle *ego, double latOffset, bool onlyFrontOnLane, double maxPos=std::numeric_limits< double >::max(), bool allowCached=true) const
analogue to getLastVehicleInformation but in the upstream direction
const MSEdge * succEdge(int nSuccs) const
Returns the nSuccs'th successor of edge the vehicle is currently at.
const double SUMO_const_haltingSpeed
the speed threshold at which vehicles are considered as halting
int operator()(MSVehicle *v1, MSVehicle *v2) const
Comparing operator.
bool isRemoteAffected(SUMOTime t) const
void saveState(OutputDevice &out)
Saves the state of this lane into the given stream.
MSLeaderInfo myLeaderInfo
leaders on all sublanes as seen by approaching vehicles (cached)
const MSLane *const myLane
double getBackPositionOnLane(const MSLane *lane) const
Get the vehicle's position relative to the given lane.
MSLane * myCanonicalSuccessorLane
Main successor lane,.
Static storage of an output device and its base (abstract) implementation.
bool closeTag()
Closes the most recently opened tag.
void registerCollision()
registers one collision-related teleport
MSEdgeControl & getEdgeControl()
Returns the edge control.
Boundary getBoxBoundary() const
Returns a boundary enclosing this list of lines.
double myNettoVehicleLengthSum
The current length of all vehicles on this lane, excluding their minGaps.
double getMeanSpeed() const
Returns the mean speed on this lane.
MSLeaderInfo myFollowerInfo
followers on all sublanes as seen by vehicles on consecutive lanes (cached)
double arrivalSpeed
(optional) The final speed of the vehicle (not used yet)
virtual ~MSLane()
Destructor.
MSLane * getShadowLane() const
Returns the lane the vehicle's shadow is on during continuous/sublane lane change.
MSRouteIterator begin() const
Returns the begin of the list of edges to pass.
void addParking(MSVehicle *veh)
add parking vehicle. This should only used during state loading
int numFreeSublanes() const
bool isStopped() const
Returns whether the vehicle is at a stop.
double getSecureGap(const double speed, const double leaderSpeed, const double leaderMaxDecel) const
Returns the minimum gap to reserve if the leader is braking at maximum (>=0)
No information given; use default.
A free position is chosen.
The class responsible for building and deletion of vehicles.
double getMissingRearGap(const MSVehicle *leader, double backOffset, double leaderSpeed) const
return by how much further the leader must be inserted to avoid rear end collisions ...
const double myLengthGeometryFactor
precomputed myShape.length / myLength
std::vector< MSEdge * > MSEdgeVector
MSLeaderInfo myLeaderInfoTmp
Insert behind the last vehicle as close as possible to still allow the specified departSpeed. Fallback to DEPART_POS_BASE if there is no vehicle on the departLane yet.
const MSLinkCont & getLinkCont() const
returns the container with all links !!!
double getRightSideOnEdge(const MSLane *lane=0) const
Get the vehicle's lateral position on the edge of the given lane (or its current edge if lane == 0) ...
const std::vector< LaneQ > & getBestLanes() const
Returns the description of best lanes to use in order to continue the route.
VehCont myVehBuffer
Buffer for vehicles that moved from their previous lane onto this one. Integrated after all vehicles ...
static double angleDiff(const double angle1, const double angle2)
Returns the difference of the second angle to the first angle in radiants.
bool isParking() const
Returns whether the vehicle is parking.
double getDepartPosLat(const MSVehicle &veh)
double getSpeed() const
Returns the vehicle's current speed.
static const long CHANGE_PERMISSIONS_PERMANENT
MSLeaderDistanceInfo getFollowersOnConsecutive(const MSVehicle *ego, double backOffset, bool allSublanes, double searchDist=-1, bool ignoreMinorLinks=false) const
return the sublane followers with the largest missing rear gap among all predecessor lanes (within di...
double ymax() const
Returns maximum y-coordinate.
SUMOTime myFollowerInfoTime
time step for which myFollowerInfo was last updated
virtual void releaseVehicles() const
Allows to use the container for microsimulation again.
void handleCollisionBetween(SUMOTime timestep, const std::string &stage, MSVehicle *collider, MSVehicle *victim, double gap, double latGap, std::set< const MSVehicle *, ComparatorIdLess > &toRemove, std::set< const MSVehicle *> &toTeleport) const
take action upon collision
static SUMOTime gLaneChangeDuration
double myMaxSpeed
Lane-wide speedlimit [m/s].
double getNettoOccupancy() const
Returns the netto (excluding minGaps) occupancy of this lane during the last step (including minGaps)...
static double sum(double val)
Computes the resulting noise.
const std::string & getID() const
Returns the name of the vehicle.
void registerTeleportWrongLane()
register one non-collision-related teleport
Representation of a lane in the micro simulation.
double getWaitingSeconds() const
Returns the overall waiting time on this lane.
virtual const std::string & getID() const =0
Get the vehicle's ID.
void descheduleDeparture(const SUMOVehicle *veh)
stops trying to emit the given vehicle (and delete it)
const double myWidth
Lane width [m].
OutputDevice & openTag(const std::string &xmlElement)
Opens an XML tag.
virtual double stopSpeed(const MSVehicle *const veh, const double speed, double gap) const =0
Computes the vehicle's safe speed for approaching a non-moving obstacle (no dawdling) ...
SUMOVehicleClass getVehicleClass() const
Get this vehicle type's vehicle class.
virtual void incorporateVehicle(MSVehicle *veh, double pos, double speed, double posLat, const MSLane::VehCont::iterator &at, MSMoveReminder::Notification notification=MSMoveReminder::NOTIFICATION_DEPARTED)
Inserts the vehicle into this lane, and informs it about entering the network.
virtual bool appropriate(const MSVehicle *veh)
The vehicle is being teleported.
virtual void planMovements(const SUMOTime t)
Compute safe velocities for all vehicles based on positions and speeds from the last time step...
MSLane * getParallelLane(int offset) const
Returns the lane with the given offset parallel to this one or 0 if it does not exist.
Definition of vehicle stop (position and duration)
virtual const MSVehicleType & getVehicleType() const =0
Returns the vehicle's type.
double getDepartSpeed(const MSVehicle &veh, bool &patchSpeed)
DepartPosLatDefinition departPosLatProcedure
Information how the vehicle shall choose the lateral departure position.