/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (the "License").
 * You may not use this file except in compliance with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */

/*
 * Copyright 2011 Nexenta Systems, Inc.  All rights reserved.
 */
/*
 * Copyright 2006 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#ifdef __RESTRICT
#define restrict _Restrict
#else
#define restrict
#endif

/* float logf(float x)
 *
 * Method :
 *      1. Special cases:
 *              for x is negative, -Inf => QNaN + invalid;
 *              for x = 0               => -Inf + divide-by-zero;
 *              for x = +Inf            => Inf;
 *              for x = NaN             => QNaN.
 *      2. Computes logarithm from:
 *              x = m * 2**n => log(x) = n * log(2) + log(m),
 *              m = [1, 2).
 *      Let m = m0 + dm, where m0 = 1 + k / 32,
 *              k = [0, 32],
 *              dm = [-1/64, 1/64].
 *      Then log(m) = log(m0 + dm) = log(m0) + log(1+y),
 *              where y = dm*(1/m0), y = [-1/66, 1/64].
 *      Then
 *              1/m0 is looked up in a table of 1, 1/(1+1/32), ..., 1/(1+32/32);
 *              log(m0) is looked up in a table of log(1), log(1+1/32),
 *              ..., log(1+32/32).
 *              log(1+y) is computed using approximation:
 *              log(1+y) = ((a3*y + a2)*y + a1)*y*y + y.
 * Accuracy:
 *      The maximum relative error for the approximating
 *      polynomial is 2**(-28.41).  All calculations are of
 *      double precision.
 *      Maximum error observed: less than 0.545 ulp for the
 *      whole float type range.
 */

static const double __TBL_logf[] = {
        /* __TBL_logf[2*i] = log(1+i/32), i = [0, 32] */
        /* __TBL_logf[2*i+1] = 2**(-23)/(1+i/32), i = [0, 32] */
0.000000000000000000e+00, 1.192092895507812500e-07, 3.077165866675368733e-02,
1.155968868371212153e-07, 6.062462181643483994e-02, 1.121969784007352926e-07,
8.961215868968713805e-02, 1.089913504464285680e-07, 1.177830356563834557e-01,
1.059638129340277719e-07, 1.451820098444978890e-01, 1.030999260979729787e-07,
1.718502569266592284e-01, 1.003867701480263102e-07, 1.978257433299198675e-01,
9.781275040064102225e-08, 2.231435513142097649e-01, 9.536743164062500529e-08,
2.478361639045812692e-01, 9.304139672256097884e-08, 2.719337154836417580e-01,
9.082612537202380448e-08, 2.954642128938358980e-01, 8.871388989825581272e-08,
3.184537311185345887e-01, 8.669766512784091150e-08, 3.409265869705931928e-01,
8.477105034722222546e-08, 3.629054936893684746e-01, 8.292820142663043248e-08,
3.844116989103320559e-01, 8.116377160904255122e-08, 4.054651081081643849e-01,
7.947285970052082892e-08, 4.260843953109000881e-01, 7.785096460459183052e-08,
4.462871026284195297e-01, 7.629394531250000159e-08, 4.660897299245992387e-01,
7.479798560049019504e-08, 4.855078157817008244e-01, 7.335956280048077330e-08,
5.045560107523953119e-01, 7.197542010613207272e-08, 5.232481437645478684e-01,
7.064254195601851460e-08, 5.415972824327444091e-01, 6.935813210227272390e-08,
5.596157879354226594e-01, 6.811959402901785336e-08, 5.773153650348236132e-01,
6.692451343201754014e-08, 5.947071077466927758e-01, 6.577064251077586116e-08,
6.118015411059929409e-01, 6.465588585805084723e-08, 6.286086594223740942e-01,
6.357828776041666578e-08, 6.451379613735847007e-01, 6.253602074795082293e-08,
6.613984822453650159e-01, 6.152737525201612732e-08, 6.773988235918061429e-01,
6.055075024801586965e-08, 6.931471805599452862e-01, 5.960464477539062500e-08
};

static const double
        K3 = -2.49887584306188944706e-01,
        K2 =  3.33368809981254554946e-01,
        K1 = -5.00000008402474976565e-01;

static const union {
        int     i;
        float   f;
} inf = { 0x7f800000 };

#define INF     inf.f

#define PROCESS(N)                                                              \
        iy##N = ival##N & 0x007fffff;                                           \
        ival##N = (iy##N + 0x20000) & 0xfffc0000;                               \
        i##N  = ival##N >> 17;                                                  \
        iy##N = iy##N - ival##N;                                                \
        ty##N = LN2 * (double) exp##N + __TBL_logf[i##N];                       \
        yy##N = (double) iy##N * __TBL_logf[i##N + 1];                          \
        yy##N = ((K3 * yy##N + K2) * yy##N + K1) * yy##N * yy##N + yy##N;       \
        y[0] = (float)(yy##N + ty##N);                                          \
        y += stridey;

#define PREPROCESS(N, index, label)                                             \
        ival##N = *(int*)x;                                                     \
        value = x[0];                                                           \
        x += stridex;                                                           \
        exp##N = (ival##N >> 23) - 127;                                         \
        if ((ival##N & 0x7fffffff) >= 0x7f800000) /* X = NaN or Inf */  \
        {                                                                       \
                y[index] = value + INF;                                         \
                goto label;                                                     \
        }                                                                       \
        if (ival##N < 0x00800000)                                               \
        {                                                                       \
                if (ival##N > 0)        /* X = denormal */                      \
                {                                                               \
                        value = (float) ival##N;                                \
                        ival##N = *(int*) &value;                               \
                        exp##N = (ival##N >> 23) - (127 + 149);                 \
                }                                                               \
                else                                                            \
                {                                                               \
                        value = 0.0f;                                           \
                        y[index] = ((ival##N & 0x7fffffff) == 0) ?              \
                                -1.0f / value : value / value;                  \
                        goto label;                                             \
                }                                                               \
        }

void
__vlogf(int n, float * restrict x, int stridex, float * restrict y,
        int stridey)
{
        double  LN2 = __TBL_logf[64];           /* log(2) = 0.6931471805599453094       */
        double  yy0, yy1, yy2, yy3, yy4;
        double  ty0, ty1, ty2, ty3, ty4;
        float   value;
        int     i0, i1, i2, i3, i4;
        int     ival0, ival1, ival2, ival3, ival4;
        int     exp0, exp1, exp2, exp3, exp4;
        int     iy0, iy1, iy2, iy3, iy4;

        y -= stridey;

        for (; ;)
        {
begin:
                y += stridey;

                if (--n < 0)
                        break;

                PREPROCESS(0, 0, begin)

                if (--n < 0)
                        goto process1;

                PREPROCESS(1, stridey, process1)

                if (--n < 0)
                        goto process2;

                PREPROCESS(2, (stridey << 1), process2)

                if (--n < 0)
                        goto process3;

                PREPROCESS(3, (stridey << 1) + stridey, process3)

                if (--n < 0)
                        goto process4;

                PREPROCESS(4, (stridey << 2), process4)

                iy0 = ival0 & 0x007fffff;
                iy1 = ival1 & 0x007fffff;
                iy2 = ival2 & 0x007fffff;
                iy3 = ival3 & 0x007fffff;
                iy4 = ival4 & 0x007fffff;

                ival0 = (iy0 + 0x20000) & 0xfffc0000;
                ival1 = (iy1 + 0x20000) & 0xfffc0000;
                ival2 = (iy2 + 0x20000) & 0xfffc0000;
                ival3 = (iy3 + 0x20000) & 0xfffc0000;
                ival4 = (iy4 + 0x20000) & 0xfffc0000;

                i0 = ival0 >> 17;
                i1 = ival1 >> 17;
                i2 = ival2 >> 17;
                i3 = ival3 >> 17;
                i4 = ival4 >> 17;

                iy0 = iy0 - ival0;
                iy1 = iy1 - ival1;
                iy2 = iy2 - ival2;
                iy3 = iy3 - ival3;
                iy4 = iy4 - ival4;

                ty0 = LN2 * (double) exp0 + __TBL_logf[i0];
                ty1 = LN2 * (double) exp1 + __TBL_logf[i1];
                ty2 = LN2 * (double) exp2 + __TBL_logf[i2];
                ty3 = LN2 * (double) exp3 + __TBL_logf[i3];
                ty4 = LN2 * (double) exp4 + __TBL_logf[i4];

                yy0 = (double) iy0 * __TBL_logf[i0 + 1];
                yy1 = (double) iy1 * __TBL_logf[i1 + 1];
                yy2 = (double) iy2 * __TBL_logf[i2 + 1];
                yy3 = (double) iy3 * __TBL_logf[i3 + 1];
                yy4 = (double) iy4 * __TBL_logf[i4 + 1];

                yy0 = ((K3 * yy0 + K2) * yy0 + K1) * yy0 * yy0 + yy0;
                yy1 = ((K3 * yy1 + K2) * yy1 + K1) * yy1 * yy1 + yy1;
                yy2 = ((K3 * yy2 + K2) * yy2 + K1) * yy2 * yy2 + yy2;
                yy3 = ((K3 * yy3 + K2) * yy3 + K1) * yy3 * yy3 + yy3;
                yy4 = ((K3 * yy4 + K2) * yy4 + K1) * yy4 * yy4 + yy4;

                y[0] = (float)(yy0 + ty0);
                y += stridey;
                y[0] = (float)(yy1 + ty1);
                y += stridey;
                y[0] = (float)(yy2 + ty2);
                y += stridey;
                y[0] = (float)(yy3 + ty3);
                y += stridey;
                y[0] = (float)(yy4 + ty4);
                continue;

process1:
                PROCESS(0)
                continue;

process2:
                PROCESS(0)
                PROCESS(1)
                continue;

process3:
                PROCESS(0)
                PROCESS(1)
                PROCESS(2)
                continue;

process4:
                PROCESS(0)
                PROCESS(1)
                PROCESS(2)
                PROCESS(3)
        }
}