2 // interpolater.cxx -- routines to handle linear interpolation from a table of
3 // x,y The table must be sorted by "x" in ascending order
5 // Written by Curtis Olson, started April 1998.
7 // Copyright (C) 1998 Curtis L. Olson - curt@me.umn.edu
9 // This library is free software; you can redistribute it and/or
10 // modify it under the terms of the GNU Library General Public
11 // License as published by the Free Software Foundation; either
12 // version 2 of the License, or (at your option) any later version.
14 // This library is distributed in the hope that it will be useful,
15 // but WITHOUT ANY WARRANTY; without even the implied warranty of
16 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 // Library General Public License for more details.
19 // You should have received a copy of the GNU Library General Public
20 // License along with this library; if not, write to the
21 // Free Software Foundation, Inc., 59 Temple Place - Suite 330,
22 // Boston, MA 02111-1307, USA.
27 #include <simgear/compiler.h>
29 #include <stdlib.h> // for exit()
33 // depricated - #include <simgear/sg_zlib.h>
34 #include <simgear/debug/logstream.hxx>
35 #include <simgear/misc/sgstream.hxx>
37 #include "interpolater.hxx"
41 // Constructor -- starts with an empty table.
42 SGInterpTable::SGInterpTable()
48 // Constructor -- loads the interpolation table from the specified
50 SGInterpTable::SGInterpTable( const string& file )
53 SG_LOG( SG_MATH, SG_INFO, "Initializing Interpolator for " << file );
55 sg_gzifstream in( file );
56 if ( !in.is_open() ) {
57 SG_LOG( SG_GENERAL, SG_ALERT, "Cannot open file: " << file );
66 table.push_back(Entry(ind, dep));
72 // Add an entry to the table.
73 void SGInterpTable::addEntry (double ind, double dep)
75 table.push_back(Entry(ind,dep));
80 // Given an x value, linearly interpolate the y value from the table
81 double SGInterpTable::interpolate(double x) const
92 while ( (i < size) && (x > table[i].ind) ) {
93 // cout << " i = " << i << " table[i].ind = " << table[i].ind << endl;
94 // cout << " size = " << size << endl;
98 // printf ("i = %d ", i);
101 SG_LOG( SG_MATH, SG_DEBUG,
102 "interpolate(): lookup error, x to small = " << x );
106 // cout << " table[size-1].ind = " << table[size-1].ind << endl;
108 SG_LOG( SG_MATH, SG_DEBUG,
109 "interpolate(): lookup error, x to big = " << x );
110 return table[size-1].dep;
113 // y = y1 + (y0 - y1)(x - x1) / (x0 - x1)
115 ( (table[i-1].dep - table[i].dep) *
116 (x - table[i].ind) ) /
117 (table[i-1].ind - table[i].ind);
124 SGInterpTable::~SGInterpTable() {