/[escript]/branches/domexper/dudley/src/Util.c
ViewVC logotype

Diff of /branches/domexper/dudley/src/Util.c

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

trunk/esys2/finley/src/finleyC/Util.c revision 100 by jgs, Wed Dec 15 03:48:48 2004 UTC trunk/finley/src/Util.c revision 1716 by gross, Thu Aug 21 05:03:49 2008 UTC
# Line 1  Line 1 
1    
2  /* $Id$ */  /* $Id$ */
3    
4    /*******************************************************
5     *
6     *           Copyright 2003-2007 by ACceSS MNRF
7     *       Copyright 2007 by University of Queensland
8     *
9     *                http://esscc.uq.edu.au
10     *        Primary Business: Queensland, Australia
11     *  Licensed under the Open Software License version 3.0
12     *     http://www.opensource.org/licenses/osl-3.0.php
13     *
14     *******************************************************/
15    
16  /**************************************************************/  /**************************************************************/
17    
18  /*   Some utility routines: */  /*   Some utility routines: */
19    
20  /**************************************************************/  /**************************************************************/
21    
22  /*   Copyrights by ACcESS Australia, 2003 */  #include "Finley.h"
23  /*   author: gross@access.edu.au */  #include "Util.h"
24  /*   Version: $Id$ */  
25    #ifdef _OPENMP
26    #include <omp.h>
27    #endif
28    
29  /**************************************************************/  /**************************************************************/
30    
31  #include "Common.h"  /*   returns true if any of the values in the short array values is not equalt to Zero */
 #include "Finley.h"  
 #include "Util.h"  
32    
33    bool_t Finley_Util_anyNonZeroDouble(dim_t N, double* values) {
34       dim_t q;
35       for (q=0;q<N;++q) if (ABS(values[q])>0) return TRUE;
36       return FALSE;
37    }
38  /**************************************************************/  /**************************************************************/
39    
40  /*   gathers double values out from in by index: */  /*   gathers double values out from in by index: */
41    
42  /*        out(1:numData,1:len)=in(1:numData,index(1:len)) */  /*        out(1:numData,1:len)=in(1:numData,index(1:len)) */
43    
44  void Finley_Util_Gather_double(int len,maybelong* index,int numData,double* in, double * out){  void Finley_Util_Gather_double(dim_t len,index_t* index,dim_t numData,double* in, double * out){
45      int s,i;      dim_t s,i;
46      for (s=0;s<len;s++) {      for (s=0;s<len;s++) {
47         for (i=0;i<numData;i++) {         for (i=0;i<numData;i++) {
48            out[INDEX2(i,s,numData)]=in[INDEX2(i,index[s],numData)];            out[INDEX2(i,s,numData)]=in[INDEX2(i,index[s],numData)];
# Line 38  void Finley_Util_Gather_double(int len,m Line 57  void Finley_Util_Gather_double(int len,m
57    
58  /*        out(1:numData,1:len)=in(1:numData,index(1:len)) */  /*        out(1:numData,1:len)=in(1:numData,index(1:len)) */
59    
60  void Finley_Util_Gather_int(int len,maybelong* index,int numData, maybelong* in, maybelong * out){  void Finley_Util_Gather_int(dim_t len,index_t* index,dim_t numData, index_t* in, index_t * out){
61      int s,i;      dim_t s,i;
62      for (s=0;s<len;s++) {      for (s=0;s<len;s++) {
63         for (i=0;i<numData;i++) {         for (i=0;i<numData;i++) {
64            out[INDEX2(i,s,numData)]=in[INDEX2(i,index[s],numData)];            out[INDEX2(i,s,numData)]=in[INDEX2(i,index[s],numData)];
# Line 51  void Finley_Util_Gather_int(int len,mayb Line 70  void Finley_Util_Gather_int(int len,mayb
70    
71  /*   adds a vector in into out using and index. */  /*   adds a vector in into out using and index. */
72    
73  /*        out(1:numData,index(1:len))+=in(1:numData,1:len) */  /*        out(1:numData,index[p])+=in(1:numData,p) where p = {k=1...len , index[k]<upperBound}*/
74    
75    
76  void Finley_Util_AddScatter(int len,maybelong* index,int numData,double* in,double * out){  void Finley_Util_AddScatter(dim_t len,index_t* index,dim_t numData,double* in,double * out, index_t upperBound){
77     int i,s;     dim_t i,s;
78     for (s=0;s<len;s++) {     for (s=0;s<len;s++) {
79         for(i=0;i<numData;i++) {         for(i=0;i<numData;i++) {
80            #pragma omp atomic            if( index[s]<upperBound ) {
81            out[INDEX2(i,index[s],numData)]+=in[INDEX2(i,s,numData)];              out[INDEX2(i,index[s],numData)]+=in[INDEX2(i,s,numData)];
82          }
83         }         }
84     }     }
85  }  }
# Line 67  void Finley_Util_AddScatter(int len,mayb Line 88  void Finley_Util_AddScatter(int len,mayb
88    
89  /*          A(1:A1,1:A2)=B(1:A1,1:B2)*C(1:B2,1:A2) */  /*          A(1:A1,1:A2)=B(1:A1,1:B2)*C(1:B2,1:A2) */
90    
91  void Finley_Util_SmallMatMult(int A1,int A2, double* A, int B2, double*B, double* C) {  void Finley_Util_SmallMatMult(dim_t A1,dim_t A2, double* A, dim_t B2, double*B, double* C) {
92      int i,j,s;      dim_t i,j,s;
93      for (i=0;i<A1*A2;i++) A[i]=0;      for (i=0;i<A1*A2;i++) A[i]=0;
94         for (i=0;i<A1;i++) {         for (i=0;i<A1;i++) {
95            for (j=0;j<A2;j++) {            for (j=0;j<A2;j++) {
# Line 83  void Finley_Util_SmallMatMult(int A1,int Line 104  void Finley_Util_SmallMatMult(int A1,int
104    
105  /*        A(1:A1,1:A2,i)=B(1:A1,1:B2,i)*C(1:B2,1:A2,i) i=1,len */  /*        A(1:A1,1:A2,i)=B(1:A1,1:B2,i)*C(1:B2,1:A2,i) i=1,len */
106    
107  void Finley_Util_SmallMatSetMult(int len,int A1,int A2, double* A, int B2, double*B, double* C) {  void Finley_Util_SmallMatSetMult(dim_t len,dim_t A1,dim_t A2, double* A, dim_t B2, double*B, double* C) {
108      int q,i,j,s;      dim_t q,i,j,s;
109      for (i=0;i<A1*A2*len;i++) A[i]=0;      for (i=0;i<A1*A2*len;i++) A[i]=0;
110      for (q=0;q<len;q++) {      for (q=0;q<len;q++) {
111         for (i=0;i<A1;i++) {         for (i=0;i<A1;i++) {
# Line 96  void Finley_Util_SmallMatSetMult(int len Line 117  void Finley_Util_SmallMatSetMult(int len
117         }         }
118      }      }
119  }  }
   
120  /*    inverts the set of dim x dim matrices A(:,:,1:len) with dim=1,2,3 */  /*    inverts the set of dim x dim matrices A(:,:,1:len) with dim=1,2,3 */
121  /*    the determinante is returned. */  /*    the determinante is returned. */
122    
123  void Finley_Util_InvertSmallMat(int len,int dim,double* A,double *invA, double* det){  void Finley_Util_InvertSmallMat(dim_t len,dim_t dim,double* A,double *invA, double* det){
124     int q;     dim_t q;
125     double D,A11,A12,A13,A21,A22,A23,A31,A32,A33;     register double D,A11,A12,A13,A21,A22,A23,A31,A32,A33;
126    
127     switch(dim) {     switch(dim) {
128        case 1:        case 1:
129           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
130              D=A[INDEX3(0,0,q,dim,dim)];              D=A[q];
131              if (D == 0 ){              if (ABS(D) > 0 ){
132                 Finley_ErrorCode=ZERO_DIVISION_ERROR;                 det[q]=D;
133                 sprintf(Finley_ErrorMsg,"Non-regular matrix");                 D=1./D;
134                   invA[q]=D;
135                } else {
136                   Finley_setError(ZERO_DIVISION_ERROR,"__FILE__: Non-regular matrix");
137                 return;                 return;
138              }              }
             det[q]=D;  
             D=1./D;  
             invA[INDEX3(0,0,q,dim,dim)]=D;  
139           }           }
140           break;           break;
141    
142        case 2:        case 2:
143           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
144              A11=A[INDEX3(0,0,q,dim,dim)];              A11=A[INDEX3(0,0,q,2,2)];
145              A12=A[INDEX3(0,1,q,dim,dim)];              A12=A[INDEX3(0,1,q,2,2)];
146              A21=A[INDEX3(1,0,q,dim,dim)];              A21=A[INDEX3(1,0,q,2,2)];
147              A22=A[INDEX3(1,1,q,dim,dim)];              A22=A[INDEX3(1,1,q,2,2)];
148    
149              D = A11*A22-A12*A21;              D = A11*A22-A12*A21;
150              if (D == 0 ){              if (ABS(D) > 0 ){
151                 Finley_ErrorCode=ZERO_DIVISION_ERROR;                 det[q]=D;
152                 sprintf(Finley_ErrorMsg,"Non-regular matrix");                 D=1./D;
153                   invA[INDEX3(0,0,q,2,2)]= A22*D;
154                   invA[INDEX3(1,0,q,2,2)]=-A21*D;
155                   invA[INDEX3(0,1,q,2,2)]=-A12*D;
156                   invA[INDEX3(1,1,q,2,2)]= A11*D;
157                } else {
158                   Finley_setError(ZERO_DIVISION_ERROR,"__FILE__: Non-regular matrix");
159                 return;                 return;
160              }              }
             det[q]=D;  
             D=1./D;  
             invA[INDEX3(0,0,q,dim,dim)]= A22*D;  
             invA[INDEX3(1,0,q,dim,dim)]=-A21*D;  
             invA[INDEX3(0,1,q,dim,dim)]=-A12*D;  
             invA[INDEX3(1,1,q,dim,dim)]= A11*D;  
161           }           }
162           break;           break;
163    
164        case 3:        case 3:
165       for (q=0;q<len;q++) {       for (q=0;q<len;q++) {
166              A11=A[INDEX3(0,0,q,dim,dim)];              A11=A[INDEX3(0,0,q,3,3)];
167              A21=A[INDEX3(1,0,q,dim,dim)];              A21=A[INDEX3(1,0,q,3,3)];
168              A31=A[INDEX3(2,0,q,dim,dim)];              A31=A[INDEX3(2,0,q,3,3)];
169              A12=A[INDEX3(0,1,q,dim,dim)];              A12=A[INDEX3(0,1,q,3,3)];
170              A22=A[INDEX3(1,1,q,dim,dim)];              A22=A[INDEX3(1,1,q,3,3)];
171              A32=A[INDEX3(2,1,q,dim,dim)];              A32=A[INDEX3(2,1,q,3,3)];
172              A13=A[INDEX3(0,2,q,dim,dim)];              A13=A[INDEX3(0,2,q,3,3)];
173              A23=A[INDEX3(1,2,q,dim,dim)];              A23=A[INDEX3(1,2,q,3,3)];
174              A33=A[INDEX3(2,2,q,dim,dim)];              A33=A[INDEX3(2,2,q,3,3)];
175    
176              D  =  A11*(A22*A33-A23*A32)+ A12*(A31*A23-A21*A33)+A13*(A21*A32-A31*A22);              D  =  A11*(A22*A33-A23*A32)+ A12*(A31*A23-A21*A33)+A13*(A21*A32-A31*A22);
177              if (D == 0 ){              if (ABS(D) > 0 ){
178                 Finley_ErrorCode=ZERO_DIVISION_ERROR;                 det[q]    =D;
179                 sprintf(Finley_ErrorMsg,"Non-regular matrix");                 D=1./D;
180                   invA[INDEX3(0,0,q,3,3)]=(A22*A33-A23*A32)*D;
181                   invA[INDEX3(1,0,q,3,3)]=(A31*A23-A21*A33)*D;
182                   invA[INDEX3(2,0,q,3,3)]=(A21*A32-A31*A22)*D;
183                   invA[INDEX3(0,1,q,3,3)]=(A13*A32-A12*A33)*D;
184                   invA[INDEX3(1,1,q,3,3)]=(A11*A33-A31*A13)*D;
185                   invA[INDEX3(2,1,q,3,3)]=(A12*A31-A11*A32)*D;
186                   invA[INDEX3(0,2,q,3,3)]=(A12*A23-A13*A22)*D;
187                   invA[INDEX3(1,2,q,3,3)]=(A13*A21-A11*A23)*D;
188                   invA[INDEX3(2,2,q,3,3)]=(A11*A22-A12*A21)*D;
189                } else {
190                   Finley_setError(ZERO_DIVISION_ERROR,"__FILE__: Non-regular matrix");
191                 return;                 return;
192              }              }
             det[q]    =D;  
             D=1./D;  
             invA[INDEX3(0,0,q,dim,dim)]=(A22*A33-A23*A32)*D;  
             invA[INDEX3(1,0,q,dim,dim)]=(A31*A23-A21*A33)*D;  
             invA[INDEX3(2,0,q,dim,dim)]=(A21*A32-A31*A22)*D;  
             invA[INDEX3(0,1,q,dim,dim)]=(A13*A32-A12*A33)*D;  
             invA[INDEX3(1,1,q,dim,dim)]=(A11*A33-A31*A13)*D;  
             invA[INDEX3(2,1,q,dim,dim)]=(A12*A31-A11*A32)*D;  
             invA[INDEX3(0,2,q,dim,dim)]=(A12*A23-A13*A22)*D;  
             invA[INDEX3(1,2,q,dim,dim)]=(A13*A21-A11*A23)*D;  
             invA[INDEX3(2,2,q,dim,dim)]=(A11*A22-A12*A21)*D;  
193           }           }
194           break;           break;
195    
# Line 179  void Finley_Util_InvertSmallMat(int len, Line 199  void Finley_Util_InvertSmallMat(int len,
199    
200  /*    sets the derterminate of a set of dim x dim matrices A(:,:,1:len) with dim=1,2,3 */  /*    sets the derterminate of a set of dim x dim matrices A(:,:,1:len) with dim=1,2,3 */
201    
202  void Finley_Util_DetOfSmallMat(int len,int dim,double* A, double* det){  void Finley_Util_DetOfSmallMat(dim_t len,dim_t dim,double* A, double* det){
203     int q;     dim_t q;
204     double A11,A12,A13,A21,A22,A23,A31,A32,A33;     register double A11,A12,A13,A21,A22,A23,A31,A32,A33;
205    
206     switch(dim) {     switch(dim) {
207        case 1:        case 1:
208           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
209              det[q]=A[INDEX3(0,0,q,dim,dim)];              det[q]=A[q];
210           }           }
211           break;           break;
212    
213        case 2:        case 2:
214           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
215              A11=A[INDEX3(0,0,q,dim,dim)];              A11=A[INDEX3(0,0,q,2,2)];
216              A12=A[INDEX3(0,1,q,dim,dim)];              A12=A[INDEX3(0,1,q,2,2)];
217              A21=A[INDEX3(1,0,q,dim,dim)];              A21=A[INDEX3(1,0,q,2,2)];
218              A22=A[INDEX3(1,1,q,dim,dim)];              A22=A[INDEX3(1,1,q,2,2)];
219    
220              det[q] = A11*A22-A12*A21;              det[q] = A11*A22-A12*A21;
221           }           }
# Line 203  void Finley_Util_DetOfSmallMat(int len,i Line 223  void Finley_Util_DetOfSmallMat(int len,i
223    
224        case 3:        case 3:
225       for (q=0;q<len;q++) {       for (q=0;q<len;q++) {
226              A11=A[INDEX3(0,0,q,dim,dim)];              A11=A[INDEX3(0,0,q,3,3)];
227              A21=A[INDEX3(1,0,q,dim,dim)];              A21=A[INDEX3(1,0,q,3,3)];
228              A31=A[INDEX3(2,0,q,dim,dim)];              A31=A[INDEX3(2,0,q,3,3)];
229              A12=A[INDEX3(0,1,q,dim,dim)];              A12=A[INDEX3(0,1,q,3,3)];
230              A22=A[INDEX3(1,1,q,dim,dim)];              A22=A[INDEX3(1,1,q,3,3)];
231              A32=A[INDEX3(2,1,q,dim,dim)];              A32=A[INDEX3(2,1,q,3,3)];
232              A13=A[INDEX3(0,2,q,dim,dim)];              A13=A[INDEX3(0,2,q,3,3)];
233              A23=A[INDEX3(1,2,q,dim,dim)];              A23=A[INDEX3(1,2,q,3,3)];
234              A33=A[INDEX3(2,2,q,dim,dim)];              A33=A[INDEX3(2,2,q,3,3)];
235    
236              det[q]  =  A11*(A22*A33-A23*A32)+ A12*(A31*A23-A21*A33)+A13*(A21*A32-A31*A22);              det[q]  =  A11*(A22*A33-A23*A32)+ A12*(A31*A23-A21*A33)+A13*(A21*A32-A31*A22);
237           }           }
# Line 223  void Finley_Util_DetOfSmallMat(int len,i Line 243  void Finley_Util_DetOfSmallMat(int len,i
243  /*    returns the normalized vector Normal[dim,len] orthogonal to A(:,0,q) and A(:,1,q) in the case of dim=3  */  /*    returns the normalized vector Normal[dim,len] orthogonal to A(:,0,q) and A(:,1,q) in the case of dim=3  */
244  /*    or the vector A(:,0,q) in the case of dim=2                                             */  /*    or the vector A(:,0,q) in the case of dim=2                                             */
245    
246  void  Finley_NormalVector(int len, int dim, int dim1, double* A,double* Normal) {  void  Finley_NormalVector(dim_t len, dim_t dim, dim_t dim1, double* A,double* Normal) {
247     int q;     dim_t q;
248     double A11,A12,CO_A13,A21,A22,CO_A23,A31,A32,CO_A33,length,invlength;     register double A11,A12,CO_A13,A21,A22,CO_A23,A31,A32,CO_A33,length,invlength;
249    
250     switch(dim) {     switch(dim) {
251        case 1:        case 1:
252           for (q=0;q<len;q++) Normal[INDEX1(q)]    =1;           for (q=0;q<len;q++) Normal[q]    =1;
253           break;           break;
254        case 2:        case 2:
255           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
256              A11=A[INDEX3(0,0,q,dim,dim1)];              A11=A[INDEX3(0,0,q,2,dim1)];
257              A21=A[INDEX3(1,0,q,dim,dim1)];              A21=A[INDEX3(1,0,q,2,dim1)];
258              length = sqrt(A11*A11+A21*A21);              length = sqrt(A11*A11+A21*A21);
259              if (! length>0) {              if (! length>0) {
260                 Finley_ErrorCode=ZERO_DIVISION_ERROR;                 Finley_setError(ZERO_DIVISION_ERROR,"__FILE__: area equals zero.");
                sprintf(Finley_ErrorMsg,"area equals zero.");  
261                 return;                 return;
262              } else {              } else {
263                 invlength=1./length;                 invlength=1./length;
264                 Normal[INDEX2(0,q,dim)]=A21*invlength;                 Normal[INDEX2(0,q,2)]=A21*invlength;
265                 Normal[INDEX2(1,q,dim)]=-A11*invlength;                 Normal[INDEX2(1,q,2)]=-A11*invlength;
266              }              }
267           }           }
268           break;           break;
269        case 3:        case 3:
270           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
271              A11=A[INDEX3(0,0,q,dim,dim1)];              A11=A[INDEX3(0,0,q,3,dim1)];
272              A21=A[INDEX3(1,0,q,dim,dim1)];              A21=A[INDEX3(1,0,q,3,dim1)];
273              A31=A[INDEX3(2,0,q,dim,dim1)];              A31=A[INDEX3(2,0,q,3,dim1)];
274              A12=A[INDEX3(0,1,q,dim,dim1)];              A12=A[INDEX3(0,1,q,3,dim1)];
275              A22=A[INDEX3(1,1,q,dim,dim1)];              A22=A[INDEX3(1,1,q,3,dim1)];
276              A32=A[INDEX3(2,1,q,dim,dim1)];              A32=A[INDEX3(2,1,q,3,dim1)];
277              CO_A13=A21*A32-A31*A22;              CO_A13=A21*A32-A31*A22;
278              CO_A23=A31*A12-A11*A32;              CO_A23=A31*A12-A11*A32;
279              CO_A33=A11*A22-A21*A12;              CO_A33=A11*A22-A21*A12;
280              length=sqrt(CO_A13*CO_A13+CO_A23*CO_A23+CO_A33*CO_A33);              length=sqrt(CO_A13*CO_A13+CO_A23*CO_A23+CO_A33*CO_A33);
281              if (! length>0) {              if (! length>0) {
282                 Finley_ErrorCode=ZERO_DIVISION_ERROR;                 Finley_setError(ZERO_DIVISION_ERROR,"__FILE__: area equals zero.");
                sprintf(Finley_ErrorMsg,"area equals zero.");  
283                 return;                 return;
284              } else {              } else {
285                 invlength=1./length;                 invlength=1./length;
286                 Normal[INDEX2(0,q,dim)]=CO_A13*invlength;                 Normal[INDEX2(0,q,3)]=CO_A13*invlength;
287                 Normal[INDEX2(1,q,dim)]=CO_A23*invlength;                 Normal[INDEX2(1,q,3)]=CO_A23*invlength;
288                 Normal[INDEX2(2,q,dim)]=CO_A33*invlength;                 Normal[INDEX2(2,q,3)]=CO_A33*invlength;
289             }             }
290                            
291        }        }
# Line 280  void  Finley_NormalVector(int len, int d Line 298  void  Finley_NormalVector(int len, int d
298  /*    return the length of the vector which is orthogonal to the vectors A(:,0,q) and A(:,1,q) in the case of dim=3 */  /*    return the length of the vector which is orthogonal to the vectors A(:,0,q) and A(:,1,q) in the case of dim=3 */
299  /*    or the vector A(:,0,q) in the case of dim=2                                                                   */  /*    or the vector A(:,0,q) in the case of dim=2                                                                   */
300    
301  void  Finley_LengthOfNormalVector(int len, int dim, int dim1, double* A,double* length) {  void  Finley_LengthOfNormalVector(dim_t len, dim_t dim, dim_t dim1, double* A,double* length) {
302     int q;     dim_t q;
303     double A11,A12,CO_A13,A21,A22,CO_A23,A31,A32,CO_A33;     double A11,A12,CO_A13,A21,A22,CO_A23,A31,A32,CO_A33;
304    
305     switch(dim) {     switch(dim) {
306        case 1:        case 1:
307           for (q=0;q<len;q++) length[INDEX1(q)]    =1;           for (q=0;q<len;q++) length[q]    =1;
308           break;           break;
309        case 2:        case 2:
310           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
311              A11=A[INDEX3(0,0,q,dim,dim1)];              A11=A[INDEX3(0,0,q,2,dim1)];
312              A21=A[INDEX3(1,0,q,dim,dim1)];              A21=A[INDEX3(1,0,q,2,dim1)];
313              length[q] = sqrt(A11*A11+A21*A21);              length[q] = sqrt(A11*A11+A21*A21);
314           }           }
315           break;           break;
316        case 3:        case 3:
317           for (q=0;q<len;q++) {           for (q=0;q<len;q++) {
318              A11=A[INDEX3(0,0,q,dim,dim1)];              A11=A[INDEX3(0,0,q,3,dim1)];
319              A21=A[INDEX3(1,0,q,dim,dim1)];              A21=A[INDEX3(1,0,q,3,dim1)];
320              A31=A[INDEX3(2,0,q,dim,dim1)];              A31=A[INDEX3(2,0,q,3,dim1)];
321              A12=A[INDEX3(0,1,q,dim,dim1)];              A12=A[INDEX3(0,1,q,3,dim1)];
322              A22=A[INDEX3(1,1,q,dim,dim1)];              A22=A[INDEX3(1,1,q,3,dim1)];
323              A32=A[INDEX3(2,1,q,dim,dim1)];              A32=A[INDEX3(2,1,q,3,dim1)];
324              CO_A13=A21*A32-A31*A22;              CO_A13=A21*A32-A31*A22;
325              CO_A23=A31*A12-A11*A32;              CO_A23=A31*A12-A11*A32;
326              CO_A33=A11*A22-A21*A12;              CO_A33=A11*A22-A21*A12;
# Line 318  void  Finley_LengthOfNormalVector(int le Line 336  void  Finley_LengthOfNormalVector(int le
336  /* there is no range checking! */  /* there is no range checking! */
337  /* at output Map[invMap[i]]=i for i=0:lenInvMap */  /* at output Map[invMap[i]]=i for i=0:lenInvMap */
338    
339  void Finley_Util_InvertMap(int lenInvMap, maybelong* invMap,int lenMap, maybelong* Map) {  void Finley_Util_InvertMap(dim_t lenInvMap, index_t* invMap,dim_t lenMap, index_t* Map) {
340     int i;     dim_t i;
341     for (i=0;i<lenInvMap;i++) invMap[i]=0;     for (i=0;i<lenInvMap;i++) invMap[i]=0;
342     for (i=0;i<lenMap;i++) {     for (i=0;i<lenMap;i++) {
343        if (Map[i]>=0) invMap[Map[i]]=i;        if (Map[i]>=0) invMap[Map[i]]=i;
# Line 335  int Finley_Util_ValueAndIndex_compar(con Line 353  int Finley_Util_ValueAndIndex_compar(con
353     e2=(Finley_Util_ValueAndIndex*) arg2;     e2=(Finley_Util_ValueAndIndex*) arg2;
354     if (e1->value < e2->value) return -1;     if (e1->value < e2->value) return -1;
355     if (e1->value > e2->value) return  1;     if (e1->value > e2->value) return  1;
356       if (e1->index < e2->index) return -1;
357       if (e1->index > e2->index) return  1;
358     return 0;     return 0;
359  }  }
360  void Finley_Util_sortValueAndIndex(int n,Finley_Util_ValueAndIndex* array) {  
361    void Finley_Util_sortValueAndIndex(dim_t n,Finley_Util_ValueAndIndex* array) {
362       /* OMP : needs parallelization !*/       /* OMP : needs parallelization !*/
363       qsort(array,n,sizeof(Finley_Util_ValueAndIndex),Finley_Util_ValueAndIndex_compar);       qsort(array,n,sizeof(Finley_Util_ValueAndIndex),Finley_Util_ValueAndIndex_compar);
364  }  }
# Line 347  void Finley_Util_sortValueAndIndex(int n Line 368  void Finley_Util_sortValueAndIndex(int n
368    
369  /* calculates the minimum value from a dim X N integer array */  /* calculates the minimum value from a dim X N integer array */
370    
371  maybelong Finley_Util_getMinInt(int dim,int N,maybelong* values) {  index_t Finley_Util_getMinInt(dim_t dim,dim_t N,index_t* values) {
372     maybelong i,j,out;     dim_t i,j;
373     out=MAYBELONG_MAX;     index_t out,out_local;
374       out=INDEX_T_MAX;
375     if (values!=NULL && dim*N>0 ) {     if (values!=NULL && dim*N>0 ) {
      /* OMP */  
376       out=values[0];       out=values[0];
377       for (j=0;j<N;j++) {       #pragma omp parallel private(out_local)
378         for (i=0;i<dim;i++) out=MIN(out,values[INDEX2(i,j,dim)]);       {
379             out_local=out;
380             #pragma omp for private(i,j) schedule(static)
381             for (j=0;j<N;j++) {
382               for (i=0;i<dim;i++) out_local=MIN(out_local,values[INDEX2(i,j,dim)]);
383             }
384             #pragma omp critical
385             out=MIN(out_local,out);
386       }       }
387     }     }
388     return out;     return out;
# Line 362  maybelong Finley_Util_getMinInt(int dim, Line 390  maybelong Finley_Util_getMinInt(int dim,
390                                                                                                                                                                                                                                                                                                        
391  /* calculates the maximum value from a dim X N integer array */  /* calculates the maximum value from a dim X N integer array */
392    
393  maybelong Finley_Util_getMaxInt(int dim,int N,maybelong* values) {  index_t Finley_Util_getMaxInt(dim_t dim,dim_t N,index_t* values) {
394     maybelong i,j,out;     dim_t i,j;
395     out=-MAYBELONG_MAX;     index_t out,out_local;
396       out=-INDEX_T_MAX;
397     if (values!=NULL && dim*N>0 ) {     if (values!=NULL && dim*N>0 ) {
      /* OMP */  
398       out=values[0];       out=values[0];
399       for (j=0;j<N;j++) {       #pragma omp parallel private(out_local)
400         for (i=0;i<dim;i++) out=MAX(out,values[INDEX2(i,j,dim)]);       {
401             out_local=out;
402             #pragma omp for private(i,j) schedule(static)
403             for (j=0;j<N;j++) {
404                 for (i=0;i<dim;i++) out_local=MAX(out_local,values[INDEX2(i,j,dim)]);
405             }
406             #pragma omp critical
407             out=MAX(out_local,out);
408          }
409       }
410       return out;
411    }
412    /**************************************************************/
413    
414    /* calculates the minimum value from a dim X N integer array */
415    
416    index_t Finley_Util_getFlaggedMinInt(dim_t dim,dim_t N,index_t* values, index_t ignore) {
417       dim_t i,j;
418       index_t out,out_local;
419       out=INDEX_T_MAX;
420       if (values!=NULL && dim*N>0 ) {
421         out=values[0];
422         #pragma omp parallel private(out_local)
423         {
424             out_local=out;
425             #pragma omp for private(i,j) schedule(static)
426             for (j=0;j<N;j++) {
427               for (i=0;i<dim;i++) if (values[INDEX2(i,j,dim)]!=ignore) out_local=MIN(out_local,values[INDEX2(i,j,dim)]);
428             }
429             #pragma omp critical
430             out=MIN(out_local,out);
431       }       }
432     }     }
433     return out;     return out;
434  }  }
435                                                                                                                                                      
436    /* calculates the maximum value from a dim X N integer array */
437    
438    index_t Finley_Util_getFlaggedMaxInt(dim_t dim,dim_t N,index_t* values, index_t ignore) {
439       dim_t i,j;
440       index_t out,out_local;
441       out=-INDEX_T_MAX;
442       if (values!=NULL && dim*N>0 ) {
443         out=values[0];
444         #pragma omp parallel private(out_local)
445         {
446             out_local=out;
447             #pragma omp for private(i,j) schedule(static)
448             for (j=0;j<N;j++) {
449                 for (i=0;i<dim;i++) if (values[INDEX2(i,j,dim)]!=ignore) out_local=MAX(out_local,values[INDEX2(i,j,dim)]);
450             }
451             #pragma omp critical
452             out=MAX(out_local,out);
453          }
454       }
455       return out;
456    }
457    
458  /* set the index of the positive entries in mask. The length of index is returned. */  /* set the index of the positive entries in mask. The length of index is returned. */
459    
460  maybelong Finley_Util_packMask(maybelong N,maybelong* mask,maybelong* index) {  dim_t Finley_Util_packMask(dim_t N,index_t* mask,index_t* index) {
461        maybelong out,k;        dim_t out,k;
462        out=0;        out=0;
463        /*OMP */        /*OMP */
464        for (k=0;k<N;k++) {        for (k=0;k<N;k++) {
# Line 391  maybelong Finley_Util_packMask(maybelong Line 471  maybelong Finley_Util_packMask(maybelong
471  }  }
472    
473  /* returns true if array contains value */  /* returns true if array contains value */
474  int Finley_Util_isAny(maybelong N,maybelong* array,maybelong value) {  bool_t Finley_Util_isAny(dim_t N,index_t* array,index_t value) {
475     int out=FALSE;     bool_t out=FALSE;
476     maybelong i;     dim_t i;
477     #pragma omp parallel for private(i) schedule(static) reduction(||:out)     #pragma omp parallel for private(i) schedule(static) reduction(||:out)
478     for (i=0;i<N;i++) out=out || (array[i]==value);     for (i=0;i<N;i++) out = out || (array[i]==value);
479     return out;     return out;
480  }  }
481    /* calculates the cummultative sum in array and returns the total sum */
482  void Finley_copyDouble(int n,double* source, double* target) {  index_t Finley_Util_cumsum(dim_t N,index_t* array) {
483    int i;     index_t out=0,tmp;
484    for (i=0;i<n;i++) target[i]=source[i];     dim_t i;
485       #ifdef _OPENMP
486          index_t *partial_sums=NULL, sum;
487          partial_sums=TMPMEMALLOC(omp_get_max_threads(),index_t);
488          #pragma omp parallel private(sum,i,tmp)
489          {
490            sum=0;
491            #pragma omp for schedule(static)
492            for (i=0;i<N;++i) sum+=array[i];
493            partial_sums[omp_get_thread_num()]=sum;
494            #pragma omp barrier
495            #pragma omp master
496            {
497              out=0;
498              for (i=0;i<omp_get_max_threads();++i) {
499                 tmp=out;
500                 out+=partial_sums[i];
501                 partial_sums[i]=tmp;
502               }
503            }
504            #pragma omp barrier
505            sum=partial_sums[omp_get_thread_num()];
506            #pragma omp for schedule(static)
507            for (i=0;i<N;++i) {
508              tmp=sum;
509              sum+=array[i];
510              array[i]=tmp;
511            }
512          }
513          TMPMEMFREE(partial_sums);
514       #else
515          for (i=0;i<N;++i) {
516             tmp=out;
517             out+=array[i];
518             array[i]=tmp;
519          }
520       #endif
521       return out;
522    }
523    void Finley_Util_setValuesInUse(const index_t *values, const dim_t numValues, dim_t *numValuesInUse, index_t **valuesInUse, Paso_MPIInfo* mpiinfo)
524    {
525       dim_t i;
526       index_t lastFoundValue=INDEX_T_MIN, minFoundValue, local_minFoundValue, *newValuesInUse=NULL;
527       register index_t itmp;
528       bool_t allFound=FALSE;
529       dim_t nv=0;
530    
531       while (! allFound) {
532           /*
533            *  find smallest value bigger than lastFoundValue
534            */
535            minFoundValue=INDEX_T_MAX;
536            #pragma omp parallel private(local_minFoundValue)
537            {
538                local_minFoundValue=minFoundValue;
539                #pragma omp for private(i,itmp) schedule(static)
540                for (i=0;i< numValues;i++) {
541                   itmp=values[i];
542                   if ((itmp>lastFoundValue) && (itmp<local_minFoundValue)) local_minFoundValue=itmp;
543                }
544                #pragma omp critical
545                minFoundValue=MIN(local_minFoundValue,minFoundValue);
546             }
547             #ifdef PASO_MPI
548             local_minFoundValue=minFoundValue;
549             MPI_Allreduce(&local_minFoundValue,&minFoundValue, 1, MPI_INT, MPI_MAX, mpiinfo->comm );
550             #endif
551    
552             /* if we found a new tag we need to add this too the valuesInUseList */
553    
554             if (minFoundValue < INDEX_T_MAX) {
555                 newValuesInUse=MEMALLOC(nv+1,index_t);
556                 if (*valuesInUse!=NULL) {
557                     memcpy(newValuesInUse,*valuesInUse,sizeof(index_t)*nv);
558                     MEMFREE(*valuesInUse);
559                 }
560                 newValuesInUse[nv]=minFoundValue;
561                 *valuesInUse=newValuesInUse;
562                 newValuesInUse=NULL;
563                 nv++;
564                 lastFoundValue=minFoundValue;
565             } else {
566                 allFound=TRUE;
567             }
568       }
569       *numValuesInUse=nv;
570  }  }
571    
572  /*  
573   * $Log$  #ifdef PASO_MPI
574   * Revision 1.3  2004/12/15 03:48:47  jgs  void Finley_printDoubleArray( FILE *fid, dim_t n, double *array, char *name  )
575   * *** empty log message ***  {
576   *    index_t i;
577   * Revision 1.1.1.1  2004/10/26 06:53:57  jgs    
578   * initial import of project esys2    if( name )
579   *      fprintf( fid, "%s [ ", name );
580   * Revision 1.3  2004/08/26 12:03:52  gross    else
581   * Some other bug in Finley_Assemble_gradient fixed.      fprintf( fid, "[ " );  
582   *    for( i=0; i<(n<60 ? n : 60); i++ )
583   * Revision 1.2  2004/07/02 04:21:13  gross      fprintf( fid, "%g ", array[i] );
584   * Finley C code has been included    if( n>=30 )
585   *      fprintf( fid, "... " );
586   * Revision 1.1.1.1  2004/06/24 04:00:40  johng    fprintf( fid, "]\n" );
587   * Initial version of eys using boost-python.  }
588   *  void Finley_printIntArray( FILE *fid, dim_t n, int *array, char *name  )
589   *  {
590   */    index_t i;
591      
592      if( name )
593        fprintf( fid, "%s [ ", name );
594      else
595        fprintf( fid, "[ " );  
596      for( i=0; i<(n<60 ? n : 60); i++ )
597        fprintf( fid, "%d ", array[i] );
598      if( n>=30 )
599        fprintf( fid, "... " );
600      fprintf( fid, "]\n" );
601    }
602    void Finley_printMaskArray( FILE *fid, dim_t n, int *array, char *name  )
603    {
604      index_t i;
605      
606      if( name )
607        fprintf( fid, "%s [ ", name );
608      else
609        fprintf( fid, "[ " );  
610      for( i=0; i<(n<60 ? n : 60); i++ )
611        if( array[i]!=-1 )
612          fprintf( fid, "%3d ", array[i] );
613        else
614          fprintf( fid, "  * " );
615      if( n>=30 )
616        fprintf( fid, "... " );
617      fprintf( fid, "]\n" );
618    }
619    #endif

Legend:
Removed from v.100  
changed lines
  Added in v.1716

  ViewVC Help
Powered by ViewVC 1.1.26