| 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 |
} |