private void updateLandingBurn() { var vesselVelocity = VesselController.getVelocity(); var vesselVelocityNormalized = vesselVelocity; vesselVelocityNormalized.Normalize(); VesselDirectionController.setTargetDirection(-vesselVelocityNormalized); double hoverPercentage = predictThrustPercentageForAcceleration(VesselController.getGravity().Length()); double val = vesselVelocity.Length() - (5.0f + VesselController.getAltitude() * 0.09f);// - landingSpeedPID.Calculate(17.0f, vesselVelocity.Length()); if (brakeAltitudePrediction <= 0.0) { val = 1.0; } // if (vesselVelocity.Length() > VesselController.getAltitude() * 0.2f + 5.0) val = 1.0; VesselController.setThrottle(clamp(val, 0.0, 1.0)); if (VesselController.getAltitude() < 500) { VesselController.setLandingGearState(true); } Console.WriteLine("[Landing burn] Brake prediction {0}", brakeAltitudePrediction); }
private void updateLandingBurn() { var targetRelative = Target - landingPrediction.Position; var targetRelativeNormalized = targetRelative; targetRelativeNormalized.Normalize(); var downDirection = VesselController.getGravity(); downDirection.Normalize(); var vesselVelocity = VesselController.getVelocity(); var vesselVelocityNormalized = vesselVelocity; vesselVelocityNormalized.Normalize(); var altitude = VesselController.getAltitude(); var targetAltitude = VesselController.getAltitudeAtPoint(Target); altitude -= targetAltitude; float tiltMultiplier = 0.38f; float relativeMultiplier = 0.0125f; if (altitude < 7000) { tiltMultiplier = 0.18f; relativeMultiplier = 0.0225f; } if (altitude < 5000) { tiltMultiplier = 0.08f; relativeMultiplier = 0.0825f; } if (altitude < 2500) { tiltMultiplier = 0.0f; } var desiredDirection = -vesselVelocityNormalized + targetRelativeNormalized * tiltMultiplier * Math.Min(1.0f, targetRelative.Length() * relativeMultiplier); if (vesselVelocity.Length() < 15.0) { bool upsidedown = Vector3.Dot(downDirection, vesselVelocityNormalized) < 0.0; desiredDirection = -(upsidedown ? downDirection : vesselVelocityNormalized);// + targetRelativeNormalized * 0.10f * Math.Min(1.0f, targetRelative.Length() * 0.0225f); } VesselDirectionController.setTargetDirection(desiredDirection); var velocity = Vector3.Dot(vesselVelocity, -downDirection); var pidCalculatedThrottle = landingSpeedPID.Calculate(-altitude * 0.06f - 5.0f, velocity); //Console.WriteLine("PID Result : {0}", pidCalculatedThrottle); double hoverPercentage = predictThrustPercentageForAcceleration(VesselController.getGravity().Length()) * 2.0 - 1.0; pidCalculatedThrottle -= hoverPercentage; VesselController.setThrottle(clamp(pidCalculatedThrottle, -1.0, 1.0) * 0.5 + 0.5); if (VesselController.getAltitude() < 500) { VesselController.setLandingGearState(true); } Console.WriteLine("[Landing burn] Prediction mismatch {0} Brake prediction {1}", targetRelative.Length(), brakeAltitudePrediction); }
public bool update() { VesselDirectionController.update(); return(VesselController.getAltitude() >= Altitude); }