1 package org.opentrafficsim.road.gtu.lane.control;
2
3 import org.djunits.value.vdouble.scalar.Acceleration;
4 import org.opentrafficsim.base.parameters.ParameterException;
5 import org.opentrafficsim.base.parameters.ParameterTypeDouble;
6 import org.opentrafficsim.base.parameters.Parameters;
7 import org.opentrafficsim.base.parameters.constraint.NumericConstraint;
8 import org.opentrafficsim.road.gtu.lane.LaneBasedGTU;
9 import org.opentrafficsim.road.gtu.lane.perception.PerceptionCollectable;
10 import org.opentrafficsim.road.gtu.lane.perception.headway.HeadwayGTU;
11
12
13
14
15
16
17
18
19
20
21
22 public class PloegACC extends LinearACC
23 {
24
25
26 public static final ParameterTypeDouble KD =
27 new ParameterTypeDouble("kd", "Gap error derivative gain", 0.7, NumericConstraint.POSITIVE);
28
29
30
31
32
33 public PloegACC(final DelayedActuation delayedActuation)
34 {
35 super(delayedActuation);
36 }
37
38
39 @Override
40 public Acceleration getFollowingAcceleration(final LaneBasedGTU gtu,
41 final PerceptionCollectable<HeadwayGTU, LaneBasedGTU> leaders, final Parameters settings) throws ParameterException
42 {
43 HeadwayGTU leader = leaders.first();
44 double es =
45 leader.getDistance().si - gtu.getSpeed().si * settings.getParameter(TDACC).si - settings.getParameter(X0).si;
46 double esd = leader.getSpeed().si - gtu.getSpeed().si - gtu.getAcceleration().si * settings.getParameter(TDACC).si;
47 return Acceleration.instantiateSI(settings.getParameter(KS) * es + settings.getParameter(KD) * esd);
48 }
49
50 }