package me.fridtjof.minecarttrains.managers; import me.fridtjof.minecarttrains.utils.Rails; import org.bukkit.entity.Minecart; import org.bukkit.util.Vector; import java.util.List; public class LinkPhysics { private static final double STILL = 1.0E-4; private final LinkageManager linkageManager; private final double aimedDistanceLow; private final double aimedDistanceHigh; private final double highSpeedGateSquared; private final double stiffness; private final double damping; private final double maxCorrection; private final double curveAlignment; private final double stretchSlop; private final double curveStretchSlop; public LinkPhysics(LinkageManager linkageManager, ConfigManager configManager) { this.linkageManager = linkageManager; this.aimedDistanceLow = configManager.physicsConfig.getConfig().getDouble("link.low_speed.distance.aimed"); this.aimedDistanceHigh = configManager.physicsConfig.getConfig().getDouble("link.high_speed.distance.aimed"); double highSpeedGate = configManager.physicsConfig.getConfig().getDouble("link.high_speed.gate_speed"); this.highSpeedGateSquared = highSpeedGate * highSpeedGate; this.stiffness = configManager.physicsConfig.getConfig().getDouble("link.rigid.stiffness"); this.damping = configManager.physicsConfig.getConfig().getDouble("link.rigid.damping"); this.maxCorrection = configManager.physicsConfig.getConfig().getDouble("link.rigid.max_correction"); this.curveAlignment = configManager.physicsConfig.getConfig().getDouble("link.rigid.curve_alignment"); this.stretchSlop = configManager.physicsConfig.getConfig().getDouble("link.rigid.stretch_slop"); this.curveStretchSlop = configManager.physicsConfig.getConfig().getDouble("link.rigid.curve_stretch_slop"); } public void updateTrain(Minecart cart) { if (!linkageManager.markTrainSolved(cart)) { return; } List train = linkageManager.getTrain(cart); if (train.size() < 2) { return; } Minecart leader = linkageManager.findLeader(cart); if (leader == null) { for (int i = 1; i < train.size(); i++) { constrain(train.get(i), train.get(i - 1), false); } return; } int leaderIndex = indexOf(train, leader); if (leaderIndex < 0) { return; } for (int i = leaderIndex + 1; i < train.size(); i++) { constrain(train.get(i), train.get(i - 1), true); } for (int i = leaderIndex - 1; i >= 0; i--) { constrain(train.get(i), train.get(i + 1), true); } } private void constrain(Minecart follower, Minecart anchor, boolean driven) { Vector followerPos = follower.getLocation().toVector(); Vector anchorPos = anchor.getLocation().toVector(); Vector between = followerPos.subtract(anchorPos); double distance = between.length(); if (distance < 1.0E-6) { return; } Vector linkAxis = between.multiply(1.0 / distance); Vector hint = follower.getVelocity(); if (hint.lengthSquared() < STILL) { hint = anchor.getVelocity(); } if (hint.lengthSquared() < STILL) { hint = linkAxis; } Vector rail = Rails.tangent(follower.getLocation(), hint); if (rail.lengthSquared() < STILL) { rail = linkAxis.clone().setY(0); if (rail.lengthSquared() < STILL) { return; } rail.normalize(); } if (rail.dot(hint) < 0 && hint.lengthSquared() >= STILL) { rail.multiply(-1); } double alignment = Math.abs(rail.dot(linkAxis)); boolean onCurve = alignment < curveAlignment; double aimed = aimedDistance(anchor); double stretch = distance - aimed; Vector newVelocity = driven ? rail.clone().multiply(anchor.getVelocity().length()) : follower.getVelocity().clone(); double correction = spacingCorrection(stretch, onCurve, follower.getVelocity(), anchor.getVelocity(), rail, linkAxis); if (Math.abs(correction) > 1.0E-4) { newVelocity.add(rail.clone().multiply(correction)); } else if (!driven) { return; } follower.setVelocity(newVelocity); } private double spacingCorrection(double stretch, boolean onCurve, Vector followerVel, Vector anchorVel, Vector rail, Vector linkAxis) { double slop = onCurve ? curveStretchSlop : stretchSlop; if (stretch <= slop) { return 0; } double towardAnchor = -Math.signum(rail.dot(linkAxis)); if (towardAnchor == 0.0) { towardAnchor = -1; } double relative = followerVel.clone().subtract(anchorVel).dot(rail); double correction = towardAnchor * stiffness * (stretch - slop) - damping * relative; return Math.max(-maxCorrection, Math.min(maxCorrection, correction)); } private double aimedDistance(Minecart anchor) { if (anchor.getVelocity().lengthSquared() > highSpeedGateSquared) { return aimedDistanceHigh; } return aimedDistanceLow; } private int indexOf(List train, Minecart cart) { for (int i = 0; i < train.size(); i++) { if (train.get(i).getUniqueId().equals(cart.getUniqueId())) { return i; } } return -1; } }