Sirikata
|
00001 /* Sirikata 00002 * SqrIntegral.hpp 00003 * 00004 * Copyright (c) 2010, Daniel Reiter Horn 00005 * All rights reserved. 00006 * 00007 * Redistribution and use in source and binary forms, with or without 00008 * modification, are permitted provided that the following conditions are 00009 * met: 00010 * * Redistributions of source code must retain the above copyright 00011 * notice, this list of conditions and the following disclaimer. 00012 * * Redistributions in binary form must reproduce the above copyright 00013 * notice, this list of conditions and the following disclaimer in 00014 * the documentation and/or other materials provided with the 00015 * distribution. 00016 * * Neither the name of Sirikata nor the names of its contributors may 00017 * be used to endorse or promote products derived from this software 00018 * without specific prior written permission. 00019 * 00020 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS 00021 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 00022 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A 00023 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER 00024 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 00025 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 00026 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 00027 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 00028 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 00029 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 00030 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00031 */ 00032 00033 #include <sirikata/core/util/Platform.hpp> 00034 00035 namespace Sirikata { 00036 class SqrIntegral { 00037 enum {MAX_CACHE=2}; 00038 double cachedCutoff[MAX_CACHE]; 00039 double cachedDimensions[MAX_CACHE][2]; 00040 double cachedFlatness[MAX_CACHE]; 00041 double infiniteIntegral[MAX_CACHE]; 00042 bool normalize; 00043 void *gsl_rng_r; 00044 void *gsl_monte_plane_state_s; 00045 static bool approxEqual(double a, double b) { 00046 double eps=1.0e-6; 00047 if (a>b) { 00048 return a-b<eps; 00049 } 00050 return b-a<eps; 00051 } 00052 public: 00053 SqrIntegral(bool normalize); 00054 typedef double result_type; 00055 double integrate(double cutoff, double flatness,const Vector3d&xymin, const Vector3d&xymax, const Vector3d &uvmin, const Vector3d &uvmax, double*error); 00056 double computeWithGivenCutoff(int whichCutoff,const Vector3d&xymin, const Vector3d&xymax, const Vector3d &uvmin, const Vector3d &uvmax); 00057 double computeInfiniteIntegral(int whichCutoff); 00058 double operator()(float cutoff, float flatness, const Vector3d&xymin, const Vector3d&xymax, const Vector3d &uvmin, const Vector3d &uvmax){ 00059 double deltaLocation=(((xymin+xymax)-(uvmin+uvmax))*.5).length(); 00060 deltaLocation/=flatness; 00061 deltaLocation+=cutoff; 00062 if (deltaLocation<2.7) deltaLocation=2.7; 00063 double logLocDelta=deltaLocation*log(deltaLocation); 00064 double r1=(xymax-xymin).length(); 00065 double r2=(uvmax-uvmin).length(); 00066 return 2.*r1*r2/(logLocDelta*logLocDelta); 00067 } 00068 00069 }; 00070 }