コード例 #1
0
 @Inject
 public LaneMoveHandler(
     HasArea environment,
     EnvironmentServiceProvider serviceProvider,
     EnvironmentSharedStateAccess sharedState,
     EventBus eb,
     @Named("params.nonStopMode") int nonStopMode)
     throws UnavailableServiceException {
   super(environment, serviceProvider, sharedState);
   this.eventBus = eb;
   eb.subscribe(this);
   this.roadEnvironmentService =
       serviceProvider.getEnvironmentService(RoadEnvironmentService.class);
   this.speedService = serviceProvider.getEnvironmentService(SpeedService.class);
   this.nonStopMode = nonStopMode;
 }
コード例 #2
0
  @Override
  public Input handle(Action action, UUID actor) throws ActionHandlingException {
    CellMove m = (CellMove) action;
    int prevSpeed = speedService.getAgentSpeed(actor);
    int maxSpeed = roadEnvironmentService.getMaxSpeed();
    int maxAccel = roadEnvironmentService.getMaxAccel();
    int maxDecel = roadEnvironmentService.getMaxDecel();

    // check move direction is positive or 0
    if (m.getY() < 0) {
      throw new ActionHandlingException("Cannot move backwards. Move was: " + m);
    }

    // check move is not too fast
    if (m.getY() > maxSpeed) {
      throw new ActionHandlingException(
          "Cannot move faster than the maximum speed (" + maxSpeed + "). Move was: " + m);
    }

    // check acceleration is not too fast
    if (m.getY() > prevSpeed) {
      if ((m.getY() - prevSpeed) > maxAccel) {
        throw new ActionHandlingException(
            "Cannot accelerate faster than the maximum acceleration ("
                + maxAccel
                + "). Move was: "
                + m
                + " and previous speed was "
                + prevSpeed);
      }
    }

    // check deceleration is not too fast
    if (m.getY() < prevSpeed) {
      if ((prevSpeed - m.getY()) > maxDecel) {
        throw new ActionHandlingException(
            "Cannot decelerate faster than the maximum deceleration ("
                + maxDecel
                + "). Move was: "
                + m
                + " and previous speed was "
                + prevSpeed);
      }
    }

    // check move sideways magnitude is 0 or 1
    if (Math.abs(m.getX()) > 1) {
      throw new ActionHandlingException(
          "Cannot change greater than one lane at once. Move was: " + m);
    }
    // cannot change lane without forward movement
    if (Math.abs(m.getX()) > 0 && (int) m.getY() == 0) {
      throw new ActionHandlingException("Cannot change lane while stationary");
    }

    RoadLocation start = (RoadLocation) getLocationService().getAgentLocation(actor);
    RoadLocation target = new RoadLocation(start.add(m));

    if (!target.in(environment.getArea())) {
      // check if it's a junction location
      if (target.getLane() == -1) {
        Integer exitPoint = null;
        Integer startOffset = MathsUtils.mod(start.getOffset(), roadEnvironmentService.getLength());
        Integer targetOffset =
            MathsUtils.mod(target.getOffset(), roadEnvironmentService.getLength());
        if (startOffset > targetOffset) {
          startOffset = startOffset - roadEnvironmentService.getLength();
        }
        for (int junction : roadEnvironmentService.getJunctionLocations()) {
          if ((startOffset <= junction) && (targetOffset >= junction)) {
            exitPoint = junction;
            logger.info("Agent " + actor + " left the road at " + exitPoint);
            eventBus.publish(new AgentLeftScenario(actor, exitPoint, SimTime.get()));
            // turning off means avoiding the possibility of crashing... ohwells: sliproads are
            // LOOOONG
            return null;
          }
        }
        logger.warn(
            "Agent "
                + actor
                + " tried to turn off using move "
                + m
                + " between "
                + start
                + " and "
                + target
                + " and offsets "
                + startOffset
                + ","
                + targetOffset
                + " but was not near a junction");
      }
      /*if ( (target.getLane()==-1) && (roadEnvironmentService.isJunctionOffset(target.getOffset())) ) {
      	// do stuff
      	logger.info("Agent " + actor + " left the road at " + target.getOffset());
      	eventBus.publish(new AgentLeftScenario(actor,target.getOffset(), SimTime.get()));
      	// turning off means avoiding the possibility of crashing... ohwells: sliproads are LOOOONG
      	return null;
      }
      else {*/
      try {
        final Move mNew = environment.getArea().getValidMove(start, m);
        target = new RoadLocation(start.add(mNew));
      } catch (EdgeException e) {
        throw new ActionHandlingException(e);
      }
      // }
    }
    this.getLocationService().setAgentLocation(actor, target);
    this.speedService.setAgentSpeed(actor, (int) m.getY());
    checks.add(new CollisionCheck(actor, start, target));

    logger.info(actor + " move: " + m);
    return null;
  }