src/gmxlib/gmx_lapack/dlaev2.c

   1 /*
   2  * This file is part of the GROMACS molecular simulation package.
   3  *
   4  * Copyright (c) 2012, by the GROMACS development team, led by
   5  * David van der Spoel, Berk Hess, Erik Lindahl, and including many
   6  * others, as listed in the AUTHORS file in the top-level source
   7  * directory and at http://www.gromacs.org.
   8  *
   9  * GROMACS is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU Lesser General Public License
  11  * as published by the Free Software Foundation; either version 2.1
  12  * of the License, or (at your option) any later version.
  13  *
  14  * GROMACS 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  * Lesser General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU Lesser General Public
  20  * License along with GROMACS; if not, see
  21  * http://www.gnu.org/licenses, or write to the Free Software Foundation,
  22  * Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA.
  23  *
  24  * If you want to redistribute modifications to GROMACS, please
  25  * consider that scientific software is very special. Version
  26  * control is crucial - bugs must be traceable. We will be happy to
  27  * consider code for inclusion in the official distribution, but
  28  * derived work must not be called official GROMACS. Details are found
  29  * in the README & COPYING files - if they are missing, get the
  30  * official version at http://www.gromacs.org.
  31  *
  32  * To help us fund GROMACS development, we humbly ask that you cite
  33  * the research papers on the package. Check out http://www.gromacs.org.
  34  */
  35 #include <math.h>
  36 #include <types/simple.h>
  37
  38 #include "gmx_lapack.h"
  39
  40
  41 void
  42 F77_FUNC(dlaev2,DLAEV2)(double *   a,
  43         double *   b,
  44         double *   c__,
  45         double *   rt1,
  46         double *   rt2,
  47         double *   cs1,
  48         double *   sn1)
  49 {
  50     double d__1;
  51
  52     double ab, df, cs, ct, tb, sm, tn, rt, adf, acs;
  53     int sgn1, sgn2;
  54     double acmn, acmx;
  55
  56     sm = *a + *c__;
  57     df = *a - *c__;
  58     adf = fabs(df);
  59     tb = *b + *b;
  60     ab = fabs(tb);
  61     if (fabs(*a) > fabs(*c__)) {
  62         acmx = *a;
  63         acmn = *c__;
  64     } else {
  65         acmx = *c__;
  66         acmn = *a;
  67     }
  68     if (adf > ab) {
  69         d__1 = ab / adf;
  70         rt = adf * sqrt(d__1 * d__1 + 1.);
  71     } else if (adf < ab) {
  72         d__1 = adf / ab;
  73         rt = ab * sqrt(d__1 * d__1 + 1.);
  74     } else {
  75
  76         rt = ab * sqrt(2.);
  77     }
  78     if (sm < 0.) {
  79         *rt1 = (sm - rt) * .5;
  80         sgn1 = -1;
  81
  82         *rt2 = acmx / *rt1 * acmn - *b / *rt1 * *b;
  83     } else if (sm > 0.) {
  84         *rt1 = (sm + rt) * .5;
  85         sgn1 = 1;
  86         *rt2 = acmx / *rt1 * acmn - *b / *rt1 * *b;
  87     } else {
  88         *rt1 = rt * .5;
  89         *rt2 = rt * -.5;
  90         sgn1 = 1;
  91     }
  92     if (df >= 0.) {
  93         cs = df + rt;
  94         sgn2 = 1;
  95     } else {
  96         cs = df - rt;
  97         sgn2 = -1;
  98     }
  99     acs = fabs(cs);
 100     if (acs > ab) {
 101         ct = -tb / cs;
 102         *sn1 = 1. / sqrt(ct * ct + 1.);
 103         *cs1 = ct * *sn1;
 104     } else {
 105         if (fabs(ab)<GMX_DOUBLE_MIN) {
 106             *cs1 = 1.;
 107             *sn1 = 0.;
 108         } else {
 109             tn = -cs / tb;
 110             *cs1 = 1. / sqrt(tn * tn + 1.);
 111             *sn1 = tn * *cs1;
 112         }
 113     }
 114     if (sgn1 == sgn2) {
 115         tn = *cs1;
 116         *cs1 = -(*sn1);
 117         *sn1 = tn;
 118     }
 119     return;
 120
 121 }
 122
 123