src/gromacs/gmxana/correl.c

   1 /*
   2  * This file is part of the GROMACS molecular simulation package.
   3  *
   4  * Copyright (c) 1991-2000, University of Groningen, The Netherlands.
   5  * Copyright (c) 2001-2008, The GROMACS development team.
   6  * Copyright (c) 2013,2014, by the GROMACS development team, led by
   7  * Mark Abraham, David van der Spoel, Berk Hess, and Erik Lindahl,
   8  * and including many others, as listed in the AUTHORS file in the
   9  * top-level source directory and at http://www.gromacs.org.
  10  *
  11  * GROMACS is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU Lesser General Public License
  13  * as published by the Free Software Foundation; either version 2.1
  14  * of the License, or (at your option) any later version.
  15  *
  16  * GROMACS is distributed in the hope that it will be useful,
  17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  19  * Lesser General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU Lesser General Public
  22  * License along with GROMACS; if not, see
  23  * http://www.gnu.org/licenses, or write to the Free Software Foundation,
  24  * Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA.
  25  *
  26  * If you want to redistribute modifications to GROMACS, please
  27  * consider that scientific software is very special. Version
  28  * control is crucial - bugs must be traceable. We will be happy to
  29  * consider code for inclusion in the official distribution, but
  30  * derived work must not be called official GROMACS. Details are found
  31  * in the README & COPYING files - if they are missing, get the
  32  * official version at http://www.gromacs.org.
  33  *
  34  * To help us fund GROMACS development, we humbly ask that you cite
  35  * the research papers on the package. Check out http://www.gromacs.org.
  36  */
  37
  38 #include "gmxpre.h"
  39
  40 #include "correl.h"
  41
  42 #include <math.h>
  43 #include <stdio.h>
  44 #include <stdlib.h>
  45
  46 #include "gromacs/fft/fft.h"
  47 #include "gromacs/utility/smalloc.h"
  48
  49 #define SWAP(a, b) tempr = (a); (a) = (b); (b) = tempr
  50
  51 void four1(real data[], int nn, int isign)
  52 {
  53     int    n, mmax, m, j, istep, i;
  54     double wtemp, wr, wpr, wpi, wi, theta;
  55     real   tempr, tempi;
  56
  57     n = nn << 1;
  58     j = 1;
  59     for (i = 1; i < n; i += 2)
  60     {
  61         if (j > i)
  62         {
  63             SWAP(data[j], data[i]);
  64             SWAP(data[j+1], data[i+1]);
  65         }
  66         m = n >> 1;
  67         while (m >= 2 && j > m)
  68         {
  69             j  -= m;
  70             m >>= 1;
  71         }
  72         j += m;
  73     }
  74     mmax = 2;
  75     while (n > mmax)
  76     {
  77         istep = 2*mmax;
  78         theta = 6.28318530717959/(isign*mmax);
  79         wtemp = sin(0.5*theta);
  80         wpr   = -2.0*wtemp*wtemp;
  81         wpi   = sin(theta);
  82         wr    = 1.0;
  83         wi    = 0.0;
  84         for (m = 1; m < mmax; m += 2)
  85         {
  86             for (i = m; i <= n; i += istep)
  87             {
  88                 j          = i+mmax;
  89                 tempr      = wr*data[j]-wi*data[j+1];
  90                 tempi      = wr*data[j+1]+wi*data[j];
  91                 data[j]    = data[i]-tempr;
  92                 data[j+1]  = data[i+1]-tempi;
  93                 data[i]   += tempr;
  94                 data[i+1] += tempi;
  95             }
  96             wr = (wtemp = wr)*wpr-wi*wpi+wr;
  97             wi = wi*wpr+wtemp*wpi+wi;
  98         }
  99         mmax = istep;
 100     }
 101 }
 102
 103 #undef SWAP
 104
 105 static void realft(real data[], int n, int isign)
 106 {
 107     int    i, i1, i2, i3, i4, n2p3;
 108     real   c1 = 0.5, c2, h1r, h1i, h2r, h2i;
 109     double wr, wi, wpr, wpi, wtemp, theta;
 110
 111     theta = 3.141592653589793/(double) n;
 112     if (isign == 1)
 113     {
 114         c2 = -0.5;
 115         four1(data, n, 1);
 116     }
 117     else
 118     {
 119         c2    = 0.5;
 120         theta = -theta;
 121     }
 122     wtemp = sin(0.5*theta);
 123     wpr   = -2.0*wtemp*wtemp;
 124     wpi   = sin(theta);
 125     wr    = 1.0+wpr;
 126     wi    = wpi;
 127     n2p3  = 2*n+3;
 128     for (i = 2; i <= n/2; i++)
 129     {
 130         i4       = 1+(i3 = n2p3-(i2 = 1+(i1 = i+i-1)));
 131         h1r      = c1*(data[i1]+data[i3]);
 132         h1i      = c1*(data[i2]-data[i4]);
 133         h2r      = -c2*(data[i2]+data[i4]);
 134         h2i      = c2*(data[i1]-data[i3]);
 135         data[i1] = h1r+wr*h2r-wi*h2i;
 136         data[i2] = h1i+wr*h2i+wi*h2r;
 137         data[i3] = h1r-wr*h2r+wi*h2i;
 138         data[i4] = -h1i+wr*h2i+wi*h2r;
 139         wr       = (wtemp = wr)*wpr-wi*wpi+wr;
 140         wi       = wi*wpr+wtemp*wpi+wi;
 141     }
 142     if (isign == 1)
 143     {
 144         data[1] = (h1r = data[1])+data[2];
 145         data[2] = h1r-data[2];
 146     }
 147     else
 148     {
 149         data[1] = c1*((h1r = data[1])+data[2]);
 150         data[2] = c1*(h1r-data[2]);
 151         four1(data, n, -1);
 152     }
 153 }
 154
 155 static void twofft(real data1[], real data2[], real fft1[], real fft2[], int n)
 156 {
 157     int  nn3, nn2, jj, j;
 158     real rep, rem, aip, aim;
 159
 160     nn3 = 1+(nn2 = 2+n+n);
 161     for (j = 1, jj = 2; j <= n; j++, jj += 2)
 162     {
 163         fft1[jj-1] = data1[j];
 164         fft1[jj]   = data2[j];
 165     }
 166     four1(fft1, n, 1);
 167     fft2[1] = fft1[2];
 168     fft1[2] = fft2[2] = 0.0;
 169     for (j = 3; j <= n+1; j += 2)
 170     {
 171         rep         = 0.5*(fft1[j]+fft1[nn2-j]);
 172         rem         = 0.5*(fft1[j]-fft1[nn2-j]);
 173         aip         = 0.5*(fft1[j+1]+fft1[nn3-j]);
 174         aim         = 0.5*(fft1[j+1]-fft1[nn3-j]);
 175         fft1[j]     = rep;
 176         fft1[j+1]   = aim;
 177         fft1[nn2-j] = rep;
 178         fft1[nn3-j] = -aim;
 179         fft2[j]     = aip;
 180         fft2[j+1]   = -rem;
 181         fft2[nn2-j] = aip;
 182         fft2[nn3-j] = rem;
 183     }
 184 }
 185
 186 void correl(real data1[], real data2[], int n, real ans[])
 187 {
 188     int     no2, i;
 189     real    dum, *fft;
 190
 191     snew(fft, 2*n+1);
 192     twofft(data1, data2, fft, ans, n);
 193     no2 = n/2;
 194     for (i = 2; i <= n+2; i += 2)
 195     {
 196         dum      = ans[i-1];
 197         ans[i-1] = (fft[i-1]*dum+fft[i]*ans[i])/no2;
 198         ans[i]   = (fft[i]*dum-fft[i-1]*ans[i])/no2;
 199     }
 200     ans[2] = ans[n+1];
 201     realft(ans, no2, -1);
 202     sfree(fft);
 203 }