/**
* Create a rocket configuration from the launch conditions.
*
* @param simulation the launch conditions.
* @return a rocket configuration with all stages attached.
*/
private Configuration setupConfiguration(SimulationConditions simulation) {
Configuration configuration = new Configuration(simulation.getRocket());
configuration.setAllStages();
configuration.setMotorConfigurationID(simulation.getMotorConfigurationID());
return configuration;
}
/**
* Create a new motor instance configuration for the rocket configuration.
*
* @param configuration the rocket configuration.
* @return a new motor instance configuration with all motors in place.
*/
private MotorInstanceConfiguration setupMotorConfiguration(Configuration configuration) {
MotorInstanceConfiguration motors = new MotorInstanceConfiguration();
final String motorId = configuration.getMotorConfigurationID();
Iterator<MotorMount> iterator = configuration.motorIterator();
while (iterator.hasNext()) {
MotorMount mount = iterator.next();
RocketComponent component = (RocketComponent) mount;
Motor motor = mount.getMotor(motorId);
if (motor != null) {
Coordinate[] positions = component.toAbsolute(mount.getMotorPosition(motorId));
for (int i = 0; i < positions.length; i++) {
Coordinate position = positions[i];
MotorId id = new MotorId(component.getID(), i + 1);
motors.addMotor(id, motor.getInstance(), mount, position);
}
}
}
return motors;
}
private SimulationStatus initialStatus(
Configuration configuration,
MotorInstanceConfiguration motorConfiguration,
SimulationConditions simulationConditions,
FlightData flightData) {
SimulationStatus init = new SimulationStatus();
init.setSimulationConditions(simulationConditions);
init.setConfiguration(configuration);
init.setMotorConfiguration(motorConfiguration);
init.setSimulationTime(0);
init.setPreviousTimeStep(simulationConditions.getTimeStep());
init.setRocketPosition(Coordinate.NUL);
init.setRocketVelocity(Coordinate.NUL);
init.setRocketWorldPosition(simulationConditions.getLaunchSite());
// Initialize to roll angle with least stability w.r.t. the wind
Quaternion o;
FlightConditions cond = new FlightConditions(configuration);
simulationConditions.getAerodynamicCalculator().getWorstCP(configuration, cond, null);
double angle = -cond.getTheta() - simulationConditions.getLaunchRodDirection();
o = Quaternion.rotation(new Coordinate(0, 0, angle));
// Launch rod angle and direction
o =
o.multiplyLeft(
Quaternion.rotation(new Coordinate(0, simulationConditions.getLaunchRodAngle(), 0)));
o =
o.multiplyLeft(
Quaternion.rotation(
new Coordinate(0, 0, simulationConditions.getLaunchRodDirection())));
init.setRocketOrientationQuaternion(o);
init.setRocketRotationVelocity(Coordinate.NUL);
/*
* Calculate the effective launch rod length taking into account launch lugs.
* If no lugs are found, assume a tower launcher of full length.
*/
double length = simulationConditions.getLaunchRodLength();
double lugPosition = Double.NaN;
for (RocketComponent c : configuration) {
if (c instanceof LaunchLug) {
double pos = c.toAbsolute(new Coordinate(c.getLength()))[0].x;
if (Double.isNaN(lugPosition) || pos > lugPosition) {
lugPosition = pos;
}
}
}
if (!Double.isNaN(lugPosition)) {
double maxX = 0;
for (Coordinate c : configuration.getBounds()) {
if (c.x > maxX) maxX = c.x;
}
if (maxX >= lugPosition) {
length = Math.max(0, length - (maxX - lugPosition));
}
}
init.setEffectiveLaunchRodLength(length);
init.setSimulationStartWallTime(System.nanoTime());
init.setMotorIgnited(false);
init.setLiftoff(false);
init.setLaunchRodCleared(false);
init.setApogeeReached(false);
init.getEventQueue()
.add(new FlightEvent(FlightEvent.Type.LAUNCH, 0, simulationConditions.getRocket()));
init.setFlightData(new FlightDataBranch("MAIN", FlightDataType.TYPE_TIME));
init.setWarnings(flightData.getWarningSet());
return init;
}
