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

Contents of /branches/domexper/dudley/src/Assemble_PDE_System2_C.c

Parent Directory Parent Directory | Revision Log Revision Log


Revision 3136 - (show annotations)
Thu Sep 2 03:48:29 2010 UTC (8 years, 10 months ago) by jfenwick
File MIME type: text/plain
File size: 8683 byte(s)
Removed numSubElements
1
2 /*******************************************************
3 *
4 * Copyright (c) 2003-2010 by University of Queensland
5 * Earth Systems Science Computational Center (ESSCC)
6 * http://www.uq.edu.au/esscc
7 *
8 * Primary Business: Queensland, Australia
9 * Licensed under the Open Software License version 3.0
10 * http://www.opensource.org/licenses/osl-3.0.php
11 *
12 *******************************************************/
13
14
15 /**************************************************************/
16
17 /* assembles the system of numEq PDEs into the stiffness matrix S right hand side F */
18
19 /* D_{k,m} u_m and Y_k */
20
21 /* u has p.numComp components in a 3D domain. The shape functions for test and solution must be identical */
22 /* and 2* row_NS == row_NN (contact elements) */
23
24 /* Shape of the coefficients: */
25
26 /* D = p.numEqu x p.numComp */
27 /* Y = p.numEqu */
28
29
30 /**************************************************************/
31
32 /* Author: Lutz Gross, l.gross@uq.edu.au */
33 /* Version: $Id:$ */
34
35 /**************************************************************/
36
37
38 #include "Assemble.h"
39 #include "Util.h"
40 #ifdef _OPENMP
41 #include <omp.h>
42 #endif
43
44
45 /**************************************************************/
46
47 void Dudley_Assemble_PDE_System2_C(Assemble_Parameters p, Dudley_ElementFile* elements,
48 Paso_SystemMatrix* Mat, escriptDataC* F, escriptDataC* D, escriptDataC* Y) {
49
50 index_t color;
51 dim_t e;
52 __const double *D_p, *Y_p, *D_q, *Y_q;
53 double *EM_S, *EM_F, *Vol;
54 index_t *row_index;
55 register dim_t q, s,r,k,m;
56 register double rtmp, rtmp_D;
57 bool_t add_EM_F, add_EM_S;
58
59 bool_t extendedD=isExpanded(D);
60 bool_t extendedY=isExpanded(Y);
61 double *F_p=(requireWrite(F), getSampleDataRW(F,0)); /* use comma, to get around the mixed code and declarations thing */
62 double *S=p.row_jac->BasisFunctions->S;
63
64 #pragma omp parallel private(color,EM_S, EM_F, Vol, D_p, Y_p, D_q, Y_q, row_index,q, s,r,k,m,rtmp, rtmp_D,add_EM_F, add_EM_S)
65 {
66 EM_S=THREAD_MEMALLOC(p.row_numShapesTotal*p.col_numShapesTotal*p.numEqu*p.numComp,double);
67 EM_F=THREAD_MEMALLOC(p.row_numShapesTotal*p.numEqu,double);
68 row_index=THREAD_MEMALLOC(p.row_numShapesTotal,index_t);
69
70 if (!Dudley_checkPtr(EM_S) && !Dudley_checkPtr(EM_F) && !Dudley_checkPtr(row_index) ) {
71
72 for (color=elements->minColor;color<=elements->maxColor;color++) {
73 /* open loop over all elements: */
74 #pragma omp for private(e) schedule(static)
75 for(e=0;e<elements->numElements;e++){
76 if (elements->Color[e]==color) {
77
78 D_p=getSampleDataRO(D,e);
79 Y_p=getSampleDataRO(Y,e);
80
81 Vol=&(p.row_jac->volume[INDEX3(0,0,e, p.numQuadSub,1)]);
82 add_EM_F=FALSE;
83 add_EM_S=FALSE;
84
85 /*************************************************************/
86 /* process D */
87 /**************************************************************/
88 if (NULL!=D_p) {
89 add_EM_S=TRUE;
90 if (extendedD) {
91 D_q=&(D_p[INDEX4(0,0,0,0, p.numEqu,p.numComp, p.numQuadSub)]);
92 for (s=0;s<p.row_numShapes;s++) {
93 for (r=0;r<p.col_numShapes;r++) {
94 for (k=0;k<p.numEqu;k++) {
95 for (m=0;m<p.numComp;m++) {
96 rtmp=0;
97 for (q=0;q<p.numQuadSub;q++) {
98 rtmp+=Vol[q]*S[INDEX2(s,q,p.row_numShapes)]*D_q[INDEX3(k,m,q,p.numEqu,p.numComp)]*S[INDEX2(r,q,p.row_numShapes)];
99 }
100 EM_S[INDEX4(k,m,s ,r ,p.numEqu,p.numComp,p.row_numShapesTotal)]= rtmp;
101 EM_S[INDEX4(k,m,s ,r+p.col_numShapes,p.numEqu,p.numComp,p.row_numShapesTotal)]=-rtmp;
102 EM_S[INDEX4(k,m,s+p.row_numShapes,r ,p.numEqu,p.numComp,p.row_numShapesTotal)]=-rtmp;
103 EM_S[INDEX4(k,m,s+p.row_numShapes,r+p.col_numShapes,p.numEqu,p.numComp,p.row_numShapesTotal)]= rtmp;
104 }
105 }
106 }
107 }
108 } else {
109 for (s=0;s<p.row_numShapes;s++) {
110 for (r=0;r<p.col_numShapes;r++) {
111 rtmp=0;
112 for (q=0;q<p.numQuadSub;q++) rtmp+=Vol[q]*S[INDEX2(s,q,p.row_numShapes)]*S[INDEX2(r,q,p.row_numShapes)];
113 for (k=0;k<p.numEqu;k++) {
114 for (m=0;m<p.numComp;m++) {
115 rtmp_D=rtmp*D_p[INDEX2(k,m,p.numEqu)];
116 EM_S[INDEX4(k,m,s ,r ,p.numEqu,p.numComp,p.row_numShapesTotal)]= rtmp_D;
117 EM_S[INDEX4(k,m,s ,r+p.col_numShapes,p.numEqu,p.numComp,p.row_numShapesTotal)]=-rtmp_D;
118 EM_S[INDEX4(k,m,s+p.row_numShapes,r ,p.numEqu,p.numComp,p.row_numShapesTotal)]=-rtmp_D;
119 EM_S[INDEX4(k,m,s+p.row_numShapes,r+p.col_numShapes,p.numEqu,p.numComp,p.row_numShapesTotal)]= rtmp_D;
120 }
121 }
122 }
123 }
124 }
125 }
126 /**************************************************************/
127 /* process Y: */
128 /**************************************************************/
129 if (NULL!=Y_p) {
130 add_EM_F=TRUE;
131 if (extendedY) {
132 Y_q=&(Y_p[INDEX3(0,0,0, p.numEqu,p.numQuadSub)]);
133 for (s=0;s<p.row_numShapes;s++) {
134 for (k=0;k<p.numEqu;k++) {
135 rtmp=0;
136 for (q=0;q<p.numQuadSub;q++) rtmp+=Vol[q]*S[INDEX2(s,q,p.row_numShapes)]*Y_q[INDEX2(k,q,p.numEqu)];
137 EM_F[INDEX2(k,s ,p.numEqu)]=-rtmp;
138 EM_F[INDEX2(k,s+p.row_numShapes,p.numEqu)]= rtmp;
139 }
140 }
141 } else {
142 for (s=0;s<p.row_numShapes;s++) {
143 rtmp=0;
144 for (q=0;q<p.numQuadSub;q++) rtmp+=Vol[q]*S[INDEX2(s,q,p.row_numShapes)];
145 for (k=0;k<p.numEqu;k++) {
146 rtmp_D=rtmp*Y_p[k];
147 EM_F[INDEX2(k,s ,p.numEqu)]=-rtmp_D;
148 EM_F[INDEX2(k,s+p.row_numShapes,p.numEqu)]= rtmp_D;
149 }
150 }
151 }
152 }
153 /***********************************************************************************************/
154 /* add the element matrices onto the matrix and right hand side */
155 /***********************************************************************************************/
156 for (q=0;q<p.row_numShapesTotal;q++) row_index[q]=p.row_DOF[ elements->Nodes[ INDEX2(p.row_node[INDEX2(q,0,p.row_numShapesTotal)],e,p.NN)] ];
157
158 if (add_EM_F) Dudley_Util_AddScatter(p.row_numShapesTotal,row_index,p.numEqu,EM_F,F_p, p.row_DOF_UpperBound);
159 if (add_EM_S) Dudley_Assemble_addToSystemMatrix(Mat,p.row_numShapesTotal,row_index,p.numEqu,p.col_numShapesTotal,row_index,p.numComp,EM_S);
160
161 } /* end color check */
162 } /* end element loop */
163 } /* end color loop */
164
165 THREAD_MEMFREE(EM_S);
166 THREAD_MEMFREE(EM_F);
167 THREAD_MEMFREE(row_index);
168
169 } /* end of pointer check */
170 } /* end parallel region */
171 }
172

  ViewVC Help
Powered by ViewVC 1.1.26