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 <stdio.h>
  41 #include <stdlib.h>
  42 #include <math.h>
  43
  44 #include "gromacs/fft/fft.h"
  45 #include "gromacs/utility/smalloc.h"
  46 #include "correl.h"
  47
  48 #define SWAP(a, b) tempr = (a); (a) = (b); (b) = tempr
  49
  50 void four1(real data[], int nn, int isign)
  51 {
  52     int    n, mmax, m, j, istep, i;
  53     double wtemp, wr, wpr, wpi, wi, theta;
  54     real   tempr, tempi;
  55
  56     n = nn << 1;
  57     j = 1;
  58     for (i = 1; i < n; i += 2)
  59     {
  60         if (j > i)
  61         {
  62             SWAP(data[j], data[i]);
  63             SWAP(data[j+1], data[i+1]);
  64         }
  65         m = n >> 1;
  66         while (m >= 2 && j > m)
  67         {
  68             j  -= m;
  69             m >>= 1;
  70         }
  71         j += m;
  72     }
  73     mmax = 2;
  74     while (n > mmax)
  75     {
  76         istep = 2*mmax;
  77         theta = 6.28318530717959/(isign*mmax);
  78         wtemp = sin(0.5*theta);
  79         wpr   = -2.0*wtemp*wtemp;
  80         wpi   = sin(theta);
  81         wr    = 1.0;
  82         wi    = 0.0;
  83         for (m = 1; m < mmax; m += 2)
  84         {
  85             for (i = m; i <= n; i += istep)
  86             {
  87                 j          = i+mmax;
  88                 tempr      = wr*data[j]-wi*data[j+1];
  89                 tempi      = wr*data[j+1]+wi*data[j];
  90                 data[j]    = data[i]-tempr;
  91                 data[j+1]  = data[i+1]-tempi;
  92                 data[i]   += tempr;
  93                 data[i+1] += tempi;
  94             }
  95             wr = (wtemp = wr)*wpr-wi*wpi+wr;
  96             wi = wi*wpr+wtemp*wpi+wi;
  97         }
  98         mmax = istep;
  99     }
 100 }
 101
 102 #undef SWAP
 103
 104 static void realft(real data[], int n, int isign)
 105 {
 106     int    i, i1, i2, i3, i4, n2p3;
 107     real   c1 = 0.5, c2, h1r, h1i, h2r, h2i;
 108     double wr, wi, wpr, wpi, wtemp, theta;
 109
 110     theta = 3.141592653589793/(double) n;
 111     if (isign == 1)
 112     {
 113         c2 = -0.5;
 114         four1(data, n, 1);
 115     }
 116     else
 117     {
 118         c2    = 0.5;
 119         theta = -theta;
 120     }
 121     wtemp = sin(0.5*theta);
 122     wpr   = -2.0*wtemp*wtemp;
 123     wpi   = sin(theta);
 124     wr    = 1.0+wpr;
 125     wi    = wpi;
 126     n2p3  = 2*n+3;
 127     for (i = 2; i <= n/2; i++)
 128     {
 129         i4       = 1+(i3 = n2p3-(i2 = 1+(i1 = i+i-1)));
 130         h1r      = c1*(data[i1]+data[i3]);
 131         h1i      = c1*(data[i2]-data[i4]);
 132         h2r      = -c2*(data[i2]+data[i4]);
 133         h2i      = c2*(data[i1]-data[i3]);
 134         data[i1] = h1r+wr*h2r-wi*h2i;
 135         data[i2] = h1i+wr*h2i+wi*h2r;
 136         data[i3] = h1r-wr*h2r+wi*h2i;
 137         data[i4] = -h1i+wr*h2i+wi*h2r;
 138         wr       = (wtemp = wr)*wpr-wi*wpi+wr;
 139         wi       = wi*wpr+wtemp*wpi+wi;
 140     }
 141     if (isign == 1)
 142     {
 143         data[1] = (h1r = data[1])+data[2];
 144         data[2] = h1r-data[2];
 145     }
 146     else
 147     {
 148         data[1] = c1*((h1r = data[1])+data[2]);
 149         data[2] = c1*(h1r-data[2]);
 150         four1(data, n, -1);
 151     }
 152 }
 153
 154 static void twofft(real data1[], real data2[], real fft1[], real fft2[], int n)
 155 {
 156     int  nn3, nn2, jj, j;
 157     real rep, rem, aip, aim;
 158
 159     nn3 = 1+(nn2 = 2+n+n);
 160     for (j = 1, jj = 2; j <= n; j++, jj += 2)
 161     {
 162         fft1[jj-1] = data1[j];
 163         fft1[jj]   = data2[j];
 164     }
 165     four1(fft1, n, 1);
 166     fft2[1] = fft1[2];
 167     fft1[2] = fft2[2] = 0.0;
 168     for (j = 3; j <= n+1; j += 2)
 169     {
 170         rep         = 0.5*(fft1[j]+fft1[nn2-j]);
 171         rem         = 0.5*(fft1[j]-fft1[nn2-j]);
 172         aip         = 0.5*(fft1[j+1]+fft1[nn3-j]);
 173         aim         = 0.5*(fft1[j+1]-fft1[nn3-j]);
 174         fft1[j]     = rep;
 175         fft1[j+1]   = aim;
 176         fft1[nn2-j] = rep;
 177         fft1[nn3-j] = -aim;
 178         fft2[j]     = aip;
 179         fft2[j+1]   = -rem;
 180         fft2[nn2-j] = aip;
 181         fft2[nn3-j] = rem;
 182     }
 183 }
 184
 185 void correl(real data1[], real data2[], int n, real ans[])
 186 {
 187     int     no2, i;
 188     real    dum, *fft;
 189
 190     snew(fft, 2*n+1);
 191     twofft(data1, data2, fft, ans, n);
 192     no2 = n/2;
 193     for (i = 2; i <= n+2; i += 2)
 194     {
 195         dum      = ans[i-1];
 196         ans[i-1] = (fft[i-1]*dum+fft[i]*ans[i])/no2;
 197         ans[i]   = (fft[i]*dum-fft[i-1]*ans[i])/no2;
 198     }
 199     ans[2] = ans[n+1];
 200     realft(ans, no2, -1);
 201     sfree(fft);
 202 }