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

[fix] MassCalculator now accounts for rotation in Component Assembly Instance Trees

Browse Source
This commit is contained in:
Daniel_M_Williams 2020-05-03 12:10:08 -04:00
parent 91652e7e4f
commit cce900d408
2 changed files with 459 additions and 395 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

52
core/src/net/sf/openrocket/masscalc/MassCalculation.java
View File

@ -266,19 +266,26 @@ public class MassCalculation {
final RocketComponent component = this.root;
final Transformation parentTransform = this.transform;
final int instanceCount = component.getInstanceCount();
Coordinate[] instanceLocations = component.getInstanceLocations();
// // vvv DEBUG
// if( this.config.isComponentActive(component) ){
// System.err.println(String.format( "%s[%s]....", prefix, component.getName()));
// }
final Coordinate[] allInstanceOffsets = component.getInstanceLocations();
final double[] allInstanceAngles = component.getInstanceAngles();
// // vvv DEBUG
// if( this.config.isComponentActive(component) ){
// System.err.println(String.format( "%s>>[%s]....", prefix, component.getName()));
// }
// iterate over the aggregated instances for the whole tree.
MassCalculation children = this.copy(component, parentTransform );
for( int instanceNumber = 0; instanceNumber < instanceCount; ++instanceNumber) {
Coordinate currentLocation = instanceLocations[instanceNumber];
Transformation currentTransform = parentTransform.applyTransformation( Transformation.getTranslationTransform( currentLocation ));
for( int currentInstanceNumber = 0; currentInstanceNumber < instanceCount; ++currentInstanceNumber) {
final Coordinate currentInstanceOffset = allInstanceOffsets[currentInstanceNumber];
final Transformation offsetTransform = Transformation.getTranslationTransform( currentInstanceOffset );
final double currentInstanceAngle = allInstanceAngles[currentInstanceNumber];
final Transformation angleTransform = Transformation.getAxialRotation(currentInstanceAngle);
final Transformation currentTransform = parentTransform.applyTransformation(offsetTransform)
.applyTransformation(angleTransform);
for (RocketComponent child : component.getChildren()) {
// child data, relative to rocket reference frame
MassCalculation eachChild = copy( child, currentTransform);
@ -293,8 +300,8 @@ public class MassCalculation {
if( 0 < children.getMass() ) {
this.merge( children );
// // vvv DEBUG
// System.err.println(String.format( "%s....assembly mass (incl/children): %s", prefix, this.toCMDebug()));
// // vvv DEBUG
// System.err.println(String.format( "%s....assembly mass (incl/children): %s", prefix, this.toCMDebug()));
}
if (this.config.isComponentActive(component) ){
@ -302,8 +309,9 @@ public class MassCalculation {
if (!component.getOverrideSubcomponents()) {
if (component.isMassOverridden()) {
// System.err.println("mass override=" + component.getOverrideMass());
compCM = compCM.setWeight(MathUtil.max(component.getOverrideMass(), MIN_MASS));
// // vvv DEBUG
// System.err.println(String.format( "%s....mass overridden to: %s", prefix, compCM.toPreciseString()));
}
if (component.isCGOverridden())
compCM = compCM.setXYZ(component.getOverrideCG());
@ -318,10 +326,10 @@ public class MassCalculation {
RigidBody componentInertia = new RigidBody( compCM, compIx, compIt, compIt );
this.addInertia( componentInertia );
// vvv DEBUG
// if( 0 < compCM.weight ) {
// System.err.println(String.format( "%s....componentData: %s", prefix, compCM.toPreciseString() ));
// }
// // vvv DEBUG
// if( 0 < compCM.weight ) {
// System.err.println(String.format( "%s....componentData: %s", prefix, compCM.toPreciseString() ));
// }
if (component.getOverrideSubcomponents()) {
if (component.isMassOverridden()) {
@ -337,11 +345,11 @@ public class MassCalculation {
}
}
// // vvv DEBUG
// if( this.config.isComponentActive(component) && 0 < this.getMass() ) {
// System.err.println(String.format( "%s....<< return assemblyData: %s (tree @%s)", prefix, this.toCMDebug(), component.getName() ));
// }
// // ^^^ DEBUG
// // vvv DEBUG
// if( this.config.isComponentActive(component) && 0 < this.getMass() ) {
// System.err.println(String.format( "%s....<< return data @ %s: %s", prefix, component.getName(), this.toCMDebug() ));
// }
// // ^^^ DEBUG
return this;
}

802
core/test/net/sf/openrocket/masscalc/MassCalculatorTest.java
View File

File diff suppressed because it is too large Load Diff