BlueGit

timfa minecart-trains

Files

minecart-trains / src / main / java / me / fridtjof / minecarttrains / managers / LinkPhysics.java

LinkPhysics.java

LinkPhysics.java 5.7 KiB Download Raw
1package me.fridtjof.minecarttrains.managers;
2
3import me.fridtjof.minecarttrains.utils.Rails;
4import org.bukkit.entity.Minecart;
5import org.bukkit.util.Vector;
6
7import java.util.List;
8
9public class LinkPhysics
10{
11
12 private static final double STILL = 1.0E-4;
13
14 private final LinkageManager linkageManager;
15 private final double aimedDistanceLow;
16 private final double aimedDistanceHigh;
17 private final double highSpeedGateSquared;
18 private final double stiffness;
19 private final double damping;
20 private final double maxCorrection;
21 private final double curveAlignment;
22 private final double stretchSlop;
23 private final double curveStretchSlop;
24
25 public LinkPhysics(LinkageManager linkageManager, ConfigManager configManager)
26 {
27 this.linkageManager = linkageManager;
28 this.aimedDistanceLow = configManager.physicsConfig.getConfig().getDouble("link.low_speed.distance.aimed");
29 this.aimedDistanceHigh = configManager.physicsConfig.getConfig().getDouble("link.high_speed.distance.aimed");
30 double highSpeedGate = configManager.physicsConfig.getConfig().getDouble("link.high_speed.gate_speed");
31 this.highSpeedGateSquared = highSpeedGate * highSpeedGate;
32 this.stiffness = configManager.physicsConfig.getConfig().getDouble("link.rigid.stiffness");
33 this.damping = configManager.physicsConfig.getConfig().getDouble("link.rigid.damping");
34 this.maxCorrection = configManager.physicsConfig.getConfig().getDouble("link.rigid.max_correction");
35 this.curveAlignment = configManager.physicsConfig.getConfig().getDouble("link.rigid.curve_alignment");
36 this.stretchSlop = configManager.physicsConfig.getConfig().getDouble("link.rigid.stretch_slop");
37 this.curveStretchSlop = configManager.physicsConfig.getConfig().getDouble("link.rigid.curve_stretch_slop");
38 }
39
40 public void updateTrain(Minecart cart)
41 {
42 if (!linkageManager.markTrainSolved(cart))
43 {
44 return;
45 }
46
47 List<Minecart> train = linkageManager.getTrain(cart);
48 if (train.size() < 2)
49 {
50 return;
51 }
52
53 Minecart leader = linkageManager.findLeader(cart);
54 if (leader == null)
55 {
56 for (int i = 1; i < train.size(); i++)
57 {
58 constrain(train.get(i), train.get(i - 1), false);
59 }
60 return;
61 }
62
63 int leaderIndex = indexOf(train, leader);
64 if (leaderIndex < 0)
65 {
66 return;
67 }
68
69 for (int i = leaderIndex + 1; i < train.size(); i++)
70 {
71 constrain(train.get(i), train.get(i - 1), true);
72 }
73 for (int i = leaderIndex - 1; i >= 0; i--)
74 {
75 constrain(train.get(i), train.get(i + 1), true);
76 }
77 }
78
79 private void constrain(Minecart follower, Minecart anchor, boolean driven)
80 {
81 Vector followerPos = follower.getLocation().toVector();
82 Vector anchorPos = anchor.getLocation().toVector();
83 Vector between = followerPos.subtract(anchorPos);
84 double distance = between.length();
85 if (distance < 1.0E-6)
86 {
87 return;
88 }
89
90 Vector linkAxis = between.multiply(1.0 / distance);
91 Vector hint = follower.getVelocity();
92 if (hint.lengthSquared() < STILL)
93 {
94 hint = anchor.getVelocity();
95 }
96 if (hint.lengthSquared() < STILL)
97 {
98 hint = linkAxis;
99 }
100
101 Vector rail = Rails.tangent(follower.getLocation(), hint);
102 if (rail.lengthSquared() < STILL)
103 {
104 rail = linkAxis.clone().setY(0);
105 if (rail.lengthSquared() < STILL)
106 {
107 return;
108 }
109 rail.normalize();
110 }
111
112 if (rail.dot(hint) < 0 && hint.lengthSquared() >= STILL)
113 {
114 rail.multiply(-1);
115 }
116
117 double alignment = Math.abs(rail.dot(linkAxis));
118 boolean onCurve = alignment < curveAlignment;
119 double aimed = aimedDistance(anchor);
120 double stretch = distance - aimed;
121
122 Vector newVelocity = driven
123 ? rail.clone().multiply(anchor.getVelocity().length())
124 : follower.getVelocity().clone();
125
126 double correction = spacingCorrection(stretch, onCurve, follower.getVelocity(), anchor.getVelocity(), rail, linkAxis);
127 if (Math.abs(correction) > 1.0E-4)
128 {
129 newVelocity.add(rail.clone().multiply(correction));
130 }
131 else if (!driven)
132 {
133 return;
134 }
135
136 follower.setVelocity(newVelocity);
137 }
138
139 private double spacingCorrection(double stretch, boolean onCurve, Vector followerVel, Vector anchorVel, Vector rail, Vector linkAxis)
140 {
141 double slop = onCurve ? curveStretchSlop : stretchSlop;
142 if (stretch <= slop)
143 {
144 return 0;
145 }
146
147 double towardAnchor = -Math.signum(rail.dot(linkAxis));
148 if (towardAnchor == 0.0)
149 {
150 towardAnchor = -1;
151 }
152
153 double relative = followerVel.clone().subtract(anchorVel).dot(rail);
154 double correction = towardAnchor * stiffness * (stretch - slop) - damping * relative;
155 return Math.max(-maxCorrection, Math.min(maxCorrection, correction));
156 }
157
158 private double aimedDistance(Minecart anchor)
159 {
160 if (anchor.getVelocity().lengthSquared() > highSpeedGateSquared)
161 {
162 return aimedDistanceHigh;
163 }
164 return aimedDistanceLow;
165 }
166
167 private int indexOf(List<Minecart> train, Minecart cart)
168 {
169 for (int i = 0; i < train.size(); i++)
170 {
171 if (train.get(i).getUniqueId().equals(cart.getUniqueId()))
172 {
173 return i;
174 }
175 }
176 return -1;
177 }
178}