void ApplyThrust()
{
var reachedTargetSpeed = speed >= (1 - targetSpeedVariation) * targetSpeed;
if (reachedTopSpeedOnce && reachedTargetSpeed)
{
var requiredThrust = CalculateRequiredThrust();
thrustController.ApplyThrust(requiredThrust * marginOfErrorThrust);
}
else
{
thrustController.ApplyFullThrust();
}
}
public void Main(string input)
{
lcds = SearchBlocksWithName <IMyTextPanel>(lcdSearchName);
ClearOutput();
if (input == "start")
{
Runtime.UpdateFrequency = UpdateFrequency.Update10;
Autopilot = true;
}
IMyShipController controlBlock = (IMyShipController)GridTerminalSystem.GetBlockWithName(ShipControllerName);
double altitude = 0;
bool InsideNaturalGravity = controlBlock.TryGetPlanetElevation(MyPlanetElevation.Surface, out altitude);
Vector3D velocity3D = controlBlock.GetShipVelocities().LinearVelocity;
if (!InsideNaturalGravity)
{
if (Autopilot)
{
WriteLine("Waiting for entering natural gravity");
if (input == "stop")
{
Autopilot = false;
WriteLine("Autopilot deactivated (manually)");
}
}
return;
}
else
{
if (Autopilot && AutoFall)
{
if (!AutoFallUsed)
{
input = "fall";
AutoFallUsed = true;
}
}
}
List <IMyThrust> thrusters = GetBlocksInGroup <IMyThrust>(HydrogenThrustersGroupName);
ThrustController thrustController = new ThrustController(thrusters);
gyros = GetBlocksOfType <IMyGyro>();
gyroController = new GyroController(controlBlock, gyros, Base6Directions.Direction.Down, RotationSpeedLimit);
Vector3D gravity = controlBlock.GetNaturalGravity();
Vector3D position = controlBlock.GetPosition(); // ship coords
double gravityStrength = gravity.Length(); // gravity in m/s^2
double totalMass = controlBlock.CalculateShipMass().TotalMass; // ship total mass including cargo mass
double baseMass = controlBlock.CalculateShipMass().BaseMass; // mass of the ship without cargo
double cargoMass = totalMass - baseMass; // mass of the cargo
double actualMass = baseMass + (cargoMass / InventoryMultiplier); // the mass the game uses for physics calculation
double shipWeight = actualMass * gravityStrength; // weight in newtons of the ship
double velocity = controlBlock.GetShipSpeed(); // ship velocity
double brakeDistance = CalculateBrakeDistance(gravityStrength, actualMass, altitude, thrustController.availableThrust, velocity);
double brakeAltitude = StopAltitude + brakeDistance; // at this altitude the ship will start slowing Down
if (Autopilot)
{
gyroController.Align(gravity);
if (input == "fall")
{
// This is a workaround to a game bug (ship speed greater than speed limit when free falling in natural gravity)
// Pros: your ship will not crash. Cons: you will waste a tiny amount of hydrogen.
thrustController.ApplyThrust(1);
}
if (altitude <= (brakeAltitude + AltitudeMargin))
{
// BRAKE!!!
thrustController.ApplyFullThrust(); // Maybe just enable dampeners
}
if (altitude <= (StopAltitude + DisableMargin + AltitudeMargin))
{
if (velocity < StopSpeed)
{
gyroController.Stop();
WriteLine("Autopilot deactivated (automatically)");
}
if (SmartDeactivation)
{
if (OldVelocity3D.X * velocity3D.X < 0 || OldVelocity3D.Y * velocity3D.Y < 0 || OldVelocity3D.Z * velocity3D.Z < 0)
{
gyroController.Stop();
WriteLine("Autopilot deactivated (automatically)");
}
}
}
}
OldVelocity3D = velocity3D;
if (input == "stop")
{
Runtime.UpdateFrequency = UpdateFrequency.None;
gyroController.Stop();
thrustController.Stop();
WriteLine("Autopilot deactivated (manually)");
}
}
