@Override public FlightData simulate(SimulationConditions simulationConditions) throws SimulationException { // Set up flight data FlightData flightData = new FlightData(); // Set up rocket configuration this.fcid = simulationConditions.getFlightConfigurationID(); FlightConfiguration simulationConfig = simulationConditions.getRocket().getFlightConfiguration(this.fcid).clone(); if (!simulationConfig.hasMotors()) { throw new MotorIgnitionException( trans.get("BasicEventSimulationEngine.error.noMotorsDefined")); } currentStatus = new SimulationStatus(simulationConfig, simulationConditions); currentStatus .getEventQueue() .add(new FlightEvent(FlightEvent.Type.LAUNCH, 0, simulationConditions.getRocket())); { // main simulation branch final String branchName = simulationConfig.getRocket().getTopmostStage().getName(); currentStatus.setFlightData(new FlightDataBranch(branchName, FlightDataType.TYPE_TIME)); } toSimulate.add(currentStatus); SimulationListenerHelper.fireStartSimulation(currentStatus); do { if (null == toSimulate.peek()) { break; } currentStatus = toSimulate.pop(); log.info(">>Starting simulation of branch: " + currentStatus.getFlightData().getBranchName()); FlightDataBranch dataBranch = simulateLoop(); flightData.addBranch(dataBranch); flightData.getWarningSet().addAll(currentStatus.getWarnings()); log.info( String.format( "<<Finished simulating branch: %s curTime:%s finTime:%s", dataBranch.getBranchName(), currentStatus.getSimulationTime(), dataBranch.getLast(FlightDataType.TYPE_TIME))); } while (!toSimulate.isEmpty()); SimulationListenerHelper.fireEndSimulation(currentStatus, null); if (!flightData.getWarningSet().isEmpty()) { log.info("Warnings at the end of simulation: " + flightData.getWarningSet()); } return flightData; }
@Override public FlightData simulate(SimulationConditions simulationConditions) throws SimulationException { Set<MotorId> motorBurntOut = new HashSet<MotorId>(); // Set up flight data FlightData flightData = new FlightData(); // Set up rocket configuration Configuration configuration = setupConfiguration(simulationConditions); MotorInstanceConfiguration motorConfiguration = setupMotorConfiguration(configuration); if (motorConfiguration.getMotorIDs().isEmpty()) { throw new MotorIgnitionException("No motors defined in the simulation."); } // Initialize the simulation currentStepper = flightStepper; status = initialStatus(configuration, motorConfiguration, simulationConditions, flightData); status = currentStepper.initialize(status); SimulationListenerHelper.fireStartSimulation(status); // Get originating position (in case listener has modified launch position) Coordinate origin = status.getRocketPosition(); Coordinate originVelocity = status.getRocketVelocity(); try { double maxAlt = Double.NEGATIVE_INFINITY; // Start the simulation while (handleEvents()) { // Take the step double oldAlt = status.getRocketPosition().z; if (SimulationListenerHelper.firePreStep(status)) { // Step at most to the next event double maxStepTime = Double.MAX_VALUE; FlightEvent nextEvent = status.getEventQueue().peek(); if (nextEvent != null) { maxStepTime = MathUtil.max(nextEvent.getTime() - status.getSimulationTime(), 0.001); } log.verbose( "BasicEventSimulationEngine: Taking simulation step at t=" + status.getSimulationTime()); currentStepper.step(status, maxStepTime); } SimulationListenerHelper.firePostStep(status); // Calculate values for custom expressions FlightDataBranch data = status.getFlightData(); ArrayList<CustomExpression> allExpressions = status.getSimulationConditions().getSimulation().getCustomExpressions(); for (CustomExpression expression : allExpressions) { data.setValue(expression.getType(), expression.evaluate(status)); } // Check for NaN values in the simulation status checkNaN(); // Add altitude event addEvent( new FlightEvent( FlightEvent.Type.ALTITUDE, status.getSimulationTime(), status.getConfiguration().getRocket(), new Pair<Double, Double>(oldAlt, status.getRocketPosition().z))); if (status.getRocketPosition().z > maxAlt) { maxAlt = status.getRocketPosition().z; } // Position relative to start location Coordinate relativePosition = status.getRocketPosition().sub(origin); // Add appropriate events if (!status.isLiftoff()) { // Avoid sinking into ground before liftoff if (relativePosition.z < 0) { status.setRocketPosition(origin); status.setRocketVelocity(originVelocity); } // Detect lift-off if (relativePosition.z > 0.02) { addEvent(new FlightEvent(FlightEvent.Type.LIFTOFF, status.getSimulationTime())); } } else { // Check ground hit after liftoff if (status.getRocketPosition().z < 0) { status.setRocketPosition(status.getRocketPosition().setZ(0)); addEvent(new FlightEvent(FlightEvent.Type.GROUND_HIT, status.getSimulationTime())); addEvent(new FlightEvent(FlightEvent.Type.SIMULATION_END, status.getSimulationTime())); } } // Check for launch guide clearance if (!status.isLaunchRodCleared() && relativePosition.length() > status.getSimulationConditions().getLaunchRodLength()) { addEvent(new FlightEvent(FlightEvent.Type.LAUNCHROD, status.getSimulationTime(), null)); } // Check for apogee if (!status.isApogeeReached() && status.getRocketPosition().z < maxAlt - 0.01) { addEvent( new FlightEvent( FlightEvent.Type.APOGEE, status.getSimulationTime(), status.getConfiguration().getRocket())); } // Check for burnt out motors for (MotorId motorId : status.getMotorConfiguration().getMotorIDs()) { MotorInstance motor = status.getMotorConfiguration().getMotorInstance(motorId); if (!motor.isActive() && motorBurntOut.add(motorId)) { addEvent( new FlightEvent( FlightEvent.Type.BURNOUT, status.getSimulationTime(), (RocketComponent) status.getMotorConfiguration().getMotorMount(motorId), motorId)); } } } } catch (SimulationException e) { SimulationListenerHelper.fireEndSimulation(status, e); throw e; } SimulationListenerHelper.fireEndSimulation(status, null); flightData.addBranch(status.getFlightData()); if (!flightData.getWarningSet().isEmpty()) { log.info("Warnings at the end of simulation: " + flightData.getWarningSet()); } // TODO: HIGH: Simulate branches return flightData; }