-/*******************************************************************************
+/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
Module: FGCoefficient.cpp
Author: Jon S. Berndt
--------------------------------------------------------------------------------
12/28/98 JSB Created
-********************************************************************************
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
INCLUDES
-*******************************************************************************/
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
#include "FGCoefficient.h"
#include "FGState.h"
#include "FGFDMExec.h"
-/*******************************************************************************
-************************************ CODE **************************************
-*******************************************************************************/
+#include <iomanip.h>
+
+static const char *IdSrc = "$Header$";
+static const char *IdHdr = "ID_COEFFICIENT";
+
+/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
+CLASS IMPLEMENTATION
+%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
FGCoefficient::FGCoefficient(FGFDMExec* fdex, FGConfigFile* AC_cfg)
{
int r, c, start, end, n;
float ftrashcan;
string multparms;
-
+ char nullstring[13] = " ";
+
+ bias =0.0;
+ gain = 1.0;
+
FDMExec = fdex;
State = FDMExec->GetState();
+ Table = 0;
if (AC_cfg) {
name = AC_cfg->GetValue("NAME");
AC_cfg->GetNextConfigLine();
*AC_cfg >> description;
- cout << " " << name << endl;
+ char bolden[5];
+ char unbolden[5];
+
+ bolden[0] = 27;
+ bolden[1] = '[';
+ bolden[2] = '1';
+ bolden[3] = 'm';
+ bolden[4] = '\0';
+
+ unbolden[0] = 27;
+ unbolden[1] = '[';
+ unbolden[2] = '0';
+ unbolden[3] = 'm';
+ unbolden[4] = '\0';
+
+ cout << " " << bolden << name << unbolden << endl;
cout << " " << description << endl;
cout << " " << method << endl;
cout << endl;
*AC_cfg >> multparms;
- if (multparms.substr(0,1) == "F") {
- LookupR = State->GetParameterIndex(multparms);
- cout << " Row indexing parameter: " << multparms << endl;
- } else {
- LookupR = atoi(multparms.c_str());
- cout << " Row indexing parameter: " << LookupR << endl;
- }
-
+ LookupR = State->GetParameterIndex(multparms);
+ cout << " Row indexing parameter: " << multparms << endl;
}
if (type == TABLE) {
*AC_cfg >> multparms;
- if (multparms.substr(0,1) == "F") {
- LookupR = State->GetParameterIndex(multparms);
- cout << " Column indexing parameter: " << multparms << endl;
- } else {
- LookupC = atoi(multparms.c_str());
- cout << " Column indexing parameter: " << LookupC << endl;
- }
+ LookupC = State->GetParameterIndex(multparms);
+ cout << " Column indexing parameter: " << multparms << endl;
}
// Here, read in the line of the form (e.g.) FG_MACH|FG_QBAR|FG_ALPHA
end = multparms.length();
n = multparms.find("|");
- start = mult_count = multipliers = 0;
+ start = 0;
- while(n < end && n >= 0) {
+ while (n < end && n >= 0) {
n -= start;
- mult_idx[mult_count] = State->GetParameterIndex(multparms.substr(start,n));
- multipliers += mult_idx[mult_count];
- mult_count++;
+ multipliers.push_back(State->GetParameterIndex(multparms.substr(start,n)));
start += n+1;
n = multparms.find("|",start);
}
- mult_idx[mult_count] = State->GetParameterIndex(multparms.substr(start,n));
- multipliers += mult_idx[mult_count];
- mult_count++;
+
+ multipliers.push_back(State->GetParameterIndex(multparms.substr(start,n)));
// End of non-dimensionalizing parameter read-in
Allocate(rows,2);
for (r=1;r<=rows;r++) {
- *AC_cfg >> Table3D[r][0];
- *AC_cfg >> Table3D[r][1];
+ *AC_cfg >> Table[r][0];
+ *AC_cfg >> Table[r][1];
}
for (r=1;r<=rows;r++) {
cout << " ";
for (c=0;c<columns;c++) {
- cout << Table3D[r][c] << " ";
+ cout << Table[r][c] << " ";
}
cout << endl;
}
case TABLE:
Allocate(rows, columns);
- Table3D[0][0] = 0.0;
- for (c=1;c<=columns;c++) {
- *AC_cfg >> Table3D[0][c];
+ Table[0][0] = 0.0;
+
+ // Read the table in -- it should be in matrix format with the row
+ // independents as the first column and the column independents in
+ // the first row. The implication of this layout is that there should
+ // be no value in the upper left corner of the matrix e.g:
+ // 0 10 20 30 ...
+ // -5 1 2 3 4 ...
+ // ...
+
+ for (r=0; r<=rows; r++) {
+ for (c=0; c <= columns; c++) {
+ if ( !((r == 0) && (c == 0)) ) {
+ *AC_cfg >> Table[r][c];
+ }
+ }
+ }
+
+ /* for (c=1;c<=columns;c++) {
+ *AC_cfg >> Table[0][c];
for (r=1;r<=rows;r++) {
- if ( c==1 ) *AC_cfg >> Table3D[r][0];
+ if ( c==1 ) *AC_cfg >> Table[r][0];
else *AC_cfg >> ftrashcan;
- *AC_cfg >> Table3D[r][c];
+ *AC_cfg >> Table[r][c];
}
- }
-
+ } */
+
for (r=0;r<=rows;r++) {
cout << " ";
for (c=0;c<=columns;c++) {
- cout << Table3D[r][c] << " ";
+ if( ((r == 0) && (c == 0)) ) {
+ cout << nullstring;
+ } else {
+ cout.flags(ios::left);
+ cout << setw(12) << Table[r][c];
+ }
}
cout << endl;
}
break;
+ case EQUATION:
+ case UNKNOWN:
+ cerr << "Unimplemented coefficient type: " << type << endl;
+ break;
}
AC_cfg->GetNextConfigLine();
}
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-FGCoefficient::~FGCoefficient(void)
-{
+FGCoefficient::~FGCoefficient(void) {
+ DeAllocate();
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-bool FGCoefficient::Allocate(int r, int c)
+bool FGCoefficient::DeAllocate(void)
{
- rows = r;
- columns = c;
- Table3D = new float*[r+1];
- for (int i=0;i<=r;i++) Table3D[i] = new float[c+1];
+ if (Table != NULL ) {
+ for (unsigned int i=0; i<=rows; i++) delete[] Table[i];
+
+ delete[] Table;
+ }
+
return true;
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-bool FGCoefficient::Allocate(int n)
+bool FGCoefficient::Allocate(int r, int c)
{
- rows = n;
- columns = 0;
- Table2D = new float[n+1];
+ rows = r;
+ columns = c;
+ Table = new float*[r+1];
+ for (int i=0;i<=r;i++) Table[i] = new float[c+1];
return true;
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
float FGCoefficient::Value(float rVal, float cVal)
{
float rFactor, cFactor, col1temp, col2temp, Value;
- int r, c, midx;
+ int r, c;
+ unsigned midx;
if (rows < 2 || columns < 2) return 0.0;
- for (r=1;r<=rows;r++) if (Table3D[r][0] >= rVal) break;
- for (c=1;c<=columns;c++) if (Table3D[0][c] >= cVal) break;
-
+ for (r=1;r<=rows;r++) if (Table[r][0] >= rVal) break;
+ for (c=1;c<=columns;c++) if (Table[0][c] >= cVal) break;
+ //cout << "Value(): rVal: " << rVal << " cVal: " << cVal << endl;
+ //cout << "Value(): r: " << r << " c: " << c << endl;
c = c < 2 ? 2 : (c > columns ? columns : c);
r = r < 2 ? 2 : (r > rows ? rows : r);
- rFactor = (rVal - Table3D[r-1][0]) / (Table3D[r][0] - Table3D[r-1][0]);
- cFactor = (cVal - Table3D[0][c-1]) / (Table3D[0][c] - Table3D[0][c-1]);
+ rFactor = (rVal - Table[r-1][0]) / (Table[r][0] - Table[r-1][0]);
+ cFactor = (cVal - Table[0][c-1]) / (Table[0][c] - Table[0][c-1]);
- col1temp = rFactor*(Table3D[r][c-1] - Table3D[r-1][c-1]) + Table3D[r-1][c-1];
- col2temp = rFactor*(Table3D[r][c] - Table3D[r-1][c]) + Table3D[r-1][c];
+ col1temp = rFactor*(Table[r][c-1] - Table[r-1][c-1]) + Table[r-1][c-1];
+ col2temp = rFactor*(Table[r][c] - Table[r-1][c]) + Table[r-1][c];
- SD = Value = col1temp + cFactor*(col2temp - col1temp);
-
- for (midx=0;midx<mult_count;midx++) {
- Value *= State->GetParameter(mult_idx[midx]);
+ Value = col1temp + cFactor*(col2temp - col1temp);
+ Value = (Value + bias)*gain;
+ SD = Value;
+
+ for (midx=0; midx < multipliers.size(); midx++) {
+ Value *= State->GetParameter(multipliers[midx]);
}
return Value;
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
float FGCoefficient::Value(float Val)
{
+
+
float Factor, Value;
- int r, midx;
+ int r;
+ unsigned midx;
if (rows < 2) return 0.0;
- for (r=1;r<=rows;r++) if (Table3D[r][0] >= Val) break;
+ for (r=1;r<=rows;r++) if (Table[r][0] >= Val) break;
r = r < 2 ? 2 : (r > rows ? rows : r);
// make sure denominator below does not go to zero.
- if (Table3D[r][0] != Table3D[r-1][0]) {
- Factor = (Val - Table3D[r-1][0]) / (Table3D[r][0] - Table3D[r-1][0]);
+ if (Table[r][0] != Table[r-1][0]) {
+ Factor = (Val - Table[r-1][0]) / (Table[r][0] - Table[r-1][0]);
} else {
Factor = 1.0;
}
- SD = Value = Factor*(Table3D[r][1] - Table3D[r-1][1]) + Table3D[r-1][1];
+ Value = Factor*(Table[r][1] - Table[r-1][1]) + Table[r-1][1];
+ Value = (Value + bias)*gain;
+ SD = Value;
+
+ for (midx=0; midx < multipliers.size(); midx++) {
+ Value *= State->GetParameter(multipliers[midx]);
- for (midx=0;midx<mult_count;midx++) {
- Value *= State->GetParameter(mult_idx[midx]);
}
return Value;
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
float FGCoefficient::Value(void)
{
float Value;
- int midx;
+ unsigned midx;
- SD = Value = StaticValue;
+ Value = StaticValue;
+ Value = (Value + bias)*gain;
+ SD = Value;
- for (midx=0;midx<mult_count;midx++) {
- Value *= State->GetParameter(mult_idx[midx]);
+ for (midx=0; midx < multipliers.size(); midx++) {
+ Value *= State->GetParameter(multipliers[midx]);
}
return Value;
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
float FGCoefficient::TotalValue()
{
return 0;
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
void FGCoefficient::DumpSD(void)
{
cout << " " << name << ": " << SD << endl;
}
-/******************************************************************************/
+//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
projects / flightgear.git / blobdiff