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);
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:
- 01.02.2008, c
*/
int32 dw_volume_dot_scalar( FMField *out, FMField *coef, FMField *val_qp,
VolumeGeometry *rvg, VolumeGeometry *cvg,
int32 isDiff )
{
int32 ii, nQP, nEPR, nEPC, ret = RET_OK;
FMField *ftfp = 0, *ftf = 0, *cftf = 0;
nQP = rvg->bfGM->nLev;
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 );
}
int32 dw_v_dot_grad_s_vw( FMField *out, FMField *coef, FMField *grad,
Mapping *vvg, Mapping *svg,
int32 isDiff )
{
int32 ii, nc, nEPV, nEPS, dim, nQP, ret = RET_OK;
FMField *ftg = 0, *cg = 0;
nQP = vvg->bfGM->nLev;
dim = vvg->bfGM->nRow;
nEPS = svg->bfGM->nCol;
nEPV = vvg->bf->nCol;
nc = coef->nCol;
if (isDiff == 1) {
fmf_createAlloc( &ftg, 1, nQP, dim * nEPV, nEPS );
if (nc > 1) {
fmf_createAlloc( &cg, 1, nQP, dim, nEPS );
}
} else {
fmf_createAlloc( &ftg, 1, nQP, dim * nEPV, 1 );
if (nc > 1) {
fmf_createAlloc( &cg, 1, nQP, dim, 1 );
}
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCellX1( coef, ii );
FMF_SetCell( vvg->det, ii );
FMF_SetCellX1( vvg->bf, ii );
if (isDiff == 1) {
FMF_SetCell( svg->bfGM, ii );
if (nc == 1) {
bf_actt( ftg, vvg->bf, svg->bfGM );
fmf_mul( ftg, coef->val );
} else {
// Phi^T C Gc
fmf_mulAB_nn( cg, coef, svg->bfGM );
bf_actt( ftg, vvg->bf, cg );
}
} else {
FMF_SetCell( grad, ii );
if (nc == 1) {
bf_actt_c1( ftg, vvg->bf, grad );
fmf_mul( ftg, coef->val );
} else {
// Phi^T C Gc s
fmf_mulAB_nn( cg, coef, grad );
bf_actt( ftg, vvg->bf, cg );
}
}
fmf_sumLevelsMulF( out, ftg, vvg->det->val );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &ftg );
fmf_freeDestroy( &cg );
return( ret );
}
/*!
@par Revision history:
- 21.11.2006, c
*/
int32 dw_volume_dot_vector( FMField *out, FMField *coef, FMField *val_qp,
Mapping *rvg, Mapping *cvg,
int32 isDiff )
{
int32 ii, dim, nc, nQP, nEPR, nEPC, ret = RET_OK;
FMField *ftfu = 0, *ftf1 = 0, *ftf = 0,*cf = 0, *cfu = 0;
nQP = rvg->nQP;
dim = rvg->dim;
nEPR = rvg->bf->nCol;
nEPC = cvg->bf->nCol;
nc = coef->nCol;
if (isDiff) {
fmf_createAlloc( &ftf, 1, nQP, nEPR * dim, nEPC * dim );
if (nc == 1) {
fmf_createAlloc( &ftf1, 1, nQP, nEPR, nEPC );
} else {
fmf_createAlloc( &cf, 1, nQP, dim, dim * nEPC );
}
} else {
fmf_createAlloc( &ftfu, 1, nQP, dim * nEPR, 1 );
if (nc > 1) {
fmf_createAlloc( &cfu, 1, nQP, dim, 1 );
}
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCellX1( coef, ii );
FMF_SetCell( rvg->det, ii );
FMF_SetCellX1( rvg->bf, ii );
if (isDiff) {
FMF_SetCellX1( cvg->bf, ii );
if (nc == 1) {
fmf_mulATB_nn( ftf1, rvg->bf, cvg->bf );
bf_buildFTF( ftf, ftf1 );
fmf_mul( ftf, coef->val );
} else {
bf_ract( cf, cvg->bf, coef );
bf_actt( ftf, rvg->bf, cf );
}
fmf_sumLevelsMulF( out, ftf, rvg->det->val );
} else {
FMF_SetCell( val_qp, ii );
if (nc == 1) {
bf_actt( ftfu, rvg->bf, val_qp );
fmf_mul( ftfu, coef->val );
} else {
fmf_mulAB_nn( cfu, coef, val_qp );
bf_actt( ftfu, rvg->bf, cfu );
}
fmf_sumLevelsMulF( out, ftfu, rvg->det->val );
}
ERR_CheckGo( ret );
}
end_label:
if (isDiff) {
fmf_freeDestroy( &ftf );
if (nc == 1) {
fmf_freeDestroy( &ftf1 );
} else {
fmf_freeDestroy( &cf );
}
} else {
fmf_freeDestroy( &ftfu );
if (nc > 1) {
fmf_freeDestroy( &cfu );
}
}
return( ret );
}
/*!
@par Revision history:
- 04.09.2007, c
*/
int32 dw_mass_scalar( FMField *out, FMField *state, int32 offset,
FMField *bf, VolumeGeometry *vg,
int32 *conn, int32 nEl, int32 nEP,
int32 *elList, int32 elList_nRow,
int32 isDiff )
{
int32 ii, iel, dim, nQP, ret = RET_OK;
FMField *st = 0, *fp = 0, *ftfp = 0, *ftf = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
/* output( "%d %d %d %d %d %d\n", offset, nEl, nEP, nQP, dim, elList_nRow ); */
if (isDiff) {
fmf_createAlloc( &ftf, 1, nQP, nEP, nEP );
fmf_mulATB_nn( ftf, bf, bf );
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( out, ii );
FMF_SetCell( vg->det, iel );
fmf_sumLevelsMulF( out, ftf, vg->det->val );
ERR_CheckGo( ret );
}
} else {
state->val = FMF_PtrFirst( state ) + offset;
fmf_createAlloc( &st, 1, 1, 1, nEP );
fmf_createAlloc( &fp, 1, nQP, 1, 1 );
fmf_createAlloc( &ftfp, 1, nQP, nEP, 1 );
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( out, ii );
FMF_SetCell( vg->det, iel );
ele_extractNodalValuesDBD( st, state, conn + nEP * iel );
bf_act( fp, bf, st );
bf_actt( ftfp, bf, fp );
fmf_sumLevelsMulF( out, ftfp, vg->det->val );
ERR_CheckGo( ret );
}
}
end_label:
if (isDiff) {
fmf_freeDestroy( &ftf );
} else {
fmf_freeDestroy( &st );
fmf_freeDestroy( &fp );
fmf_freeDestroy( &ftfp );
}
return( ret );
}
/*!
@par Revision history:
- 21.11.2006, c
*/
int32 dw_mass( FMField *out, float64 coef, FMField *state, int32 offset,
FMField *bf, VolumeGeometry *vg,
int32 *conn, int32 nEl, int32 nEP,
int32 *elList, int32 elList_nRow,
int32 isDiff )
{
int32 ii, iel, dim, nQP, ret = RET_OK;
FMField *st = 0, *fu = 0, *ftfu = 0, *ftf1 = 0, *ftf = 0;
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
/* output( "%d %d %d %d %d %d\n", offset, nEl, nEP, nQP, dim, elList_nRow ); */
if (isDiff) {
fmf_createAlloc( &ftf, 1, nQP, nEP * dim, nEP * dim );
fmf_createAlloc( &ftf1, 1, nQP, nEP, nEP );
fmf_mulATB_nn( ftf1, bf, bf );
bf_buildFTF( ftf, ftf1 );
/* fmf_print( bf, stdout, 0 ); */
/* fmf_print( ftf1, stdout, 0 ); */
/* fmf_print( ftf, stdout, 0 ); */
/* sys_pause(); */
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( out, ii );
FMF_SetCell( vg->det, iel );
fmf_sumLevelsMulF( out, ftf, vg->det->val );
/* fmf_print( out, stdout, 0 ); */
/* sys_pause(); */
ERR_CheckGo( ret );
}
} else {
state->val = FMF_PtrFirst( state ) + offset;
fmf_createAlloc( &st, 1, 1, dim, nEP );
fmf_createAlloc( &fu, 1, nQP, dim, 1 );
fmf_createAlloc( &ftfu, 1, nQP, dim * nEP, 1 );
for (ii = 0; ii < elList_nRow; ii++) {
iel = elList[ii];
FMF_SetCell( out, ii );
FMF_SetCell( vg->det, iel );
ele_extractNodalValuesDBD( st, state, conn + nEP * iel );
bf_act( fu, bf, st );
bf_actt( ftfu, bf, fu );
fmf_sumLevelsMulF( out, ftfu, vg->det->val );
ERR_CheckGo( ret );
}
}
// E.g. 1/dt.
fmfc_mulC( out, coef );
end_label:
if (isDiff) {
fmf_freeDestroy( &ftf1 );
fmf_freeDestroy( &ftf );
} else {
fmf_freeDestroy( &st );
fmf_freeDestroy( &fu );
fmf_freeDestroy( &ftfu );
}
return( ret );
}
/*!
@par Revision history:
- 30.10.2007, c
*/
int32 dw_st_adj2_supg_p( FMField *out, FMField *gradU, FMField *stateR,
FMField *coef,
VolumeGeometry *vg_u, VolumeGeometry *vg_r,
int32 *conn_r, int32 nEl_r, int32 nEP_r,
int32 isDiff )
{
int32 ii, dim, nQP, nEP_u, ret = RET_OK;
FMField *stR = 0, *gUTg = 0, *fTgUTg = 0;
FMField *outqp = 0;
FMField stRv[1];
nQP = vg_u->bfGM->nLev;
nEP_u = vg_u->bfGM->nCol;
dim = vg_u->bfGM->nRow;
stateR->val = FMF_PtrFirst( stateR );
fmf_createAlloc( &gUTg, 1, nQP, dim, nEP_r );
fmf_createAlloc( &fTgUTg, 1, nQP, nEP_u * dim, nEP_r );
if (isDiff == 0) {
fmf_createAlloc( &outqp, 1, nQP, nEP_u * dim, 1 );
fmf_createAlloc( &stR, 1, 1, 1, nEP_r );
stRv->nAlloc = -1;
fmf_pretend( stRv, 1, 1, nEP_r, 1, stR->val );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( gradU, ii );
FMF_SetCell( vg_r->bfGM, ii );
FMF_SetCell( vg_u->det, ii );
FMF_SetCell( coef, ii );
FMF_SetCellX1( vg_u->bf, ii );
// (grad u, grad).
fmf_mulATB_nn( gUTg, gradU, vg_r->bfGM );
// (v grad u, grad).
bf_actt( fTgUTg, vg_u->bf, gUTg );
if (isDiff == 1) {
fmf_sumLevelsMulF( out, fTgUTg, vg_u->det->val );
} else {
ele_extractNodalValuesDBD( stR, stateR, conn_r + nEP_r * ii );
// (v grad u, grad r).
fmf_mulAB_n1( outqp, fTgUTg, stRv );
fmf_sumLevelsMulF( out, outqp, vg_u->det->val );
}
fmf_mulC( out, coef->val[0] );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &gUTg );
fmf_freeDestroy( &fTgUTg );
if (isDiff == 0) {
fmf_freeDestroy( &stR );
fmf_freeDestroy( &outqp );
}
return( ret );
}
/*!
@par Revision history:
- 30.10.2007, c
*/
int32 dw_st_adj1_supg_p( FMField *out, FMField *stateW, FMField *gradP,
FMField *coef, VolumeGeometry *vg_w,
int32 *conn_w, int32 nEl_w, int32 nEP_w,
int32 isDiff )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *stW = 0, *gPTgT = 0, *fTgPTgT = 0;
FMField *outqp = 0;
FMField stWv[1];
nQP = vg_w->bfGM->nLev;
dim = vg_w->bfGM->nRow;
stateW->val = FMF_PtrFirst( stateW );
fmf_createAlloc( &gPTgT, 1, nQP, dim, nEP_w * dim );
fmf_createAlloc( &fTgPTgT, 1, nQP, nEP_w * dim, nEP_w * dim );
if (isDiff == 0) {
fmf_createAlloc( &outqp, 1, nQP, nEP_w * dim, 1 );
fmf_createAlloc( &stW, 1, 1, dim, nEP_w );
stWv->nAlloc = -1;
fmf_pretend( stWv, 1, 1, nEP_w * dim, 1, stW->val );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( gradP, ii );
FMF_SetCell( vg_w->bfGM, ii );
FMF_SetCell( vg_w->det, ii );
FMF_SetCell( coef, ii );
FMF_SetCellX1( vg_w->bf, ii );
// (grad p, grad).
convect_build_vtbg( gPTgT, vg_w->bfGM, gradP );
// (grad p, v grad).
bf_actt( fTgPTgT, vg_w->bf, gPTgT );
if (isDiff == 1) {
fmf_sumLevelsMulF( out, fTgPTgT, vg_w->det->val );
} else {
ele_extractNodalValuesDBD( stW, stateW, conn_w + nEP_w * ii );
// (grad p, v grad w).
fmf_mulAB_n1( outqp, fTgPTgT, stWv );
fmf_sumLevelsMulF( out, outqp, vg_w->det->val );
}
fmf_mulC( out, coef->val[0] );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &gPTgT );
fmf_freeDestroy( &fTgPTgT );
if (isDiff == 0) {
fmf_freeDestroy( &stW );
fmf_freeDestroy( &outqp );
}
return( ret );
}
/*!
@par Revision history:
- 30.10.2007, c
*/
int32 dw_st_adj_supg_c( FMField *out, FMField *stateW,
FMField *stateU, FMField *gradU,
FMField *coef, VolumeGeometry *vg,
int32 *conn, int32 nEl, int32 nEP,
int32 isDiff )
{
int32 ii, dim, nQP, ret = RET_OK;
FMField *stW = 0, *gUfU = 0, *fUTg = 0;
FMField *gUfUTg = 0, *fTgUfUTg = 0;
FMField *gUfUTgT = 0, *fTgUfUTgT = 0;
FMField *outdqp = 0, *outqp = 0, *out1qp = 0, *out2qp = 0;
FMField stWv[1];
nQP = vg->bfGM->nLev;
dim = vg->bfGM->nRow;
stateW->val = FMF_PtrFirst( stateW );
fmf_createAlloc( &gUfU, 1, nQP, dim, 1 );
fmf_createAlloc( &gUfUTgT, 1, nQP, dim, nEP * dim );
fmf_createAlloc( &fTgUfUTgT, 1, nQP, nEP * dim, nEP * dim );
fmf_createAlloc( &fUTg, 1, nQP, dim, nEP * dim );
fmf_createAlloc( &gUfUTg, 1, nQP, dim, nEP * dim );
fmf_createAlloc( &fTgUfUTg, 1, nQP, nEP * dim, nEP * dim );
if (isDiff == 1) {
fmf_createAlloc( &outdqp, 1, nQP, dim * nEP, dim * nEP );
} else {
fmf_createAlloc( &stW, 1, 1, dim, nEP );
stWv->nAlloc = -1;
fmf_pretend( stWv, 1, 1, nEP * dim, 1, stW->val );
fmf_createAlloc( &out1qp, 1, nQP, dim * nEP, 1 );
fmf_createAlloc( &out2qp, 1, nQP, dim * nEP, 1 );
fmf_createAlloc( &outqp, 1, nQP, dim * nEP, 1 );
}
for (ii = 0; ii < out->nCell; ii++) {
FMF_SetCell( out, ii );
FMF_SetCell( stateU, ii );
FMF_SetCell( gradU, ii );
FMF_SetCell( vg->bfGM, ii );
FMF_SetCell( vg->det, ii );
FMF_SetCell( coef, ii );
FMF_SetCellX1( vg->bf, ii );
// u grad u.
fmf_mulAB_nn( gUfU, gradU, stateU );
// (u grad u, grad).
convect_build_vtbg( gUfUTgT, vg->bfGM, gUfU );
// (u grad u, v grad).
bf_actt( fTgUfUTgT, vg->bf, gUfUTgT );
// u grad.
convect_build_vtg( fUTg, vg->bfGM, stateU );
// (grad u, u^T grad).
fmf_mulAB_nn( gUfUTg, gradU, fUTg );
// (v grad u, u grad).
bf_actt( fTgUfUTg, vg->bf, gUfUTg );
if (isDiff == 1) {
fmf_addAB_nn( outdqp, fTgUfUTgT, fTgUfUTg );
fmf_sumLevelsMulF( out, outdqp, vg->det->val );
} else {
ele_extractNodalValuesDBD( stW, stateW, conn + nEP * ii );
// (u grad u, v grad w).
fmf_mulAB_n1( out1qp, fTgUfUTgT, stWv );
// (v grad u, u grad w).
fmf_mulAB_n1( out2qp, fTgUfUTg, stWv );
fmf_addAB_nn( outqp, out1qp, out2qp );
fmf_sumLevelsMulF( out, outqp, vg->det->val );
}
fmf_mulC( out, coef->val[0] );
ERR_CheckGo( ret );
}
end_label:
fmf_freeDestroy( &gUfU );
fmf_freeDestroy( &gUfUTgT );
fmf_freeDestroy( &fTgUfUTgT );
fmf_freeDestroy( &fUTg );
fmf_freeDestroy( &gUfUTg );
fmf_freeDestroy( &fTgUfUTg );
if (isDiff) {
fmf_freeDestroy( &outdqp );
} else {
fmf_freeDestroy( &stW );
fmf_freeDestroy( &out1qp );
fmf_freeDestroy( &out2qp );
fmf_freeDestroy( &outqp );
}
return( ret );
}
