package org.opentrafficsim.demo;
   
   import static org.opentrafficsim.core.gtu.GTUType.CAR;
   
   import java.awt.Dimension;
   import java.rmi.RemoteException;
   import java.util.LinkedHashSet;
   import java.util.Set;
   
  import javax.naming.NamingException;
  
  import org.djunits.unit.LengthUnit;
  import org.djunits.unit.TimeUnit;
  import org.djunits.unit.UNITS;
  import org.djunits.value.vdouble.scalar.Acceleration;
  import org.djunits.value.vdouble.scalar.Duration;
  import org.djunits.value.vdouble.scalar.Length;
  import org.djunits.value.vdouble.scalar.Speed;
  import org.djunits.value.vdouble.scalar.Time;
  import org.djutils.exceptions.Try;
  import org.opentrafficsim.base.parameters.ParameterException;
  import org.opentrafficsim.base.parameters.Parameters;
  import org.opentrafficsim.core.dsol.AbstractOTSModel;
  import org.opentrafficsim.core.dsol.OTSAnimator;
  import org.opentrafficsim.core.dsol.OTSSimulationException;
  import org.opentrafficsim.core.dsol.OTSSimulatorInterface;
  import org.opentrafficsim.core.geometry.OTSGeometryException;
  import org.opentrafficsim.core.geometry.OTSPoint3D;
  import org.opentrafficsim.core.gtu.GTUDirectionality;
  import org.opentrafficsim.core.gtu.GTUException;
  import org.opentrafficsim.core.gtu.GTUType;
  import org.opentrafficsim.core.network.NetworkException;
  import org.opentrafficsim.core.network.OTSNetwork;
  import org.opentrafficsim.core.network.OTSNode;
  import org.opentrafficsim.demo.FundamentalDiagrams.FundamentalDiagramPlotsModel;
  import org.opentrafficsim.draw.core.OTSDrawingException;
  import org.opentrafficsim.draw.graphs.FundamentalDiagram;
  import org.opentrafficsim.draw.graphs.FundamentalDiagram.Quantity;
  import org.opentrafficsim.draw.graphs.road.GraphLaneUtil;
  import org.opentrafficsim.road.gtu.lane.LaneBasedIndividualGTU;
  import org.opentrafficsim.road.gtu.lane.tactical.following.IDMPlusFactory;
  import org.opentrafficsim.road.gtu.lane.tactical.lmrs.DefaultLMRSPerceptionFactory;
  import org.opentrafficsim.road.gtu.lane.tactical.lmrs.LMRSFactory;
  import org.opentrafficsim.road.gtu.strategical.LaneBasedStrategicalPlanner;
  import org.opentrafficsim.road.gtu.strategical.LaneBasedStrategicalPlannerFactory;
  import org.opentrafficsim.road.gtu.strategical.route.LaneBasedStrategicalRoutePlannerFactory;
  import org.opentrafficsim.road.network.factory.LaneFactory;
  import org.opentrafficsim.road.network.lane.CrossSectionLink;
  import org.opentrafficsim.road.network.lane.DirectedLanePosition;
  import org.opentrafficsim.road.network.lane.Lane;
  import org.opentrafficsim.road.network.lane.LaneType;
  import org.opentrafficsim.road.network.lane.changing.OvertakingConditions;
  import org.opentrafficsim.road.network.lane.object.sensor.SinkSensor;
  import org.opentrafficsim.road.network.lane.object.trafficlight.SimpleTrafficLight;
  import org.opentrafficsim.road.network.lane.object.trafficlight.TrafficLightColor;
  import org.opentrafficsim.road.network.sampling.RoadSampler;
  import org.opentrafficsim.swing.gui.OTSAnimationPanel;
  import org.opentrafficsim.swing.gui.OTSSimulationApplication;
  
  import nl.tudelft.simulation.dsol.SimRuntimeException;
  import nl.tudelft.simulation.dsol.model.inputparameters.InputParameterException;
  import nl.tudelft.simulation.dsol.swing.gui.TablePanel;
  import nl.tudelft.simulation.dsol.swing.gui.inputparameters.TabbedParameterDialog;
  import nl.tudelft.simulation.jstats.streams.MersenneTwister;
  import nl.tudelft.simulation.jstats.streams.StreamInterface;
  
  /**
   * Demonstrate the FundamentalDiagram plot.
   * <p>
   * Copyright (c) 2013-2019 Delft University of Technology, PO Box 5, 2600 AA, Delft, the Netherlands. All rights reserved. <br>
   * BSD-style license. See <a href="http://opentrafficsim.org/docs/license.html">OpenTrafficSim License</a>.
   * <p>
   * $LastChangedDate: 2019-01-18 22:40:31 +0100 (Fri, 18 Jan 2019) $, @version $Revision: 4886 $, by $Author: averbraeck $,
   * initial version 17 dec. 2014 <br>
   * @author <a href="http://www.tudelft.nl/pknoppers">Peter Knoppers</a>
   */
  public class FundamentalDiagrams extends OTSSimulationApplication<FundamentalDiagramPlotsModel> implements UNITS
  {
      /** */
      private static final long serialVersionUID = 1L;
  
      /**
       * Create a Straight Swing application.
       * @param title String; the title of the Frame
       * @param panel OTSAnimationPanel; the tabbed panel to display
       * @param model FundamentalDiagramPlotsModel; the model
       * @throws OTSDrawingException on animation error
       * @throws OTSSimulationException on graph error
       */
      public FundamentalDiagrams(final String title, final OTSAnimationPanel panel, final FundamentalDiagramPlotsModel model)
              throws OTSDrawingException, OTSSimulationException
      {
          super(model, panel);
          OTSNetwork network = model.getNetwork();
          System.out.println(network.getLinkMap());
      }
  
      /** {@inheritDoc} */
      @Override
     protected void addTabs()
     {
         Try.execute(() -> addStatisticsTabs(getModel().getSimulator()), RuntimeException.class,
                 "Exception while setting up the statistics tabs.");
     }
 
     /**
      * Main program.
      * @param args String[]; the command line arguments (not used)
      */
     public static void main(final String[] args)
     {
         demo(true);
     }
 
     /**
      * Start the demo.
      * @param exitOnClose boolean; when running stand-alone: true; when running as part of a demo: false
      */
     public static void demo(final boolean exitOnClose)
     {
         try
         {
             OTSAnimator simulator = new OTSAnimator();
             final FundamentalDiagramPlotsModel otsModel = new FundamentalDiagramPlotsModel(simulator);
             if (TabbedParameterDialog.process(otsModel.getInputParameterMap()))
             {
                 simulator.initialize(Time.ZERO, Duration.ZERO, Duration.createSI(3600.0), otsModel);
                 OTSAnimationPanel animationPanel = new OTSAnimationPanel(otsModel.getNetwork().getExtent(),
                         new Dimension(800, 600), simulator, otsModel, DEFAULT_COLORER, otsModel.getNetwork());
                 FundamentalDiagrams app = new FundamentalDiagrams("FundamentalDiagrams", animationPanel, otsModel);
                 app.setExitOnClose(exitOnClose);
             }
             else
             {
                 if (exitOnClose)
                 {
                     System.exit(0);
                 }
             }
         }
         catch (SimRuntimeException | NamingException | RemoteException | OTSDrawingException | OTSSimulationException exception)
         {
             exception.printStackTrace();
         }
     }
 
     /**
      * Add the statistics tabs.
      * @param simulator OTSSimulatorInterface; the simulator on which sampling can be scheduled
      * @throws OTSSimulationException on error
      */
     protected final void addStatisticsTabs(final OTSSimulatorInterface simulator) throws OTSSimulationException
     {
         final int panelsPerRow = 3;
         TablePanel charts = new TablePanel(4, panelsPerRow);
         RoadSampler sampler = new RoadSampler(simulator);
         for (int plotNumber = 0; plotNumber < 10; plotNumber++)
         {
             Length detectorLocation = new Length(400 + 500 * plotNumber, METER);
             String name = "Fundamental Diagram at " + detectorLocation.getSI() + "m";
             FundamentalDiagram graph;
             try
             {
                 graph = new FundamentalDiagram(name, Quantity.DENSITY, Quantity.FLOW, simulator, sampler,
                         GraphLaneUtil.createCrossSection(name,
                                 new DirectedLanePosition(getModel().getLane(), detectorLocation, GTUDirectionality.DIR_PLUS)),
                         false, Duration.createSI(60.0), false);
             }
             catch (NetworkException | GTUException exception)
             {
                 throw new OTSSimulationException(exception);
             }
             charts.setCell(graph.getContentPane(), plotNumber / panelsPerRow, plotNumber % panelsPerRow);
         }
         getAnimationPanel().getTabbedPane().addTab(getAnimationPanel().getTabbedPane().getTabCount(), "statistics ", charts);
     }
 
     /**
      * Simulate a single lane road of 5 km length. Vehicles are generated at a constant rate of 1500 veh/hour. At time 300s a
      * blockade is inserted at position 4 km; this blockade is removed at time 500s. The used car following algorithm is IDM+
      * <a href="http://opentrafficsim.org/downloads/MOTUS%20reference.pdf"><i>Integrated Lane Change Model with Relaxation and
      * Synchronization</i>, by Wouter J. Schakel, Victor L. Knoop and Bart van Arem, 2012</a>. <br>
      * Output is a set of FundamentalDiagram plots for various point along the lane.
      * <p>
      * Copyright (c) 2013-2019 Delft University of Technology, PO Box 5, 2600 AA, Delft, the Netherlands. All rights reserved.
      * <br>
      * BSD-style license. See <a href="http://opentrafficsim.org/docs/license.html">OpenTrafficSim License</a>.
      * <p>
      * $LastChangedDate: 2019-01-18 22:40:31 +0100 (Fri, 18 Jan 2019) $, @version $Revision: 4886 $, by $Author: averbraeck $,
      * initial version ug 1, 2014 <br>
      * @author <a href="http://www.tudelft.nl/pknoppers">Peter Knoppers</a>
      */
     static class FundamentalDiagramPlotsModel extends AbstractOTSModel implements UNITS
     {
         /** */
         private static final long serialVersionUID = 20140820L;
 
         /** The network. */
         private OTSNetwork network = new OTSNetwork("network");
 
         /** The headway (inter-vehicle time). */
         private Duration headway;
 
         /** Number of cars created. */
         private int carsCreated = 0;
 
         /** Type of all GTUs. */
         private GTUType gtuType = CAR;
 
         /** Strategical planner generator for cars. */
         private LaneBasedStrategicalPlannerFactory<LaneBasedStrategicalPlanner> strategicalPlannerGeneratorCars = null;
 
         /** Strategical planner generator for trucks. */
         private LaneBasedStrategicalPlannerFactory<LaneBasedStrategicalPlanner> strategicalPlannerGeneratorTrucks = null;
 
         /** Car parameters. */
         private Parameters parametersCar;
 
         /** Truck parameters. */
         private Parameters parametersTruck;
 
         /** The probability that the next generated GTU is a passenger car. */
         private double carProbability;
 
         /** The blocking, implemented as a traffic light. */
         private SimpleTrafficLight block = null;
 
         /** Minimum distance. */
         private Length minimumDistance = new Length(0, METER);
 
         /** Maximum distance. */
         private Length maximumDistance = new Length(5000, METER);
 
         /** The Lane containing the simulated Cars. */
         private Lane lane;
 
         /** The speed limit. */
         private Speed speedLimit = new Speed(100, KM_PER_HOUR);
 
         /** The random number generator used to decide what kind of GTU to generate. */
         private StreamInterface stream = new MersenneTwister(12345);
 
         /**
          * @param simulator OTSSimulatorInterface; the simulator for this model
          */
         FundamentalDiagramPlotsModel(final OTSSimulatorInterface simulator)
         {
             super(simulator);
             InputParameterHelper.makeInputParameterMapCarTruck(this.inputParameterMap, 1.0);
         }
 
         /** {@inheritDoc} */
         @Override
         public final void constructModel() throws SimRuntimeException
         {
             try
             {
                 OTSNode from = new OTSNode(this.network, "From", new OTSPoint3D(getMinimumDistance().getSI(), 0, 0));
                 OTSNode to = new OTSNode(this.network, "To", new OTSPoint3D(getMaximumDistance().getSI(), 0, 0));
                 OTSNode end = new OTSNode(this.network, "End", new OTSPoint3D(getMaximumDistance().getSI() + 50.0, 0, 0));
                 LaneType laneType = LaneType.TWO_WAY_LANE;
                 this.lane =
                         LaneFactory.makeLane(this.network, "Lane", from, to, null, laneType, this.speedLimit, this.simulator);
                 CrossSectionLink endLink = LaneFactory.makeLink(this.network, "endLink", to, end, null, this.simulator);
                 // No overtaking, single lane
                 Lane sinkLane = new Lane(endLink, "sinkLane", this.lane.getLateralCenterPosition(1.0),
                         this.lane.getLateralCenterPosition(1.0), this.lane.getWidth(1.0), this.lane.getWidth(1.0), laneType,
                         this.speedLimit, new OvertakingConditions.None());
                 new SinkSensor(sinkLane, new Length(10.0, METER), this.simulator);
 
                 this.carProbability = (double) getInputParameter("generic.carProbability");
                 this.parametersCar = InputParameterHelper.getParametersCar(getInputParameterMap());
                 this.parametersTruck = InputParameterHelper.getParametersTruck(getInputParameterMap());
 
                 this.strategicalPlannerGeneratorCars = new LaneBasedStrategicalRoutePlannerFactory(
                         new LMRSFactory(new IDMPlusFactory(this.stream), new DefaultLMRSPerceptionFactory()));
                 this.strategicalPlannerGeneratorTrucks = new LaneBasedStrategicalRoutePlannerFactory(
                         new LMRSFactory(new IDMPlusFactory(this.stream), new DefaultLMRSPerceptionFactory()));
 
                 // 1500 [veh / hour] == 2.4s headway
                 this.headway = new Duration(3600.0 / 1500.0, SECOND);
 
                 // Schedule creation of the first car (this will re-schedule itself one headway later, etc.).
                 this.simulator.scheduleEventAbs(Time.ZERO, this, this, "generateCar", null);
 
                 this.block = new SimpleTrafficLight(this.lane.getId() + "_TL", this.lane,
                         new Length(new Length(4000.0, LengthUnit.METER)), this.simulator);
                 this.block.setTrafficLightColor(TrafficLightColor.GREEN);
 
                 // Create a block at t = 5 minutes
                 this.simulator.scheduleEventAbs(new Time(300, TimeUnit.BASE_SECOND), this, this, "createBlock", null);
                 // Remove the block at t = 7 minutes
                 this.simulator.scheduleEventAbs(new Time(420, TimeUnit.BASE_SECOND), this, this, "removeBlock", null);
             }
             catch (SimRuntimeException | NetworkException | GTUException | OTSGeometryException | ParameterException
                     | InputParameterException exception)
             {
                 exception.printStackTrace();
             }
         }
 
         /**
          * Set up the block.
          */
         protected final void createBlock()
         {
             this.block.setTrafficLightColor(TrafficLightColor.RED);
         }
 
         /**
          * Remove the block.
          */
         protected final void removeBlock()
         {
             this.block.setTrafficLightColor(TrafficLightColor.GREEN);
         }
 
         /**
          * Generate cars at a fixed rate (implemented by re-scheduling this method).
          */
         protected final void generateCar()
         {
             try
             {
                 boolean generateTruck = this.stream.nextDouble() > this.carProbability;
                 Length vehicleLength = new Length(generateTruck ? 15 : 4, METER);
                 LaneBasedIndividualGTU gtu = new LaneBasedIndividualGTU("" + (++this.carsCreated), this.gtuType, vehicleLength,
                         new Length(1.8, METER), new Speed(200, KM_PER_HOUR), vehicleLength.multiplyBy(0.5), this.simulator,
                         this.network);
                 gtu.setParameters(generateTruck ? this.parametersTruck : this.parametersCar);
                 gtu.setNoLaneChangeDistance(Length.ZERO);
                 gtu.setMaximumAcceleration(Acceleration.createSI(3.0));
                 gtu.setMaximumDeceleration(Acceleration.createSI(-8.0));
 
                 // strategical planner
                 LaneBasedStrategicalPlanner strategicalPlanner =
                         generateTruck ? this.strategicalPlannerGeneratorTrucks.create(gtu, null, null, null)
                                 : this.strategicalPlannerGeneratorCars.create(gtu, null, null, null);
 
                 Set<DirectedLanePosition> initialPositions = new LinkedHashSet<>(1);
                 Length initialPosition = new Length(20, METER);
                 initialPositions.add(new DirectedLanePosition(this.lane, initialPosition, GTUDirectionality.DIR_PLUS));
                 Speed initialSpeed = new Speed(100.0, KM_PER_HOUR);
                 gtu.init(strategicalPlanner, initialPositions, initialSpeed);
                 this.simulator.scheduleEventRel(this.headway, this, this, "generateCar", null);
             }
             catch (SimRuntimeException | NetworkException | GTUException | OTSGeometryException exception)
             {
                 exception.printStackTrace();
             }
         }
 
         /** {@inheritDoc} */
         @Override
         public OTSNetwork getNetwork()
         {
             return this.network;
         }
 
         /**
          * @return minimumDistance
          */
         public final Length getMinimumDistance()
         {
             return this.minimumDistance;
         }
 
         /**
          * @return maximumDistance
          */
         public final Length getMaximumDistance()
         {
             return this.maximumDistance;
         }
 
         /**
          * @return lane.
          */
         public Lane getLane()
         {
             return this.lane;
         }
     }
 
     /** {@inheritDoc} */
     @Override
     public final String toString()
     {
         return "FundamentalDiagrams [model=" + getModel() + "]";
     }
 
 }