void
MSVehicleTransfer::checkInsertions(SUMOTime time) {
// go through vehicles
for (VehicleInfVector::iterator i = myVehicles.begin(); i != myVehicles.end();) {
// get the vehicle information
VehicleInformation& desc = *i;
if (desc.myParking) {
// handle parking vehicles
if (desc.myVeh->processNextStop(1) == 0) {
++i;
continue;
}
// parking finished, head back into traffic
}
const SUMOVehicleClass vclass = desc.myVeh->getVehicleType().getVehicleClass();
const MSEdge* e = desc.myVeh->getEdge();
const MSEdge* nextEdge = desc.myVeh->succEdge(1);
// get the lane on which this vehicle should continue
// first select all the lanes which allow continuation onto nextEdge
// then pick the one which is least occupied
// @todo maybe parking vehicles should always continue on the rightmost lane?
const MSLane* oldLane = desc.myVeh->getLane();
MSLane* l = (nextEdge != 0 ? e->getFreeLane(e->allowedLanes(*nextEdge, vclass), vclass) :
e->getFreeLane(0, vclass));
if (desc.myParking) {
// handle parking vehicles
if (l->isInsertionSuccess(desc.myVeh, 0, desc.myVeh->getPositionOnLane(), false, MSMoveReminder::NOTIFICATION_PARKING)) {
MSNet::getInstance()->informVehicleStateListener(desc.myVeh, MSNet::VEHICLE_STATE_ENDING_PARKING);
myParkingVehicles[oldLane].erase(desc.myVeh);
i = myVehicles.erase(i);
} else {
i++;
}
} else {
// handle teleporting vehicles, lane may be 0 because permissions were modified by a closing rerouter or TraCI
if (l != 0 && l->freeInsertion(*(desc.myVeh), MIN2(l->getSpeedLimit(), desc.myVeh->getMaxSpeed()), MSMoveReminder::NOTIFICATION_TELEPORT)) {
WRITE_WARNING("Vehicle '" + desc.myVeh->getID() + "' ends teleporting on edge '" + e->getID() + "', time " + time2string(MSNet::getInstance()->getCurrentTimeStep()) + ".");
MSNet::getInstance()->informVehicleStateListener(desc.myVeh, MSNet::VEHICLE_STATE_ENDING_TELEPORT);
i = myVehicles.erase(i);
} else {
// could not insert. maybe we should proceed in virtual space
if (desc.myProceedTime < time) {
if (desc.myVeh->succEdge(1) == 0) {
WRITE_WARNING("Vehicle '" + desc.myVeh->getID() + "' teleports beyond end of route ('" + e->getID() + "'), time " + time2string(MSNet::getInstance()->getCurrentTimeStep()) + ".");
desc.myVeh->leaveLane(MSMoveReminder::NOTIFICATION_TELEPORT_ARRIVED);
MSNet::getInstance()->getVehicleControl().scheduleVehicleRemoval(desc.myVeh);
i = myVehicles.erase(i);
continue;
}
// let the vehicle move to the next edge
desc.myVeh->leaveLane(MSMoveReminder::NOTIFICATION_TELEPORT);
// active move reminders (i.e. rerouters)
desc.myVeh->enterLaneAtMove(desc.myVeh->succEdge(1)->getLanes()[0], true);
// use current travel time to determine when to move the vehicle forward
desc.myProceedTime = time + TIME2STEPS(e->getCurrentTravelTime(TeleportMinSpeed));
}
++i;
}
}
}
}
