Debian Codegraph @

3rdparty/mshmet/src/sourceslib/defmet.c

raw
1 #include "mshmet.h"
2
3
4 /* create 3d metric */
5 int defmet_3d(pMesh mesh,pSol sol,int is) {
6 double lmax,lambda[3],vp[3][3],m[6],mr[6],hlmin,hlmax;
7 double *tmet,*hes,dd;
8 int i,j,k,l,iadr,iasol;
9
10 hlmin = 1.0 / (mesh->info.hmax*mesh->info.hmax);
11 hlmax = 1.0 / (mesh->info.hmin*mesh->info.hmin);
12
13 for (k=1; k<=mesh->np; k++) {
14 iadr = (k-1)*6 + 1;
15 hes = &sol->hes[iadr];
16 if ( !eigenv(1,hes,lambda,vp) ) {
17 if ( mesh->info.imprim < 0 )
18 fprintf(stdout," %%%% Unable to define metric %d.\n",k);
19 return(0);
20 }
21
22 /* truncation */
23 lmax = 0.0;
24 for (i=0; i<3; i++) {
25 dd = MS_MAX(fabs(lambda[i]),hlmin);
26 lambda[i] = MS_MIN(dd,hlmax);
27 if ( lambda[i] > lmax ) lmax = lambda[i];
28 }
29
30 if ( mesh->info.iso ) {
31 tmet = &sol->met[k];
32 if ( is == 0 && !mesh->info.metric )
33 tmet[0] = 1.0 / sqrt(lmax);
34 else
35 tmet[0] = MS_MIN(1.0/sqrt(lmax),tmet[0]);
36 }
37
38 else {
39 iasol = (k-1)*6 + 1;
40 tmet = &sol->met[iasol];
41
42 /* compute Mat = B M Bt */
43 for (l=0,i=0; i<3; i++)
44 for (j=i; j<3; j++)
45 m[l++] = lambda[0]*vp[0][i]*vp[0][j] + lambda[1]*vp[1][i]*vp[1][j] \
46 + lambda[2]*vp[2][i]*vp[2][j];
47
48 if ( is == 0 && !mesh->info.metric ) {
49 for (i=0; i<6; i++) tmet[i] = m[i];
50 }
51 else {
52 if ( !redsim(tmet,m,mr) ) {
53 fprintf(stdout," %%%% Metric problem (point: %d)\n",k);
54 if ( mesh->info.ddebug ) {
55 fprintf(stdout," lambda: %e %e %e\n",lambda[0],lambda[1],lambda[2]);
56 fprintf(stdout," mat %e %e %e\n%e %e\n %e\n",m[0],m[1],m[2],m[3],m[4],m[5]);
57 }
58 return(0);
59 }
60 else
61 for (i=0; i<6; i++) tmet[i] = mr[i];
62 }
63 }
64 }
65
66 return(1);
67 }
68
69
70 int defmet_2d(pMesh mesh,pSol sol,int is) {
71 double lambda[2],vp[2][2],mat[3],mr[3],dd,hlmin,hlmax;
72 double *tmet,*hes;
73 int i,k,iasol,iadr;
74
75 hlmin = 1.0 / (mesh->info.hmax*mesh->info.hmax);
76 hlmax = 1.0 / (mesh->info.hmin*mesh->info.hmin);
77 for (k=1; k<=mesh->np; k++) {
78 iadr = (k-1)*3 + 1;
79 hes = &sol->hes[iadr];
80 if ( !eigen2(hes,lambda,vp) ) {
81 if ( mesh->info.imprim < 0 )
82 fprintf(stdout," %%%% Unable to define metric %d.\n",k);
83 return(0);
84 }
85
86 /* truncation */
87 dd = MS_MAX(fabs(lambda[0]),hlmin);
88 lambda[0] = MS_MIN(dd,hlmax);
89 dd = MS_MAX(fabs(lambda[1]),hlmin);
90 lambda[1] = MS_MIN(dd,hlmax);
91
92 if ( mesh->info.iso ) {
93 tmet = &sol->met[k];
94 if ( lambda[0] < lambda[1] )
95 lambda[0] = lambda[1];
96 else
97 lambda[1] = lambda[0];
98 if ( is == 0 && !mesh->info.metric )
99 tmet[0] = 1.0 / sqrt(lambda[0]);
100 else
101 tmet[0] = MS_MIN(1.0/sqrt(lambda[0]),tmet[0]);
102 }
103
104 else {
105 iasol = (k-1)*3 + 1;
106 tmet = &sol->met[iasol];
107
108 /* compute Mat = B M Bt */
109 mat[0] = lambda[0]*vp[0][0]*vp[0][0] + lambda[1]*vp[1][0]*vp[1][0];
110 mat[1] = lambda[0]*vp[0][0]*vp[0][1] + lambda[1]*vp[1][0]*vp[1][1];
111 mat[2] = lambda[0]*vp[0][1]*vp[0][1] + lambda[1]*vp[1][1]*vp[1][1];
112
113 if ( is == 0 && !mesh->info.metric ) {
114 tmet[0] = mat[0];
115 tmet[1] = mat[1];
116 tmet[2] = mat[2];
117 }
118 else { /* intersection */
119 redsim(tmet,mat,mr);
120 for (i=0; i<3; i++) tmet[i] = mr[i];
121 }
122 }
123 }
124
125 return(1);
126 }
127
128
129 int defmet_s(pMesh mesh,pSol sol,int is) {
130 double lmax,lambda[3],vp[3][3],m[6],mr[6],hlmin,hlmax;
131 double *tmet,*hes,*nn,dd,d1,d2,d3;
132 int i,j,k,l,iadr,iasol;
133
134 hlmin = 1.0 / (mesh->info.hmax*mesh->info.hmax);
135 hlmax = 1.0 / (mesh->info.hmin*mesh->info.hmin);
136
137 for (k=1; k<=mesh->np; k++) {
138 iadr = (k-1)*6 + 1;
139 hes = &sol->hes[iadr];
140 if ( !eigenv(1,hes,lambda,vp) ) {
141 if ( mesh->info.imprim < 0 )
142 fprintf(stdout," %%%% Unable to define metric %d.\n",k);
143 return(0);
144 }
145
146 iadr = (k-1)*sol->dim + 1;
147 nn = &sol->nn[iadr];
148
149 d1 = fabs(nn[0]*vp[0][0] + nn[1]*vp[0][1] + nn[2]*vp[0][2]);
150 d2 = fabs(nn[0]*vp[1][0] + nn[1]*vp[1][1] + nn[2]*vp[1][2]);
151 d3 = fabs(nn[0]*vp[2][0] + nn[1]*vp[2][1] + nn[2]*vp[2][2]);
152
153 if ( d1 > d2 ) {
154 if ( d1 > d3 ) {
155 //memcpy(vp[0],nn,3*sizeof(double));
156 lambda[0] = hlmin;
157 }
158 else {
159 //memcpy(vp[2],nn,3*sizeof(double));
160 lambda[2] = hlmin;
161 }
162 }
163 else if ( d2 > d3 ) {
164 //memcpy(vp[1],nn,3*sizeof(double));
165 lambda[1] = hlmin;
166 }
167 else {
168 //memcpy(vp[2],nn,3*sizeof(double));
169 lambda[2] = hlmin;
170 }
171
172 /* truncation */
173 lmax = 0.0;
174 for (i=0; i<3; i++) {
175 dd = MS_MAX(fabs(lambda[i]),hlmin);
176 lambda[i] = MS_MIN(dd,hlmax);
177 if ( lambda[i] > lmax ) lmax = lambda[i];
178 }
179
180 if ( mesh->info.iso ) {
181 tmet = &sol->met[k];
182 if ( is == 0 && !mesh->info.metric )
183 tmet[0] = 1.0 / sqrt(lmax);
184 else
185 tmet[0] = MS_MIN(1.0/sqrt(lmax),tmet[0]);
186 }
187
188 else {
189 iasol = (k-1)*6 + 1;
190 tmet = &sol->met[iasol];
191
192 /* compute Mat = B M Bt */
193 for (l=0,i=0; i<3; i++)
194 for (j=i; j<3; j++)
195 m[l++] = lambda[0]*vp[0][i]*vp[0][j] + lambda[1]*vp[1][i]*vp[1][j] \
196 + lambda[2]*vp[2][i]*vp[2][j];
197
198 if ( is == 0 && !mesh->info.metric ) {
199 for (i=0; i<6; i++) tmet[i] = m[i];
200 }
201 else {
202 redsim(tmet,m,mr);
203 for (i=0; i<6; i++) tmet[i] = mr[i];
204 }
205 }
206 }
207
208 return(1);
209 }