/*!
@par Revision history:
- c: 05.03.2008, r: 05.03.2008
*/
int32 d_biot_div( FMField *out, float64 coef, FMField *state, FMField *strain,
FMField *mtxD, Mapping *vg )
{
int32 ii, nQP, ret = RET_OK;
FMField *dtgu = 0, *pftdtgu = 0;
nQP = vg->bfGM->nLev;
/* fmf_print( mtxD, stdout, 0 ); */
fmf_createAlloc( &dtgu, 1, nQP, 1, 1 );
fmf_createAlloc( &pftdtgu, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( mtxD, ii );
FMF_SetCell( vg->det, ii );
FMF_SetCell( state, ii );
FMF_SetCell( strain, ii );
fmf_mulATB_nn( dtgu, mtxD, strain );
fmf_mulATB_nn( pftdtgu, state, dtgu );
fmf_sumLevelsMulF( out, pftdtgu, vg->det->val );
ERR_CheckGo( ret );
}
// E.g. 1/dt.
fmfc_mulC( out, coef );
end_label:
fmf_freeDestroy( &dtgu );
fmf_freeDestroy( &pftdtgu );
return( ret );
}
/*!
@par Revision history:
- 24.10.2007, c
*/
int32 d_sd_st_grad_div( FMField *out, FMField *divU, FMField *gradU,
FMField *divW, FMField *gradW, FMField *divMV,
FMField *gradMV, FMField *coef,
VolumeGeometry *vg_u, int32 mode )
{
int32 ii, nQP, ret = RET_OK;
FMField *scalar1 = 0, *scalar2 = 0;
nQP = vg_u->bfGM->nLev;
fmf_createAlloc( &scalar1, 1, nQP, 1, 1 );
if (mode == 1) {
fmf_createAlloc( &scalar2, 1, nQP, 1, 1 );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( coef, ii );
FMF_SetCell( divU, ii );
FMF_SetCell( divW, ii );
FMF_SetCell( vg_u->det, ii );
if (mode == 0) {
// (div u, div w)
fmf_mulATB_nn( scalar1, divU, divW );
fmf_mul( scalar1, coef->val );
fmf_sumLevelsMulF( out, scalar1, vg_u->det->val );
} else if (mode == 1) {
FMF_SetCell( divMV, ii );
FMF_SetCell( gradU, ii );
FMF_SetCell( gradW, ii );
FMF_SetCell( gradMV, ii );
// div u div w div nu ...
fmf_mulATB_nn( scalar1, divU, divW );
fmf_mulATB_nn( scalar2, divMV, scalar1 );
// ... - (gu : gnu^T) div w ...
sub_mul_gradddgrad_scalar( scalar2, gradMV, gradU, divW );
// ... - (gw : gnu^T) div u
sub_mul_gradddgrad_scalar( scalar2, gradMV, gradW, divU );
fmf_mul( scalar2, coef->val );
fmf_sumLevelsMulF( out, scalar2, vg_u->det->val );
}
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &scalar1 );
if (mode == 1) {
fmf_freeDestroy( &scalar2 );
}
return( ret );
}
int32 d_diffusion_sa( FMField *out,
FMField *grad_q, FMField *grad_p,
FMField *grad_w, FMField *div_w,
FMField *mtxD, Mapping *vg )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *aux2 = 0, *aux3 = 0, *aux4 = 0, *out0 = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
FMF_SetFirst( out );
fmf_createAlloc( &aux2, 1, nQP, dim, 1 );
fmf_createAlloc( &aux3, 1, nQP, 1, 1 );
fmf_createAlloc( &aux4, 1, nQP, dim, 1 );
fmf_createAlloc( &out0, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( vg->bfGM, ii );
FMF_SetCell( vg->det, ii );
FMF_SetCell( mtxD, ii );
FMF_SetCell( grad_q, ii );
FMF_SetCell( grad_p, ii );
FMF_SetCell( grad_w, ii );
FMF_SetCell( div_w, ii );
/* div w K_ij grad_j q grad_i p */
fmf_mulAB_nn( aux2, mtxD, grad_p );
fmf_mulATB_nn( aux3, grad_q, aux2 );
fmf_mulAB_nn( out0, div_w, aux3 );
/* grad_k q K_ij grad_j w_k grad_i p */
fmf_mulATB_nn( aux4, grad_w, aux2 );
fmf_mulATB_nn( aux3, grad_q, aux4 );
fmf_subAB_nn( out0, out0, aux3 );
/* grad_k q K_ij grad_j w_k grad_i p */
fmf_mulAB_nn( aux2, grad_w, grad_p );
fmf_mulAB_nn( aux4, mtxD, aux2 );
fmf_mulATB_nn( aux3, grad_q, aux4 );
fmf_subAB_nn( out0, out0, aux3 );
fmf_sumLevelsMulF( out, out0, vg->det->val );
FMF_SetCellNext( out );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &out0 );
fmf_freeDestroy( &aux2 );
fmf_freeDestroy( &aux3 );
fmf_freeDestroy( &aux4 );
return( ret );
}
int32 dw_surface_flux(FMField *out, FMField *grad,
FMField *mat, FMField *bf, Mapping *sg,
int32 *fis, int32 nFa, int32 nFP, int32 mode)
{
int32 ii, ifa, dim, nQP, nEP, ret = RET_OK;
FMField *ntk = 0, *ntkg = 0, *out_qp = 0;
nQP = sg->normal->nLev;
dim = sg->normal->nRow;
nEP = sg->bfGM->nCol;
fmf_createAlloc(&ntk, 1, nQP, 1, dim);
if (mode) {
fmf_createAlloc(&ntkg, 1, nQP, 1, nEP);
fmf_createAlloc(&out_qp, 1, nQP, nEP, nEP);
} else {
fmf_createAlloc(&ntkg, 1, nQP, 1, 1);
fmf_createAlloc(&out_qp, 1, nQP, nEP, 1);
}
for (ii = 0; ii < out->nCell; ii++) {
ifa = fis[ii*nFP+1];
FMF_SetCell(out, ii);
FMF_SetCellX1(mat, ii);
FMF_SetCell(sg->det, ii);
FMF_SetCell(sg->normal, ii);
FMF_SetCell(bf, ifa);
fmf_mulATB_nn(ntk, sg->normal, mat);
if (mode) {
FMF_SetCell(sg->bfGM, ii);
fmf_mulAB_nn(ntkg, ntk, sg->bfGM);
} else {
FMF_SetCell(grad, ii);
fmf_mulAB_nn(ntkg, ntk, grad);
}
fmf_mulATB_nn(out_qp, bf, ntkg);
fmf_sumLevelsMulF(out, out_qp, sg->det->val);
ERR_CheckGo(ret);
}
end_label:
fmf_freeDestroy(&ntk);
fmf_freeDestroy(&ntkg);
fmf_freeDestroy(&out_qp);
return(ret);
}
int32 dw_surface_s_v_dot_n(FMField *out,
FMField *coef, FMField *val_qp,
Mapping *rsg,
Mapping *csg,
int32 isDiff)
{
int32 ii, dim, nQP, nEPR, nEPC, ret = RET_OK;
FMField *aux1 = 0, *aux2 = 0;
nQP = rsg->det->nLev;
dim = csg->normal->nRow;
nEPR = rsg->bf->nCol;
nEPC = csg->bf->nCol;
if (isDiff) {
fmf_createAlloc(&aux2, 1, nQP, nEPR, dim * nEPC);
fmf_createAlloc(&aux1, 1, nQP, dim * nEPC, 1);
} else {
fmf_createAlloc(&aux2, 1, nQP, nEPR, 1);
fmf_createAlloc(&aux1, 1, nQP, 1, 1);
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell(out, ii);
FMF_SetCellX1(coef, ii);
FMF_SetCell(rsg->det, ii);
FMF_SetCellX1(rsg->bf, ii);
FMF_SetCell(csg->normal, ii);
if (isDiff) {
FMF_SetCellX1(csg->bf, ii);
bf_actt(aux1, csg->bf, csg->normal);
fmf_mulATBT_nn(aux2, rsg->bf, aux1);
fmf_mul(aux2, coef->val);
fmf_sumLevelsMulF(out, aux2, rsg->det->val);
} else {
FMF_SetCell(val_qp, ii);
fmf_mulATB_nn(aux1, csg->normal, val_qp);
fmf_mulATB_nn(aux2, rsg->bf, aux1);
fmf_mul(aux2, coef->val);
fmf_sumLevelsMulF(out, aux2, rsg->det->val);
}
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy(&aux1);
fmf_freeDestroy(&aux2);
return( ret );
}
/*!
@par Revision history:
- c: 03.08.2006, r: 23.01.2008
*/
int32 dw_diffusion( FMField *out, FMField *grad,
FMField *mtxD, Mapping *vg,
int32 isDiff )
{
int32 ii, dim, nQP, nEP, ret = RET_OK;
FMField *gtd = 0, *gtdg = 0, *dgp = 0, *gtdgp = 0;
nQP = vg->bfGM->nLev;
nEP = vg->bfGM->nCol;
dim = vg->bfGM->nRow;
if (isDiff) {
fmf_createAlloc( >d, 1, nQP, nEP, dim );
fmf_createAlloc( >dg, 1, nQP, nEP, nEP );
} else {
fmf_createAlloc( &dgp, 1, nQP, dim, 1 );
fmf_createAlloc( >dgp, 1, nQP, nEP, 1 );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( vg->bfGM, ii );
FMF_SetCell( vg->det, ii );
if (mtxD->nCell > 1) {
FMF_SetCell( mtxD, ii );
}
if (isDiff) {
fmf_mulATB_nn( gtd, vg->bfGM, mtxD );
fmf_mulAB_nn( gtdg, gtd, vg->bfGM );
fmf_sumLevelsMulF( out, gtdg, vg->det->val );
} else {
FMF_SetCell( grad, ii );
fmf_mulAB_nn( dgp, mtxD, grad );
fmf_mulATB_nn( gtdgp, vg->bfGM, dgp );
fmf_sumLevelsMulF( out, gtdgp, vg->det->val );
}
ERR_CheckGo( ret );
}
end_label:
if (isDiff) {
fmf_freeDestroy( >d );
fmf_freeDestroy( >dg );
} else {
fmf_freeDestroy( &dgp );
fmf_freeDestroy( >dgp );
}
return( ret );
}
/*!
@par Revision history:
- 04.09.2007, c
*/
int32 d_mass_scalar( FMField *out, FMField *coef,
FMField *stateP, FMField *stateQ,
FMField *bf, VolumeGeometry *vg )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *qftfp = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
fmf_createAlloc( &qftfp, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( stateP, ii );
FMF_SetCell( stateQ, ii );
FMF_SetCell( vg->det, ii );
if (coef->nCell > 1) {
FMF_SetCell( coef, ii );
}
fmf_mulATB_nn( qftfp, stateQ, stateP );
fmf_mul( qftfp, coef->val );
fmf_sumLevelsMulF( out, qftfp, vg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &qftfp );
return( ret );
}
/*!
mode == 0: \int pq
mode == 1: \int pq div V
Works for both scalars and vectors.
@par Revision history:
- 24.02.2006, c
- 27.02.2006
*/
int32 d_sd_volume_dot( FMField *out, FMField *stateP, FMField *stateQ,
FMField *divMV, VolumeGeometry *vg, int32 mode )
{
int32 ii, nQP, ret = RET_OK;
FMField *pq = 0;
nQP = vg->bfGM->nLev;
fmf_createAlloc( &pq, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( stateP, ii );
FMF_SetCell( stateQ, ii );
FMF_SetCell( vg->det, ii );
fmf_mulATB_nn( pq, stateP, stateQ );
if (mode == 1) {
FMF_SetCell( divMV, ii );
fmf_mul( pq, divMV->val );
}
fmf_sumLevelsMulF( out, pq, vg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &pq );
return( ret );
}
/*!
@par Revision history:
- 22.03.2006, c
*/
int32 d_sd_convect( FMField *out, FMField *stateU, FMField *gradU,
FMField *stateW, FMField *divMV, FMField *gradMV,
VolumeGeometry *vg_u, int32 mode )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *aux11 = 0, *aux = 0, *fwgu = 0, *fwgugmv = 0;
FMField gum[1], gmvm[1];
nQP = vg_u->bfGM->nLev;
dim = vg_u->bfGM->nRow;
gum->nAlloc = -1;
fmf_pretend( gum, gradU->nCell, nQP, dim, dim, gradU->val0 );
fmf_createAlloc( &fwgu, 1, nQP, 1, dim );
fmf_createAlloc( &aux11, 1, nQP, 1, 1 );
if (mode == 1) {
gmvm->nAlloc = -1;
fmf_pretend( gmvm, gradMV->nCell, nQP, dim, dim, gradMV->val0 );
fmf_createAlloc( &fwgugmv, 1, nQP, 1, dim );
fmf_createAlloc( &aux, 1, nQP, 1, 1 );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( stateU, ii );
FMF_SetCell( stateW, ii );
FMF_SetCell( gum, ii );
FMF_SetCell( vg_u->det, ii );
fmf_mulATB_nn( fwgu, stateW, gum );
fmf_mulAB_nn( aux11, fwgu, stateU );
if (mode == 1) {
FMF_SetCell( divMV, ii );
FMF_SetCell( gmvm, ii );
fmf_mul( aux11, divMV->val );
fmf_mulAB_nn( fwgugmv, fwgu, gmvm );
fmf_mulAB_nn( aux, fwgugmv, stateU );
fmf_subAB_nn( aux11, aux11, aux );
}
fmf_sumLevelsMulF( out, aux11, vg_u->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &aux11 );
fmf_freeDestroy( &fwgu );
if (mode == 1) {
fmf_freeDestroy( &fwgugmv );
fmf_freeDestroy( &aux );
}
return( ret );
}
/*!
@par Revision history:
- 23.01.2006, c
- 02.03.2006
- 27.07.2006
*/
int32 d_of_nsMinGrad( FMField *out, FMField *grad,
FMField *viscosity, VolumeGeometry *vg )
{
int32 ii, nQP, ret = RET_OK;
float64 aux;
FMField *out1 = 0, *gvel2 = 0;
nQP = vg->bfGM->nLev;
fmf_createAlloc( &out1, 1, 1, 1, 1 );
fmf_createAlloc( &gvel2, 1, nQP, 1, 1 );
FMF_SetFirst( out );
aux = 0.0;
for (ii = 0; ii < grad->nCell; ii++) {
FMF_SetCell( grad, ii );
FMF_SetCell( viscosity, ii );
FMF_SetCell( vg->det, ii );
fmf_mulATB_nn( gvel2, grad, grad );
fmf_mul( gvel2, viscosity->val );
fmf_sumLevelsMulF( out1, gvel2, vg->det->val );
aux += out1->val[0];
ERR_CheckGo( ret );
}
out->val[0] = aux * 0.5;
end_label:
fmf_freeDestroy( &out1 );
fmf_freeDestroy( &gvel2 );
return( ret );
}
int32 d_piezo_coupling( FMField *out, FMField *strain, FMField *charge_grad,
FMField *mtxG, VolumeGeometry *vg )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *ge = 0, *gptge = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
fmf_createAlloc( &ge, 1, nQP, dim, 1 );
fmf_createAlloc( &gptge, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( mtxG, ii );
FMF_SetCell( vg->det, ii );
FMF_SetCell( strain, ii );
FMF_SetCell( charge_grad, ii );
fmf_mulAB_nn( ge, mtxG, strain );
fmf_mulATB_nn( gptge, charge_grad, ge );
fmf_sumLevelsMulF( out, gptge, vg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &ge );
fmf_freeDestroy( &gptge );
return( ret );
}
/*!
@par Revision history:
- c: 23.04.2007, r: 23.01.2008
*/
int32 dw_diffusion_r( FMField *out, FMField *mtxD, Mapping *vg )
{
int32 ii, nQP, nEP, ret = RET_OK;
FMField *gtd = 0;
nQP = vg->bfGM->nLev;
nEP = vg->bfGM->nCol;
fmf_createAlloc( >d, 1, nQP, nEP, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( vg->bfGM, ii );
FMF_SetCell( vg->det, ii );
if (mtxD->nCell > 1) {
FMF_SetCell( mtxD, ii );
}
fmf_mulATB_nn( gtd, vg->bfGM, mtxD );
fmf_sumLevelsMulF( out, gtd, vg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( >d );
return( ret );
}
/*!
@par Revision history:
- c: 12.03.2007, r: 23.01.2008
*/
int32 d_diffusion( FMField *out, FMField *gradP1, FMField *gradP2,
FMField *mtxD, Mapping *vg )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *dgp2 = 0, *gp1tdgp2 = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
fmf_createAlloc( &dgp2, 1, nQP, dim, 1 );
fmf_createAlloc( &gp1tdgp2, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( vg->det, ii );
FMF_SetCell( gradP1, ii );
FMF_SetCell( gradP2, ii );
if (mtxD->nCell > 1) {
FMF_SetCell( mtxD, ii );
}
fmf_mulAB_nn( dgp2, mtxD, gradP2 );
fmf_mulATB_nn( gp1tdgp2, gradP1, dgp2 );
fmf_sumLevelsMulF( out, gp1tdgp2, vg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &dgp2 );
fmf_freeDestroy( &gp1tdgp2 );
return( ret );
}
/*!
@par Revision history:
- c: 23.04.2007, r: 23.01.2008
*/
int32 dw_permeability_r( FMField *out, FMField *mtxD, VolumeGeometry *vg,
int32 *conn, int32 nEl, int32 nEP,
int32 *elList, int32 elList_nRow )
{
int32 ii, iel, nQP, ret = RET_OK;
FMField *gtd = 0;
nQP = vg->bfGM->nLev;
fmf_createAlloc( >d, 1, nQP, nEP, 1 );
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( out, ii );
FMF_SetCell( vg->bfGM, iel );
FMF_SetCell( vg->det, iel );
if (mtxD->nCell > 1) {
FMF_SetCell( mtxD, ii );
}
fmf_mulATB_nn( gtd, vg->bfGM, mtxD );
fmf_sumLevelsMulF( out, gtd, vg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( >d );
return( ret );
}
int32 d_surf_lcouple( FMField *out, FMField *stateP, FMField *gradQ, FMField *coef,
Mapping *sg )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *aux1 = 0, *aux2 = 0;
nQP = stateP->nLev;
dim = coef->nRow;
fmf_createAlloc(&aux1, 1, nQP, dim, 1);
fmf_createAlloc(&aux2, 1, nQP, 1, 1);
for (ii = 0; ii < out->nCell; ii++) {
if (coef->nCell > 1)
FMF_SetCell( coef, ii );
FMF_SetCell( out, ii );
FMF_SetCell( sg->det, ii );
FMF_SetCell(stateP, ii);
FMF_SetCell(gradQ, ii);
fmf_mulAB_nn(aux1, coef, stateP);
fmf_mulATB_nn(aux2, gradQ, aux1);
fmf_sumLevelsMulF(out, aux2, sg->det->val);
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy(&aux1);
fmf_freeDestroy(&aux2);
return( ret );
}
/*!
@par Revision history:
- 01.02.2008, c
*/
int32 dw_mass_scalar( FMField *out, FMField *coef,
FMField *state, FMField *bf, VolumeGeometry *vg,
int32 isDiff )
{
int32 ii, dim, nQP, nEP, ret = RET_OK;
FMField *ftfp = 0, *ftf = 0, *cftf = 0;
nQP = vg->bfGM->nLev;
nEP = vg->bfGM->nCol;
dim = vg->bfGM->nRow;
if (isDiff) {
fmf_createAlloc( &ftf, 1, nQP, nEP, nEP );
fmf_createAlloc( &cftf, 1, nQP, nEP, nEP );
fmf_mulATB_nn( ftf, bf, bf );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( vg->det, ii );
if (coef->nCell > 1) {
FMF_SetCell( coef, ii );
}
fmf_mulAF( cftf, ftf, coef->val );
fmf_sumLevelsMulF( out, cftf, vg->det->val );
ERR_CheckGo( ret );
}
} else {
fmf_createAlloc( &ftfp, 1, nQP, nEP, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( state, ii );
FMF_SetCell( vg->det, ii );
if (coef->nCell > 1) {
FMF_SetCell( coef, ii );
}
bf_actt( ftfp, bf, state );
fmf_mul( ftfp, coef->val );
fmf_sumLevelsMulF( out, ftfp, vg->det->val );
ERR_CheckGo( ret );
}
}
end_label:
if (isDiff) {
fmf_freeDestroy( &ftf );
fmf_freeDestroy( &cftf );
} else {
fmf_freeDestroy( &ftfp );
}
return( ret );
}
/*!
@par Revision history:
- 09.03.2009, c
*/
int32 dw_surf_mass_scalar( FMField *out, FMField *coef,
FMField *state, FMField *bf, SurfaceGeometry *sg,
int32 isDiff )
{
int32 ii, nFP, ret = RET_OK;
FMField *ftfp = 0, *ftf = 0, *cftf = 0;
nFP = bf->nCol;
if (isDiff) {
fmf_createAlloc( &ftf, 1, sg->nQP, nFP, nFP );
fmf_createAlloc( &cftf, 1, sg->nQP, nFP, nFP );
fmf_mulATB_nn( ftf, bf, bf );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( sg->det, ii );
if (coef->nCell > 1) {
FMF_SetCell( coef, ii );
}
fmf_mulAF( cftf, ftf, coef->val );
fmf_sumLevelsMulF( out, cftf, sg->det->val );
ERR_CheckGo( ret );
}
} else {
fmf_createAlloc( &ftfp, 1, sg->nQP, nFP, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( sg->det, ii );
if (coef->nCell > 1) {
FMF_SetCell( coef, ii );
}
FMF_SetCell( state, ii );
bf_actt( ftfp, bf, state );
fmf_mulAF( ftfp, ftfp, coef->val );
fmf_sumLevelsMulF( out, ftfp, sg->det->val );
ERR_CheckGo( ret );
}
}
end_label:
if (isDiff) {
fmf_freeDestroy( &ftf );
fmf_freeDestroy( &cftf );
} else {
fmf_freeDestroy( &ftfp );
}
return( ret );
}
/*!
@par Revision history:
- 20.12.2005, c
- 22.03.2006
- 27.07.2006
*/
int32 dw_adj_convect2( FMField *out, FMField *stateW, FMField *stateU,
VolumeGeometry *vg, int32 isDiff )
{
int32 ii, dim, nQP, nEP, ret = RET_OK;
FMField *vtg = 0, *ftvtg = 0;
FMField *futvtg = 0;
nQP = vg->bfGM->nLev;
nEP = vg->bfGM->nCol;
dim = vg->bfGM->nRow;
fmf_createAlloc( &vtg, 1, nQP, dim, nEP * dim );
if (isDiff) {
fmf_createAlloc( &ftvtg, 1, nQP, dim * nEP, dim * nEP );
} else {
fmf_createAlloc( &futvtg, 1, nQP, 1, dim * nEP );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( stateU, ii );
FMF_SetCell( vg->bfGM, ii );
FMF_SetCell( vg->det, ii );
convect_build_vtg( vtg, vg->bfGM, stateU );
if (isDiff) {
FMF_SetCellX1( vg->bf, ii );
bf_actt( ftvtg, vg->bf, vtg );
fmf_sumLevelsTMulF( out, ftvtg, vg->det->val );
} else {
FMF_SetCell( stateW, ii );
fmf_mulATB_nn( futvtg, stateW, vtg );
fmf_sumLevelsTMulF( out, futvtg, vg->det->val );
}
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &vtg );
if (isDiff) {
fmf_freeDestroy( &ftvtg );
} else {
fmf_freeDestroy( &futvtg );
}
return( ret );
}
int32 dw_surface_dot_vector( FMField *out, FMField *coef, FMField *val_qp,
SurfaceGeometry *rsg, SurfaceGeometry *csg,
int32 isDiff )
{
int32 ii, dim, nQP, nEPR, nEPC, ret = RET_OK;
FMField *ftfu = 0, *ftf1 = 0, *ftf = 0;
nQP = rsg->normal->nLev;
dim = rsg->normal->nRow;
nEPR = rsg->bf->nCol;
nEPC = csg->bf->nCol;
if (isDiff) {
fmf_createAlloc( &ftf, 1, nQP, nEPR * dim, nEPC * dim );
fmf_createAlloc( &ftf1, 1, nQP, nEPR, nEPC );
} else {
fmf_createAlloc( &ftfu, 1, nQP, dim * nEPR, 1 );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCellX1( coef, ii );
FMF_SetCell( rsg->det, ii );
FMF_SetCellX1( rsg->bf, ii );
if (isDiff) {
FMF_SetCellX1( csg->bf, ii );
fmf_mulATB_nn( ftf1, rsg->bf, csg->bf );
bf_buildFTF( ftf, ftf1 );
fmf_mul( ftf, coef->val );
fmf_sumLevelsMulF( out, ftf, rsg->det->val );
} else {
FMF_SetCell( val_qp, ii );
bf_actt( ftfu, rsg->bf, val_qp );
fmf_mul( ftfu, coef->val );
fmf_sumLevelsMulF( out, ftfu, rsg->det->val );
}
ERR_CheckGo( ret );
}
end_label:
if (isDiff) {
fmf_freeDestroy( &ftf1 );
fmf_freeDestroy( &ftf );
} else {
fmf_freeDestroy( &ftfu );
}
return( ret );
}
/*!
@par Revision history:
- 01.02.2008, c
*/
int32 dw_volume_dot_scalar( FMField *out, FMField *coef, FMField *val_qp,
Mapping *rvg, Mapping *cvg,
int32 isDiff )
{
int32 ii, nQP, nEPR, nEPC, ret = RET_OK;
FMField *ftfp = 0, *ftf = 0, *cftf = 0;
nQP = rvg->nQP;
nEPR = rvg->bf->nCol;
nEPC = cvg->bf->nCol;
if (isDiff) {
fmf_createAlloc( &ftf, 1, nQP, nEPR, nEPC );
fmf_createAlloc( &cftf, 1, nQP, nEPR, nEPC );
} else {
fmf_createAlloc( &ftfp, 1, nQP, nEPR, 1 );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( rvg->det, ii );
FMF_SetCellX1( coef, ii );
FMF_SetCellX1( rvg->bf, ii );
if (isDiff) {
FMF_SetCellX1( cvg->bf, ii );
fmf_mulATB_nn( ftf, rvg->bf, cvg->bf );
fmf_mulAF( cftf, ftf, coef->val );
fmf_sumLevelsMulF( out, cftf, rvg->det->val );
} else {
FMF_SetCell( val_qp, ii );
bf_actt( ftfp, rvg->bf, val_qp );
fmf_mul( ftfp, coef->val );
fmf_sumLevelsMulF( out, ftfp, rvg->det->val );
}
ERR_CheckGo( ret );
}
end_label:
if (isDiff) {
fmf_freeDestroy( &ftf );
fmf_freeDestroy( &cftf );
} else {
fmf_freeDestroy( &ftfp );
}
return( ret );
}
/*!
For scalar input p: \int_{\Gamma} p dS
For vector input v: \int_{\Gamma} v n dS
@par Revision history:
- 01.11.2007, c
*/
int32 sg_integrateChunk( SurfaceGeometry *obj, FMField *out, FMField *in,
int32 *elList, int32 elList_nRow, int32 mode )
{
int32 dim, nQP, iel, ii, ret = RET_OK;
FMField *vn = 0;
dim = obj->normal->nRow;
nQP = obj->normal->nLev;
if (in->nRow == 1 || mode == 1) {
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( obj->det, iel );
FMF_SetCell( in, ii );
FMF_SetCell( out, ii );
fmf_sumLevelsMulF( out, in, obj->det->val );
ERR_CheckGo( ret );
}
} else if (in->nRow == dim) {
fmf_createAlloc( &vn, 1, nQP, 1, 1 );
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( obj->normal, iel );
FMF_SetCell( obj->det, iel );
FMF_SetCell( in, ii );
FMF_SetCell( out, ii );
fmf_mulATB_nn( vn, in, obj->normal );
/* fmf_mulC( vn, -1.0 ); */
fmf_sumLevelsMulF( out, vn, obj->det->val );
/* fmf_print( vn, stdout, 0 ); */
/* fmf_print( out, stdout, 0 ); */
/* sys_pause(); */
ERR_CheckGo( ret );
}
} else {
errput( ErrHead "ERR_Switch\n" );
}
end_label:
fmf_freeDestroy( &vn );
return( RET_OK );
}
int32 dw_surf_laplace( FMField *out, FMField *grad, FMField *coef,
FMField *gbf, Mapping *sg,
int32 isDiff )
{
int32 ii, nEP, dim, nQP, ret = RET_OK;
FMField *aux1 = 0, *aux2 = 0;
nQP = gbf->nLev;
dim = gbf->nRow;
nEP = gbf->nCol;
fmf_createAlloc( &aux1, 1, nQP, nEP, dim );
if (isDiff)
fmf_createAlloc( &aux2, 1, nQP, nEP, nEP );
else
fmf_createAlloc( &aux2, 1, nQP, nEP, 1 );
for (ii = 0; ii < out->nCell; ii++) {
if (coef->nCell > 1)
FMF_SetCell( coef, ii );
FMF_SetCell( out, ii );
FMF_SetCell( sg->det, ii );
fmf_mulATB_nn(aux1, gbf, coef);
if (isDiff) {
fmf_mulAB_nn(aux2, aux1, gbf);
}
else {
FMF_SetCell(grad, ii);
fmf_mulAB_nn(aux2, aux1, grad);
}
fmf_sumLevelsMulF(out, aux2, sg->det->val);
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy(&aux1);
fmf_freeDestroy(&aux2);
return( ret );
}
/*!
For scalar input p: \int_{\Gamma} p dS
For vector input v: \int_{\Gamma} v n dS
@par Revision history:
- 24.04.2007, c
*/
int32 sg_integrate( SurfaceGeometry *obj, FMField *out, FMField *in )
{
int32 dim, nQP, iel, ret = RET_OK;
FMField *vn = 0;
dim = obj->normal->nRow;
nQP = obj->normal->nLev;
if (in->nRow == 1) {
for (iel = 0; iel < obj->det->nCell; iel++) {
FMF_SetCell( obj->det, iel );
FMF_SetCell( in, iel );
FMF_SetCell( out, iel );
fmf_sumLevelsMulF( out, in, obj->det->val );
ERR_CheckGo( ret );
}
} else if (in->nRow == dim) {
fmf_createAlloc( &vn, 1, nQP, 1, 1 );
for (iel = 0; iel < obj->det->nCell; iel++) {
FMF_SetCell( obj->normal, iel );
FMF_SetCell( obj->det, iel );
FMF_SetCell( in, iel );
FMF_SetCell( out, iel );
fmf_mulATB_nn( vn, in, obj->normal );
/* fmf_mulC( vn, -1.0 ); */
fmf_sumLevelsMulF( out, vn, obj->det->val );
ERR_CheckGo( ret );
}
} else {
errput( ErrHead "ERR_Switch\n" );
}
end_label:
fmf_freeDestroy( &vn );
return( RET_OK );
}
int32 d_laplace( FMField *out, FMField *gradP1, FMField *gradP2,
FMField *coef, VolumeGeometry *vg,
int32 *elList, int32 elList_nRow )
{
int32 ii, iel, dim, nQP, ret = RET_OK;
FMField *dgp2 = 0, *gp1tdgp2 = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
fmf_createAlloc( &dgp2, 1, nQP, dim, 1 );
fmf_createAlloc( &gp1tdgp2, 1, nQP, 1, 1 );
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( out, ii );
FMF_SetCell( vg->det, iel );
FMF_SetCell( gradP1, iel );
FMF_SetCell( gradP2, iel );
if (coef->nCell > 1) {
FMF_SetCell( coef, ii );
}
fmf_mulAF( dgp2, gradP2, coef->val );
fmf_mulATB_nn( gp1tdgp2, gradP1, dgp2 );
fmf_sumLevelsMulF( out, gp1tdgp2, vg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &dgp2 );
fmf_freeDestroy( &gp1tdgp2 );
return( ret );
}
/*!
@par Revision history:
- 02.03.2007, c
*/
int32 d_lin_elastic( FMField *out, float64 coef, FMField *strainV,
FMField *strainU, FMField *mtxD, VolumeGeometry *vg )
{
int32 ii, dim, sym, nQP, nEP, ret = RET_OK;
FMField *std = 0, *stds = 0;
nQP = vg->bfGM->nLev;
nEP = vg->bfGM->nCol;
dim = vg->bfGM->nRow;
sym = (dim + 1) * dim / 2;
fmf_createAlloc( &std, 1, nQP, 1, sym );
fmf_createAlloc( &stds, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( mtxD, ii );
FMF_SetCell( vg->det, ii );
FMF_SetCell( strainV, ii );
FMF_SetCell( strainU, ii );
fmf_mulATB_nn( std, strainV, mtxD );
fmf_mulAB_nn( stds, std, strainU );
fmf_sumLevelsMulF( out, stds, vg->det->val );
ERR_CheckGo( ret );
}
// E.g. 1/dt.
fmfc_mulC( out, coef );
end_label:
fmf_freeDestroy( &std );
fmf_freeDestroy( &stds );
return( ret );
}
int32 mulATB_integrate(FMField *out, FMField *A, FMField *B,
VolumeGeometry *vg)
{
int32 ii, ret = RET_OK;
FMField *aux = 0;
fmf_createAlloc(&aux, 1, A->nLev, A->nCol, B->nCol);
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell(out, ii);
FMF_SetCell(vg->det, ii);
FMF_SetCell(A, ii);
FMF_SetCell(B, ii);
fmf_mulATB_nn(aux, A, B);
fmf_sumLevelsMulF(out, aux, vg->det->val);
ERR_CheckGo(ret);
}
end_label:
fmf_freeDestroy(&aux);
return( ret );
}
int32 d_surface_flux( FMField *out, FMField *grad,
FMField *mtxD, Mapping *sg, int32 mode )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *dgp = 0, *ntdgp = 0;
nQP = sg->normal->nLev;
dim = sg->normal->nRow;
fmf_createAlloc( &dgp, 1, nQP, dim, 1 );
fmf_createAlloc( &ntdgp, 1, nQP, 1, 1 );
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( grad, ii );
FMF_SetCell( mtxD, ii );
FMF_SetCell( sg->normal, ii );
FMF_SetCell( sg->det, ii );
fmf_mulAB_nn( dgp, mtxD, grad );
fmf_mulATB_nn( ntdgp, sg->normal, dgp );
fmf_sumLevelsMulF( out, ntdgp, sg->det->val );
if (mode == 1) {
FMF_SetCell( sg->volume, ii );
fmf_mulC( out, 1.0 / sg->volume->val[0] );
}
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &dgp );
fmf_freeDestroy( &ntdgp );
return( ret );
}
int32 dw_piezo_coupling( FMField *out, FMField *strain, FMField *charge_grad,
FMField *mtxG, VolumeGeometry *vg,
int32 mode )
{
int32 ii, nEPU, nEPP, dim, sym, nQP, ret = RET_OK;
FMField *gtgp = 0, *gtgtgp = 0, *ge = 0, *gctge = 0, *gg = 0, *gctgg = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
nEPU = vg->bfGM->nCol;
sym = (dim + 1) * dim / 2;
if ((mode == 0) || (mode == 1)) {
nEPP = out->nCol;
} else {
nEPP = out->nRow;
}
if (mode == 0) {
fmf_createAlloc( >gp, 1, nQP, sym, 1 );
fmf_createAlloc( >gtgp, 1, nQP, dim * nEPU, 1 );
} else if (mode == 2) {
fmf_createAlloc( &ge, 1, nQP, dim, 1 );
fmf_createAlloc( &gctge, 1, nQP, nEPP, 1 );
} else {
fmf_createAlloc( &gg, 1, nQP, dim, dim * nEPU );
fmf_createAlloc( &gctgg, 1, nQP, nEPP, dim * nEPU );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( mtxG, ii );
FMF_SetCell( vg->bfGM, ii );
FMF_SetCell( vg->det, ii );
if (mode == 0) { // vector - grad
FMF_SetCell( charge_grad, ii );
fmf_mulATB_nn( gtgp, mtxG, charge_grad );
form_sdcc_actOpGT_VS3( gtgtgp, vg->bfGM, gtgp );
fmf_sumLevelsMulF( out, gtgtgp, vg->det->val );
} else if (mode == 2) { // vector - div
FMF_SetCell( strain, ii );
fmf_mulAB_nn( ge, mtxG, strain );
fmf_mulATB_nn( gctge, vg->bfGM, ge );
fmf_sumLevelsMulF( out, gctge, vg->det->val );
} else { // matrix - div, grad
form_sdcc_actOpG_RM3( gg, mtxG, vg->bfGM );
fmf_mulATB_nn( gctgg, vg->bfGM, gg );
if (mode == 1) { // matrix - grad
fmf_sumLevelsTMulF( out, gctgg, vg->det->val );
} else { // matrix - div
fmf_sumLevelsMulF( out, gctgg, vg->det->val );
}
}
ERR_CheckGo( ret );
}
end_label:
if (mode == 0) {
fmf_freeDestroy( >gp );
fmf_freeDestroy( >gtgp );
} else if (mode == 2) {
fmf_freeDestroy( &ge );
fmf_freeDestroy( &gctge );
} else {
fmf_freeDestroy( &gg );
fmf_freeDestroy( &gctgg );
}
return( ret );
}
/*
dR_dx has shape (dim, n_efun), transposed w.r.t. the Python version!
*/
int32 eval_nurbs_basis_tp(FMField *R, FMField *dR_dx, FMField *det,
FMField *dR_dxi,
FMField *dx_dxi, FMField *dxi_dx,
FMField *B, FMField *dB_dxi,
FMField *N, FMField *dN_dxi,
FMField *qp, uint32 ie, FMField *control_points,
FMField *weights, int32 *degrees, int32 dim,
FMField *cs,
int32 *conn, int32 n_el, int32 n_ep)
{
int32 ret = RET_OK;
uint32 ii, jj, a, i0, i1, i2;
uint32 n_efuns[3];
uint32 n_efun = 1;
uint32 n_els[3];
uint32 ic[3];
int32 *ec;
FMField *C, *N0, *N1, *N2, *dN0_dxi, *dN1_dxi, *dN2_dxi;
float64 w, W, P;
float64 dw_dxi[3];
#ifdef DEBUG_FMF
if (!((dim == qp->nCol) && (dim <= 3))) {
errput(ErrHead "inconsistent dimension! (%d == $d <= 3)", dim, qp->nCol);
ERR_CheckGo(ret);
}
#endif
for (ii = 0; ii < dim; ii++) {
n_efuns[ii] = degrees[ii] + 1;
n_efun *= n_efuns[ii];
}
#ifdef DEBUG_FMF
if (n_efun != n_ep) {
errput(ErrHead "inconsistent number of bases! (%d == $d)", n_efun, n_ep);
ERR_CheckGo(ret);
}
#endif
// Element connectivity.
ec = conn + n_ep * ie;
// 1D Bernstein basis B, dB/dxi.
for (ii = 0; ii < dim; ii++) {
eval_bernstein_basis(B + ii, dB_dxi + ii, qp->val[ii], degrees[ii]);
}
// 1D B-spline basis N = CB, dN/dxi = C dB/dxi.
for (ii = 0; ii < dim; ii++) {
n_els[ii] = (cs + ii)->nCell;
}
unravel_index(ic, ie, n_els, dim);
for (ii = 0; ii < dim; ii++) {
C = cs + ii;
FMF_SetCell(C, ic[ii]);
fmf_mulAB_nn(N + ii, C, B + ii);
fmf_mulAB_nn(dN_dxi + ii, C, dB_dxi + ii);
}
ERR_CheckGo(ret);
// Numerators and denominator for tensor-product NURBS basis R, dR/dxi.
w = 0; // w_b
for (ii = 0; ii < dim; ii++) {
dw_dxi[ii] = 0.0; // dw_b/dxi
}
a = 0; // Basis function index.
if (dim == 3) {
N0 = N + 0;
N1 = N + 1;
N2 = N + 2;
dN0_dxi = dN_dxi + 0;
dN1_dxi = dN_dxi + 1;
dN2_dxi = dN_dxi + 2;
for (i0 = 0; i0 < n_efuns[0]; i0++) {
for (i1 = 0; i1 < n_efuns[1]; i1++) {
for (i2 = 0; i2 < n_efuns[2]; i2++) {
W = weights->val[ec[a]];
R->val[a] = N0->val[i0] * N1->val[i1] * N2->val[i2] * W;
w += R->val[a];
dR_dxi->val[a+n_ep*0] = dN0_dxi->val[i0] * N1->val[i1] * N2->val[i2] * W;
dw_dxi[0] += dR_dxi->val[a+n_ep*0];
dR_dxi->val[a+n_ep*1] = N0->val[i0] * dN1_dxi->val[i1] * N2->val[i2] * W;
dw_dxi[1] += dR_dxi->val[a+n_ep*1];
dR_dxi->val[a+n_ep*2] = N0->val[i0] * N1->val[i1] * dN2_dxi->val[i2] * W;
dw_dxi[2] += dR_dxi->val[a+n_ep*2];
a += 1;
}
}
}
} else if (dim == 2) {
N0 = N + 0;
N1 = N + 1;
dN0_dxi = dN_dxi + 0;
dN1_dxi = dN_dxi + 1;
for (i0 = 0; i0 < n_efuns[0]; i0++) {
for (i1 = 0; i1 < n_efuns[1]; i1++) {
W = weights->val[ec[a]];
R->val[a] = N0->val[i0] * N1->val[i1] * W;
w += R->val[a];
dR_dxi->val[a+n_ep*0] = dN0_dxi->val[i0] * N1->val[i1] * W;
dw_dxi[0] += dR_dxi->val[a+n_ep*0];
dR_dxi->val[a+n_ep*1] = N0->val[i0] * dN1_dxi->val[i1] * W;
dw_dxi[1] += dR_dxi->val[a+n_ep*1];
a += 1;
}
}
} else {
N0 = N + 0;
dN0_dxi = dN_dxi + 0;
for (i0 = 0; i0 < n_efuns[0]; i0++) {
W = weights->val[ec[a]];
R->val[a] = N0->val[i0] * W;
w += R->val[a];
dR_dxi->val[a+n_ep*0] = dN0_dxi->val[i0] * W;
dw_dxi[0] += dR_dxi->val[a+n_ep*0];
a += 1;
}
}
// Finish R <- R / w_b.
fmf_mulC(R, 1.0 / w);
// Finish dR/dxi. D == W C dB/dxi, dR/dxi = (D - R dw_b/dxi) / w_b.
for (a = 0; a < dR_dxi->nCol; a++) {
for (ii = 0; ii < dim; ii++) {
dR_dxi->val[a+n_ep*ii] = (dR_dxi->val[a+n_ep*ii]
- R->val[a] * dw_dxi[ii]) / w;
}
}
// Mapping reference -> physical domain dxi/dx.
// x = sum P_a R_a, dx/dxi = sum P_a dR_a/dxi, invert.
for (ii = 0; ii < dim; ii++) {
for (jj = 0; jj < dim; jj++) {
dx_dxi->val[dim*ii+jj] = 0.0;
for (a = 0; a < dR_dxi->nCol; a++) {
P = control_points->val[dim*ec[a]+ii];
dx_dxi->val[dim*ii+jj] += P * dR_dxi->val[a+n_ep*jj];
}
}
}
geme_det3x3(det->val, dx_dxi);
geme_invert3x3(dxi_dx, dx_dxi);
// dR/dx.
fmf_mulATB_nn(dR_dx, dxi_dx, dR_dxi);
end_label:
return(ret);
}
int32 dw_convect_v_grad_s( FMField *out, FMField *val_v, FMField *grad_s,
Mapping *vvg, Mapping *svg,
int32 isDiff )
{
int32 ii, nEPV, nEPS, dim, nQP, ret = RET_OK;
FMField *aux = 0, *out_qp = 0, *gst = 0;
nQP = vvg->bfGM->nLev;
dim = vvg->bfGM->nRow;
nEPS = svg->bfGM->nCol;
nEPV = vvg->bf->nCol;
if (isDiff == 0) {
fmf_createAlloc( &aux, 1, nQP, 1, 1 );
fmf_createAlloc( &out_qp, 1, nQP, nEPS, 1 );
} else if (isDiff == 1) { // d/ds.
fmf_createAlloc( &aux, 1, nQP, 1, nEPS );
fmf_createAlloc( &out_qp, 1, nQP, nEPS, nEPS );
} else { // d/dv.
fmf_createAlloc( &aux, 1, nQP, 1, dim * nEPV );
fmf_createAlloc( &out_qp, 1, nQP, nEPS, dim * nEPV );
fmf_createAlloc( &gst, 1, nQP, 1, dim );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCellX1( svg->bf, ii );
if (isDiff == 0) {
FMF_SetCell( val_v, ii );
FMF_SetCell( grad_s, ii );
// v^T Psi^T G_c s.
fmf_mulATB_nn( aux, val_v, grad_s );
// Phi^T v^T Psi^T G_c s.
fmf_mulATB_nn( out_qp, svg->bf, aux );
} else if (isDiff == 1) { // d/ds.
FMF_SetCell( val_v, ii );
FMF_SetCell( svg->bfGM, ii );
// v^T Psi^T G_c.
fmf_mulATB_nn( aux, val_v, svg->bfGM );
// Phi^T v^T Psi^T G_c.
fmf_mulATB_nn( out_qp, svg->bf, aux );
} else { // d/dv.
FMF_SetCell( grad_s, ii );
FMF_SetCellX1( vvg->bf, ii );
// s^T G_c^T - transpose grad_s.
fmf_mulATC( gst, grad_s, 1.0 );
// s^T G_c^T Psi.
bf_ract( aux, vvg->bf, gst );
// Phi^T s^T G_c^T Psi.
fmf_mulATB_nn( out_qp, svg->bf, aux );
}
fmf_sumLevelsMulF( out, out_qp, vvg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &aux );
fmf_freeDestroy( &out_qp );
fmf_freeDestroy( &gst );
return( ret );
}
