hongshaorou/openrocket
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Add SimulationStatus.storeData() method to save status data

Browse Source
This commit is contained in:
JoePfeiffer 2024-06-04 12:23:58 -06:00
parent 6e0c6b187a
commit f8d6cdd628
1 changed files with 34 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

34
core/src/main/java/info/openrocket/core/simulation/SimulationStatus.java
View File

@ -20,6 +20,7 @@ import info.openrocket.core.simulation.exception.SimulationException;
import info.openrocket.core.simulation.listeners.SimulationListenerHelper;
import info.openrocket.core.util.BugException;
import info.openrocket.core.util.Coordinate;
import info.openrocket.core.util.MathUtil;
import info.openrocket.core.util.Monitorable;
import info.openrocket.core.util.MonitorableSet;
import info.openrocket.core.util.Quaternion;
@ -516,6 +517,39 @@ public class SimulationStatus implements Monitorable {
}
}
/**
* Store data from current sim status
*/
public void storeData() {
flightDataBranch.setValue(FlightDataType.TYPE_TIME, getSimulationTime());
flightDataBranch.setValue(FlightDataType.TYPE_ALTITUDE, getRocketPosition().z);
flightDataBranch.setValue(FlightDataType.TYPE_POSITION_X, getRocketPosition().x);
flightDataBranch.setValue(FlightDataType.TYPE_POSITION_Y, getRocketPosition().y);
flightDataBranch.setValue(FlightDataType.TYPE_LATITUDE, getRocketWorldPosition().getLatitudeRad());
flightDataBranch.setValue(FlightDataType.TYPE_LONGITUDE, getRocketWorldPosition().getLongitudeRad());
flightDataBranch.setValue(FlightDataType.TYPE_POSITION_XY,
MathUtil.hypot(getRocketPosition().x, getRocketPosition().y));
flightDataBranch.setValue(FlightDataType.TYPE_POSITION_DIRECTION,
Math.atan2(getRocketPosition().y, getRocketPosition().x));
flightDataBranch.setValue(FlightDataType.TYPE_VELOCITY_XY,
MathUtil.hypot(getRocketVelocity().x, getRocketVelocity().y));
flightDataBranch.setValue(FlightDataType.TYPE_VELOCITY_Z, getRocketVelocity().z);
flightDataBranch.setValue(FlightDataType.TYPE_VELOCITY_TOTAL, getRocketVelocity().length());
Coordinate c = getRocketOrientationQuaternion().rotateZ();
double theta = Math.atan2(c.z, MathUtil.hypot(c.x, c.y));
double phi = Math.atan2(c.y, c.x);
if (phi < -(Math.PI - 0.0001))
phi = Math.PI;
flightDataBranch.setValue(FlightDataType.TYPE_ORIENTATION_THETA, theta);
flightDataBranch.setValue(FlightDataType.TYPE_ORIENTATION_PHI, phi);
flightDataBranch.setValue(FlightDataType.TYPE_COMPUTATION_TIME,
(System.nanoTime() - getSimulationStartWallTime()) / 1000000000.0);
}
/**
* Add a flight event to the event queue unless a listener aborts adding it.
*