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>
30 #include <stdlib.h> // for exit()
35 #include <simgear/fg_zlib.h>
36 #include <simgear/debug/logstream.hxx>
37 #include <simgear/misc/fgstream.hxx>
39 #include "interpolater.hxx"
42 // Constructor -- loads the interpolation table from the specified
44 fgINTERPTABLE::fgINTERPTABLE( const string& file ) {
45 FG_LOG( FG_MATH, FG_INFO, "Initializing Interpolator for " << file );
47 fg_gzifstream in( file );
49 FG_LOG( FG_GENERAL, FG_ALERT, "Cannot open file: " << file );
56 if ( size < MAX_TABLE_SIZE ) {
57 in >> table[size][0] >> table[size][1];
60 FG_LOG( FG_MATH, FG_ALERT,
61 "fgInterpolateInit(): Exceed max table size = "
69 // Given an x value, linearly interpolate the y value from the table
70 double fgINTERPTABLE::interpolate(double x) {
76 while ( (x > table[i][0]) && (i < size) ) {
80 // printf ("i = %d ", i);
82 if ( (i == 0) && (x < table[0][0]) ) {
83 FG_LOG( FG_MATH, FG_ALERT,
84 "fgInterpolateInit(): lookup error, x to small = " << x );
88 if ( x > table[i][0] ) {
89 FG_LOG( FG_MATH, FG_ALERT,
90 "fgInterpolateInit(): lookup error, x to big = " << x );
94 // y = y1 + (y0 - y1)(x - x1) / (x0 - x1)
96 ( (table[i-1][1] - table[i][1]) *
98 (table[i-1][0] - table[i][0]);
105 fgINTERPTABLE::~fgINTERPTABLE( void ) {