OSDN Git Service

64cf404e0a653d094183fa4c01d9e0ff7e836c64
[pf3gnuchains/gcc-fork.git] / libgfortran / generated / norm2_r10.c
1 /* Implementation of the NORM2 intrinsic
2    Copyright 2010 Free Software Foundation, Inc.
3    Contributed by Tobias Burnus  <burnus@net-b.de>
4
5 This file is part of the GNU Fortran runtime library (libgfortran).
6
7 Libgfortran is free software; you can redistribute it and/or
8 modify it under the terms of the GNU General Public
9 License as published by the Free Software Foundation; either
10 version 3 of the License, or (at your option) any later version.
11
12 Libgfortran is distributed in the hope that it will be useful,
13 but WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15 GNU General Public License for more details.
16
17 Under Section 7 of GPL version 3, you are granted additional
18 permissions described in the GCC Runtime Library Exception, version
19 3.1, as published by the Free Software Foundation.
20
21 You should have received a copy of the GNU General Public License and
22 a copy of the GCC Runtime Library Exception along with this program;
23 see the files COPYING3 and COPYING.RUNTIME respectively.  If not, see
24 <http://www.gnu.org/licenses/>.  */
25
26 #include "libgfortran.h"
27 #include <stdlib.h>
28 #include <math.h>
29 #include <assert.h>
30
31
32 #if defined (HAVE_GFC_REAL_10) && defined (HAVE_GFC_REAL_10)
33
34
35 extern void norm2_r10 (gfc_array_r10 * const restrict, 
36         gfc_array_r10 * const restrict, const index_type * const restrict);
37 export_proto(norm2_r10);
38
39 void
40 norm2_r10 (gfc_array_r10 * const restrict retarray, 
41         gfc_array_r10 * const restrict array, 
42         const index_type * const restrict pdim)
43 {
44   index_type count[GFC_MAX_DIMENSIONS];
45   index_type extent[GFC_MAX_DIMENSIONS];
46   index_type sstride[GFC_MAX_DIMENSIONS];
47   index_type dstride[GFC_MAX_DIMENSIONS];
48   const GFC_REAL_10 * restrict base;
49   GFC_REAL_10 * restrict dest;
50   index_type rank;
51   index_type n;
52   index_type len;
53   index_type delta;
54   index_type dim;
55   int continue_loop;
56
57   /* Make dim zero based to avoid confusion.  */
58   dim = (*pdim) - 1;
59   rank = GFC_DESCRIPTOR_RANK (array) - 1;
60
61   len = GFC_DESCRIPTOR_EXTENT(array,dim);
62   if (len < 0)
63     len = 0;
64   delta = GFC_DESCRIPTOR_STRIDE(array,dim);
65
66   for (n = 0; n < dim; n++)
67     {
68       sstride[n] = GFC_DESCRIPTOR_STRIDE(array,n);
69       extent[n] = GFC_DESCRIPTOR_EXTENT(array,n);
70
71       if (extent[n] < 0)
72         extent[n] = 0;
73     }
74   for (n = dim; n < rank; n++)
75     {
76       sstride[n] = GFC_DESCRIPTOR_STRIDE(array, n + 1);
77       extent[n] = GFC_DESCRIPTOR_EXTENT(array, n + 1);
78
79       if (extent[n] < 0)
80         extent[n] = 0;
81     }
82
83   if (retarray->data == NULL)
84     {
85       size_t alloc_size, str;
86
87       for (n = 0; n < rank; n++)
88         {
89           if (n == 0)
90             str = 1;
91           else
92             str = GFC_DESCRIPTOR_STRIDE(retarray,n-1) * extent[n-1];
93
94           GFC_DIMENSION_SET(retarray->dim[n], 0, extent[n] - 1, str);
95
96         }
97
98       retarray->offset = 0;
99       retarray->dtype = (array->dtype & ~GFC_DTYPE_RANK_MASK) | rank;
100
101       alloc_size = sizeof (GFC_REAL_10) * GFC_DESCRIPTOR_STRIDE(retarray,rank-1)
102                    * extent[rank-1];
103
104       if (alloc_size == 0)
105         {
106           /* Make sure we have a zero-sized array.  */
107           GFC_DIMENSION_SET(retarray->dim[0], 0, -1, 1);
108           return;
109
110         }
111       else
112         retarray->data = internal_malloc_size (alloc_size);
113     }
114   else
115     {
116       if (rank != GFC_DESCRIPTOR_RANK (retarray))
117         runtime_error ("rank of return array incorrect in"
118                        " NORM intrinsic: is %ld, should be %ld",
119                        (long int) (GFC_DESCRIPTOR_RANK (retarray)),
120                        (long int) rank);
121
122       if (unlikely (compile_options.bounds_check))
123         bounds_ifunction_return ((array_t *) retarray, extent,
124                                  "return value", "NORM");
125     }
126
127   for (n = 0; n < rank; n++)
128     {
129       count[n] = 0;
130       dstride[n] = GFC_DESCRIPTOR_STRIDE(retarray,n);
131       if (extent[n] <= 0)
132         len = 0;
133     }
134
135   base = array->data;
136   dest = retarray->data;
137
138   continue_loop = 1;
139   while (continue_loop)
140     {
141       const GFC_REAL_10 * restrict src;
142       GFC_REAL_10 result;
143       src = base;
144       {
145
146         GFC_REAL_10 scale;
147         result = 0.0L;
148         scale = 1.0L;
149         if (len <= 0)
150           *dest = 0.0L;
151         else
152           {
153             for (n = 0; n < len; n++, src += delta)
154               {
155
156           if (*src != 0.0L)
157             {
158               GFC_REAL_10 absX, val;
159               absX = fabsl (*src);
160               if (scale < absX)
161                 {
162                   val = scale / absX;
163                   result = 1.0L + result * val * val;
164                   scale = absX;
165                 }
166               else
167                 {
168                   val = absX / scale;
169                   result += val * val;
170                 }
171             }
172               }
173             result = scale * sqrtl (result);
174             *dest = result;
175           }
176       }
177       /* Advance to the next element.  */
178       count[0]++;
179       base += sstride[0];
180       dest += dstride[0];
181       n = 0;
182       while (count[n] == extent[n])
183         {
184           /* When we get to the end of a dimension, reset it and increment
185              the next dimension.  */
186           count[n] = 0;
187           /* We could precalculate these products, but this is a less
188              frequently used path so probably not worth it.  */
189           base -= sstride[n] * extent[n];
190           dest -= dstride[n] * extent[n];
191           n++;
192           if (n == rank)
193             {
194               /* Break out of the look.  */
195               continue_loop = 0;
196               break;
197             }
198           else
199             {
200               count[n]++;
201               base += sstride[n];
202               dest += dstride[n];
203             }
204         }
205     }
206 }
207
208 #endif