From 36183cbc3d56507c0878d958892a2c9768e3c719 Mon Sep 17 00:00:00 2001 From: tony Date: Thu, 17 Jul 2003 02:32:39 +0000 Subject: [PATCH] Make initTheta() use the results of the search it performs. --- src/FDM/JSBSim/FGTrimAxis.cpp | 26 +++++++++++++------------- 1 file changed, 13 insertions(+), 13 deletions(-) diff --git a/src/FDM/JSBSim/FGTrimAxis.cpp b/src/FDM/JSBSim/FGTrimAxis.cpp index 8a1b024d0..e41f7af3c 100644 --- a/src/FDM/JSBSim/FGTrimAxis.cpp +++ b/src/FDM/JSBSim/FGTrimAxis.cpp @@ -323,22 +323,22 @@ bool FGTrimAxis::initTheta(void) { level=false; theta=fgic->GetPitchAngleDegIC(); while(!level && (i < 100)) { - theta+=2.0*zDiff; - fgic->SetPitchAngleDegIC(theta); - fdmex->RunIC(); - zAft=fdmex->GetGroundReactions()->GetGearUnit(1)->GetLocalGear(3); - zForward=fdmex->GetGroundReactions()->GetGearUnit(0)->GetLocalGear(3); - zDiff = zForward - zAft; - //cout << endl << theta << " " << zDiff << endl; - //cout << "0: " << fdmex->GetGroundReactions()->GetGearUnit(0)->GetLocalGear() << endl; - //cout << "1: " << fdmex->GetGroundReactions()->GetGearUnit(1)->GetLocalGear() << endl; - - if(fabs(zDiff ) < 0.1) - level=true; - i++; + theta+=2.0*zDiff; + fgic->SetPitchAngleDegIC(theta); + fdmex->RunIC(); + zAft=fdmex->GetGroundReactions()->GetGearUnit(iAft)->GetLocalGear(3); + zForward=fdmex->GetGroundReactions()->GetGearUnit(iForward)->GetLocalGear(3); + zDiff = zForward - zAft; + //cout << endl << theta << " " << zDiff << endl; + //cout << "0: " << fdmex->GetGroundReactions()->GetGearUnit(0)->GetLocalGear() << endl; + //cout << "1: " << fdmex->GetGroundReactions()->GetGearUnit(1)->GetLocalGear() << endl; + if(fabs(zDiff ) < 0.1) + level=true; + i++; } //cout << i << endl; cout << " Initial Theta: " << fdmex->GetRotation()->Gettht()*radtodeg << endl; + cout << " Used gear unit " << iAft << " as aft and " << iForward << " as forward" << endl; control_min=(theta+5)*degtorad; control_max=(theta-5)*degtorad; fgic->SetAltitudeAGLFtIC(saveAlt); -- 2.39.5