CIndexArrayElem::CIndexArrayElem(unsigned int id_ea, unsigned int id_es, const Fem::Field::CFieldWorld& world)
{
// std::cout << "CIndexArrayElem::CIndexArrayElem" << std::endl;
itype = ELEM_TYPE_NOT_SET;
is_selected = false;
this->id_ea=id_ea;
this->id_es=id_es;
color[0] = 0.8; color[1] = 0.8; color[2] = 0.8;
// color[0] = 1.0; color[1] = 1.0; color[2] = 1.0;
// color[0] = 0.8; color[1] = 0.2; color[2] = 0.2;
// color[0] = 0.2; color[1] = 0.8; color[2] = 0.2;
nElem = 0;
pIA_Elem = 0;
pColor = 0;
ilayer = 0;
////////////////
if( !world.IsIdEA(id_ea) ) return;
const CElemAry& ea = world.GetEA(id_ea);
if( ea.ElemType() == Fem::Field::POINT){ color[0]=0; color[1]=0; color[2]=0; }
else if( ea.ElemType() == Fem::Field::LINE ){ Set_Line(id_ea,id_es, world); color[0]=0; color[1]=0; color[2]=0; }
else if( ea.ElemType() == Fem::Field::TRI ){ Set_Tri( id_ea,id_es, world); }
else if( ea.ElemType() == Fem::Field::QUAD ){ Set_Quad(id_ea,id_es, world); }
else if( ea.ElemType() == Fem::Field::TET ){ Set_Tet( id_ea,id_es, world); }
else if( ea.ElemType() == Fem::Field::HEX ){ Set_Hex( id_ea,id_es, world); }
}
bool Fem::Field::CFieldValueSetter::ExecuteValue
(double cur_time, Fem::Field::CFieldWorld& world)
{
if( id_field_gradient_ != 0 ){
SetFieldValue_Gradient(id_field_, world, id_field_gradient_);
}
if( !world.IsIdField(id_field_) ){ return false; }
Fem::Field::CField& field = world.GetField(id_field_);
const unsigned int nlen = field.GetNLenValue();
for(unsigned int ilen=0;ilen<nlen;ilen++){
if( aValueFieldDof_[ilen+nlen*0].itype == 1 ){
SetFieldValue_Constant(id_field_,ilen,VALUE,world,aValueFieldDof_[ilen+nlen*0].val);
}
else if( aValueFieldDof_[ilen+nlen*0].itype == 2 ){
SetFieldValue_MathExp(id_field_,ilen,VALUE,world,aValueFieldDof_[ilen+nlen*0].math_exp,cur_time);
}
}
for(unsigned int ilen=0;ilen<nlen;ilen++){
if( aValueFieldDof_[ilen+nlen*1].itype == 1 ){
SetFieldValue_Constant(id_field_,ilen,VELOCITY,world,aValueFieldDof_[ilen+nlen*1].val);
}
else if( aValueFieldDof_[ilen+nlen*1].itype == 2 ){
SetFieldValue_MathExp(id_field_,ilen,VELOCITY,world,aValueFieldDof_[ilen+nlen*1].math_exp,cur_time);
}
}
for(unsigned int ilen=0;ilen<nlen;ilen++){
if( aValueFieldDof_[ilen+nlen*2].itype == 1 ){
SetFieldValue_Constant(id_field_,ilen,ACCELERATION,world,aValueFieldDof_[ilen+nlen*2].val);
}
else if( aValueFieldDof_[ilen+nlen*2].itype == 2 ){
SetFieldValue_MathExp(id_field_,ilen,ACCELERATION,world,aValueFieldDof_[ilen+nlen*2].math_exp,cur_time);
}
}
return true;
}
bool View::CIndexArrayElem::Set_Hex
(unsigned int id_ea, unsigned int id_es,
const Fem::Field::CFieldWorld& world)
{
if( !world.IsIdEA(id_ea) ) return false;
const CElemAry& ea = world.GetEA(id_ea);
if( !ea.IsSegID(id_es) ) return false;
if( ea.ElemType() != HEX ) return false;
////////////////
itype = Fem::Field::HEX;
this->id_ea = id_ea;
this->id_es = id_es;
unsigned int id_es_add = 0;
CElemAry* pEA = ea.MakeBoundElemAry(id_es,id_es_add,aIndElem);
nElem = pEA->Size();
nnoel = 4;
assert( aIndElem.size() == nElem );
assert( pEA->IsSegID(id_es_add) );
const CElemAry::CElemSeg& es = pEA->GetSeg(id_es_add);
const unsigned int npofa = 4;
pIA_Elem = new unsigned int [nElem*npofa];
for(unsigned int iface=0;iface<nElem;iface++){
es.GetNodes(iface,pIA_Elem+iface*npofa);
}
delete pEA;
return true;
}
void CDrawerFace::EnableUVMap(bool is_uv_map, const Fem::Field::CFieldWorld& world)
{
if( (pUVArray != 0 ) == is_uv_map ){ return; }
if( is_uv_map ){
const unsigned int nnode = this->m_vertex_ary.NPoin();
// const unsigned int ndim = this->m_vertex_ary.NDim();
delete[] pUVArray;
pUVArray = new double [nnode*2];
if( !world.IsIdField(m_id_field) ) return;
const Fem::Field::CField& field = world.GetField(m_id_field);
// unsigned int id_na_c_co = field.GetNodeSegInNodeAry(CORNER).id_na_co;
// assert( world.IsIdNA(id_na_c_co) );
// const Fem::Field::CNodeAry& na_c_co = world.GetNA(id_na_c_co);
// assert( field.IsNodeSeg(CORNER,false,world) );
const Fem::Field::CNodeAry::CNodeSeg& ns_c_co = field.GetNodeSeg(CORNER,false,world);
// const unsigned int ndim = ns_c_co.Length();
// assert( ndim >= 2 );
for(unsigned int ino=0;ino<ns_c_co.Size();ino++){
double c[3]; ns_c_co.GetValue(ino,c);
pUVArray[ino*2+0] = c[0]*tex_scale;
pUVArray[ino*2+1] = c[1]*tex_scale;
}
}
else{
delete[] pUVArray;
pUVArray = 0;
}
}
bool Ls::CLinearSystem_RigidField2::SetFixedBoundaryCondition_Field
(unsigned int id_field, const Fem::Field::CFieldWorld& world )
{
if( !world.IsIdField(id_field) ) return false;
const Fem::Field::CField& field = world.GetField(id_field);
unsigned int id_field_parent = field.GetIDFieldParent();
if( id_field_parent == 0 ) id_field_parent = id_field;
{
int ils0 = this->FindIndexArray_Seg(id_field_parent,Fem::Field::CORNER,world);
if( ils0 >= 0 && ils0 < m_aSegRF.size() ){
const CLinSysSegRF& ls0 = this->m_aSegRF[ils0];
MatVec::CBCFlag& bc_flag = m_ls.GetBCFlag(ils0);//*m_ls.m_BCFlag[ils0];
if( ls0.id_field== id_field_parent ){
Fem::Ls::BoundaryCondition(id_field,Fem::Field::CORNER,bc_flag,world);
}
}
}
{
int ils0 = this->FindIndexArray_Seg(id_field_parent,Fem::Field::EDGE,world);
if( ils0 >= 0 && ils0 < m_aSegRF.size() ){
assert(0);
}
}
{
int ils0 = this->FindIndexArray_Seg(id_field_parent,Fem::Field::BUBBLE,world);
if( ils0 >= 0 && ils0 < m_aSegRF.size() ){
assert(0);
}
}
return true;
}
void Update_FrictionalContact
(const CContactTarget3D& ct, double stiff_n, double stiff_f, double myu_s, double myu_k,
double offset,
unsigned int id_field_disp,
Fem::Field::CFieldWorld& world,
std::vector<CFrictionPoint>& aFrictionPoint )
{
assert( world.IsIdField(id_field_disp) );
const Fem::Field::CField& field_disp = world.GetField(id_field_disp);
assert( field_disp.GetFieldType() == Fem::Field::VECTOR3 );
////////////////
const unsigned int ndim = 3;
const CNodeAry::CNodeSeg& ns_co = field_disp.GetNodeSeg( CORNER,false,world,VALUE);
const CNodeAry::CNodeSeg& ns_udisp = field_disp.GetNodeSeg( CORNER,true, world,VALUE);
const CNodeAry::CNodeSeg& ns_vdisp = field_disp.GetNodeSeg( CORNER,true, world,VELOCITY);
assert( aFrictionPoint.size() == ns_co.Size() );
for(unsigned int inode=0;inode<ns_co.Size();inode++)
{
double Co[ndim]; ns_co.GetValue( inode,Co);
double ud[ndim]; ns_udisp.GetValue(inode,ud);
double uv[ndim]; ns_vdisp.GetValue(inode,uv);
double co[3] = { Co[0]+ud[0], Co[1]+ud[1], Co[2]+ud[2] };
double n1[3];
const double pd1 = ct.Projection(co[0],co[1],co[2],n1)+offset;
CFrictionPoint& fp = aFrictionPoint[inode];
const double pd0 = fp.pd;
if( fp.is_pin ) continue;
if( pd1 < 0 ){} // not contact
else if( pd0 < 0 ){ // h1>0 && h0<0 : contact in next step
// std::cout << "contact next time step" << std::endl;
// put anchor at projected point
for(unsigned int i=0;i<3;i++){ fp.aloc[i] = co[i]+pd1*n1[i]; }
}
else{ // h1>0 && h0>0
// update the anchor that spring give force equal to dynamic friction direction to the velocity
if( fp.itype_contact == 2 ){
// update anchor
double v_t[3];
{ // tangent direction
const double t = Com::Dot3D(n1,uv);
for(unsigned int i=0;i<3;i++){ v_t[i] = uv[i] - t*n1[i]; }
}
const double len_vt = Com::Length3D(v_t);
const double invlen_vt = 1.0/len_vt;
for(unsigned int i=0;i<3;i++){ v_t[i] *= invlen_vt; }
const double dist = pd1*stiff_n*myu_k/stiff_f;
for(unsigned int i=0;i<3;i++){ fp.aloc[i] = co[i]-v_t[i]*dist; }
}
}
}
}
Fem::Field::CFieldValueSetter::CFieldValueSetter
(unsigned int id_field, Fem::Field::CFieldWorld& world) : id_field_(0), id_field_gradient_(0)
{
if( !world.IsIdField(id_field) ){ return; }
Fem::Field::CField& field = world.GetField(id_field);
const unsigned int nlen = field.GetNLenValue();
id_field_ = id_field;
aValueFieldDof_.resize(nlen*3);
}
bool CEqnSystem_Fluid2D::UpdateDomain_FieldElemAry(unsigned int id_base,unsigned int id_ea, Fem::Field::CFieldWorld& world)
{
m_id_press = world.MakeField_FieldElemAry(id_base,id_ea,
Fem::Field::SCALAR, VELOCITY|ACCELERATION,CORNER);
if( m_IsntInterpolationBubble) {
std::cout << "not bubble intp" << std::endl;
m_id_velo = world.MakeField_FieldElemAry(id_base,id_ea,
Fem::Field::VECTOR2,VELOCITY|ACCELERATION,CORNER);
m_IsntCombine = false;
}
else {
std::cout << "bubble intp" << std::endl;
m_id_velo = world.MakeField_FieldElemAry(id_base,id_ea,
Fem::Field::VECTOR2,VELOCITY|ACCELERATION,CORNER|BUBBLE);
m_IsntCombine = true;
}
{ // 同じ要素配列IDを持つ方程式があったら，それを使う．なければ新規に追加
std::vector<CEqn_Fluid2D> aEqn_old = m_aEqn;
m_aEqn.clear();
const CField& field = world.GetField(m_id_velo);
const std::vector<unsigned int>& aIdEA = field.GetAryIdEA();
for(unsigned int iiea=0; iiea<aIdEA.size(); iiea++) {
const unsigned int id_ea = aIdEA[iiea];
unsigned int ieqn0=0;
for(; ieqn0<aEqn_old.size(); ieqn0++) {
if( aEqn_old[ieqn0].GetIdEA() == id_ea ) {
const unsigned int ieqn1 = m_aEqn.size();
m_aEqn.push_back( aEqn_old[ieqn0] );
m_aEqn[ieqn1].SetIdFieldVelocity(m_id_velo);
m_aEqn[ieqn1].SetIdFieldPressure(m_id_press);
break;
}
}
if( ieqn0 != aEqn_old.size() ) {
continue;
}
CEqn_Fluid2D eqn1(id_ea,m_id_velo,m_id_press);
eqn1.SetRho(m_rho_back);
eqn1.SetMyu(m_myu_back);
if( this->m_is_stokes_back ) {
eqn1.SetStokes();
}
else {
eqn1.SetNavierStokes();
}
m_aEqn.push_back( eqn1 );
}
}
this->ClearLinearSystemPreconditioner();
return true;
}
bool CEqn_Solid3D_Linear::SetDomain_Field(unsigned int id_field_base, Fem::Field::CFieldWorld& world){
{ // ì¸óÕÉtÉBÅ[ÉãÉhÇÃç¿ïWêflì_ÉZÉOÉÅÉìÉgÇÃdofÇ™3ǩǫǧǩÉ`ÉFÉbÉNÇ∑ÇÈ
// unsigned int id_field_base = world.GetFieldBaseID();
assert( world.IsIdField(id_field_base) );
const CField& field_base = world.GetField(id_field_base);
assert( field_base.GetNDimCoord() == 3 );
}
m_IdFieldDisp = world.MakeField_FieldElemDim(id_field_base, 3,
VECTOR3,VALUE|VELOCITY|ACCELERATION,CORNER);
this->ClearLinearSystemPreconditioner();
return true;
}
double CEqnSystem_Fluid2D::MakeLinearSystem(const Fem::Field::CFieldWorld& world)
{
if( pLS==0 || pPrec==0 ) this->InitializeLinearSystem(world);
// 連立一次方程式を作る
pLS->InitializeMarge(); // 連立一次方程式を初期化する(0クリア)
if( m_IsStationary ) {
for(unsigned int ieqn=0; ieqn<m_aEqn.size(); ieqn++) {
m_aEqn[ieqn].AddLinSys(*pLS,world);
}
}
else {
for(unsigned int ieqn=0; ieqn<m_aEqn.size(); ieqn++) {
// std::cout << "CEqnSystem_Fluid2D::MakeLinearSystem " << ieqn << " " << m_aEqn[ieqn].GetIdEA() << std::endl;
m_aEqn[ieqn].AddLinSys_NewmarkBetaAPrime(m_dt,m_gamma_newmark,m_beta_newmark,true,
*pLS, world);
}
}
if( world.IsIdField( this->m_id_force ) )
{
assert( world.IsIdField(this->m_id_force) );
const Fem::Field::CField& ff = world.GetField(this->m_id_force);
const Fem::Field::CNodeAry::CNodeSeg& nsf_v = ff.GetNodeSeg(Fem::Field::CORNER,true, world,Fem::Field::VELOCITY);
const unsigned int nno = nsf_v.Size();
assert( nsf_v.Length() == 2 );
////////////////
assert( world.IsIdField(this->m_id_velo) );
const Fem::Field::CField& fv = world.GetField(this->m_id_velo);
const Fem::Field::CNodeAry::CNodeSeg& nsv_v = fv.GetNodeSeg(Fem::Field::CORNER,true, world,Fem::Field::VELOCITY);
assert( nsv_v.Size() == nno );
assert( nsv_v.Length() == 2 );
////////////////
MatVec::CVector_Blk& vec_res = pLS->GetResidual(this->m_id_velo,Fem::Field::CORNER,world);
assert( vec_res.NBlk() == nno );
assert( vec_res.Len() >= 2 ); // Combineのときは2以上
double nres_add = 0;
for(unsigned int ino=0; ino<nno; ino++)
{
double force[2];
nsf_v.GetValue(ino,force);
vec_res.AddValue(ino,0,force[0]);
vec_res.AddValue(ino,1,force[1]);
nres_add += force[0]*force[0]+force[1]*force[1];
}
// std::cout << res << " " << nres_add << std::endl;
}
const double norm_res = pLS->FinalizeMarge();
pPrec->SetValue((*pLS).m_ls);
return norm_res;
}
unsigned int CEqnSystem_Fluid2D::AddFixElemAry( const std::vector<unsigned int>& aIdEA, Fem::Field::CFieldWorld& world, int idof)
{
for(unsigned int iid_ea=0; iid_ea<aIdEA.size(); iid_ea++) {
if( !world.IsIdEA( aIdEA[iid_ea] ) ) return 0;
}
const unsigned int id_field = world.GetPartialField(m_id_velo, aIdEA );
if( id_field == 0 ) return 0;
assert( world.IsIdField(id_field) );
// CField& field = world.GetField(id_field);
Fem::Field::SetFieldValue_Constant(id_field,0,Fem::Field::VELOCITY,world,0);
Fem::Field::SetFieldValue_Constant(id_field,1,Fem::Field::VELOCITY,world,0);
m_aIdFixField.push_back( std::make_pair(id_field,-1) );
return id_field;
}
bool Fem::Eqn::AddLinSys_AdvectionDiffusion_NonStatic_Newmark(
Fem::Ls::CLinearSystem_SaveDiaM_Newmark& ls,
double rho, double myu, double source,
const Fem::Field::CFieldWorld& world,
unsigned int id_field_val, unsigned int id_field_velo,
unsigned int id_ea )
{
if( !world.IsIdField(id_field_val) ) return false;
const CField& field_val = world.GetField(id_field_val);
if( !world.IsIdField(id_field_velo) ) return false;
const CField& field_velo = world.GetField(id_field_velo);
if( field_val.GetFieldType() != SCALAR ) return false;
if( field_velo.GetFieldType() != VECTOR2 ) return false;
if( id_ea != 0 ){
Fem::Field::INTERPOLATION_TYPE intp_type_val = field_val.GetInterpolationType(id_ea,world);
Fem::Field::INTERPOLATION_TYPE intp_type_velo = field_velo.GetInterpolationType(id_ea,world);
if( intp_type_val == TRI11 && intp_type_velo == TRI11 ){
AddLinSys_AdvectionDiffusion_NonStatic_Newmark_P1P1(
rho,myu,source,
ls,
id_field_val,id_field_velo,world,
id_ea);
}
else{
assert(0);
}
}
else{
const std::vector<unsigned int> aIdEA = field_val.GetAryIdEA();
for(unsigned int iiea=0;iiea<aIdEA.size();iiea++){
const unsigned int id_ea = aIdEA[iiea];
bool res = Fem::Eqn::AddLinSys_AdvectionDiffusion_NonStatic_Newmark(
ls,
rho, myu, source,
world,
id_field_val, id_field_velo,
id_ea );
if( !res ) return false;
}
return true;
}
return true;
}
bool CEdgeTextureColor::Update(const Fem::Field::CFieldWorld& world)
{
if( !world.IsIdField(this->id_field_velo) ){ return false; }
if( !world.IsIdField(this->id_part_field_velo) ){ return false; }
if( !world.IsIdEA(this->id_ea) ){ return false; }
const Fem::Field::CElemAry& ea = world.GetEA(id_ea);
assert( ea.ElemType() == Fem::Field::LINE );
if( nelem != ea.Size() ){
nelem = ea.Size();
if( m_aXYVeloElem != 0 ){ delete[] m_aXYVeloElem; }
if( m_aXYElem != 0 ){ delete[] m_aXYElem; }
m_aXYVeloElem = new double [nelem*4];
m_aXYElem = new double [nelem*4];
}
const Fem::Field::CField& fv = world.GetField(this->id_part_field_velo);
// const Fem::Field::CField::CNodeSegInNodeAry& nans = fv.GetNodeSegInNodeAry(Fem::Field::CORNER);
const Fem::Field::CNodeAry::CNodeSeg& ns_v = fv.GetNodeSeg(CORNER,true, world,VELOCITY);
const Fem::Field::CNodeAry::CNodeSeg& ns_c = fv.GetNodeSeg(CORNER,false,world,VELOCITY);
const Fem::Field::CElemAry::CElemSeg& es_v = fv.GetElemSeg(id_ea,CORNER,true, world);
const Fem::Field::CElemAry::CElemSeg& es_c = fv.GetElemSeg(id_ea,CORNER,false,world);
assert( es_v.Length() == 2 );
assert( es_c.Length() == 2 );
for(unsigned int ielem=0;ielem<nelem;ielem++)
{
unsigned int noes[2];
es_c.GetNodes(ielem,noes);
double co[2][2];
ns_c.GetValue(noes[0],co[0]);
ns_c.GetValue(noes[1],co[1]);
////////////////
es_v.GetNodes(ielem,noes);
double velo[2][2];
ns_v.GetValue(noes[0],velo[0]);
ns_v.GetValue(noes[1],velo[1]);
////////////////
m_aXYElem[ielem*4+0] = co[0][0];
m_aXYElem[ielem*4+1] = co[0][1];
m_aXYElem[ielem*4+2] = co[1][0];
m_aXYElem[ielem*4+3] = co[1][1];
////////////////
const double r = velo_scale;
m_aXYVeloElem[ielem*4+0] = co[0][0] + r*velo[0][0];
m_aXYVeloElem[ielem*4+1] = co[0][1] + r*velo[0][1];
m_aXYVeloElem[ielem*4+2] = co[1][0] + r*velo[1][0];
m_aXYVeloElem[ielem*4+3] = co[1][1] + r*velo[1][1];
}
return true;
}
bool CEqn_Solid2D::AddLinSys(Fem::Ls::CLinearSystem_Field& ls, const Fem::Field::CFieldWorld& world )
{
if( this->m_IsGeomNonlin ){
// ê√ìISt.Venant-KirchhoffëÃ
return Fem::Eqn::AddLinSys_StVenant2D_Static(
ls,
m_lambda, m_myu, m_rho, m_g_x, m_g_y,
world,m_IdFieldDisp,
m_id_ea );
}
else{
if( !world.IsIdField(m_IdFieldTemperature) ){
// ê√ìIê¸å`íeê´ëÃ
return Fem::Eqn::AddLinSys_LinearSolid2D_Static(
ls,
m_lambda, m_myu, m_rho, m_g_x, m_g_y,
world, m_IdFieldDisp,
m_id_ea);
}
else{
// ê√ìIê¸å`íeê´ëÃ(îMâûóÕ)
return Fem::Eqn::AddLinSys_LinearSolidThermalStress2D_Static(
ls,
m_lambda, m_myu, m_rho, m_g_x, m_g_y, 0.02,
world, m_IdFieldDisp, m_IdFieldTemperature,
m_id_ea);
}
}
return false;
}
// òAóßàÍéüï˚íˆéÆÉ}Å[ÉWÉÅÉ\ÉbÉh
bool CEqn_Solid2D::AddLinSys_NewmarkBetaAPrime( double dt, double gamma, double beta, bool is_initial,
Fem::Ls::CLinearSystem_Field& ls, const Fem::Field::CFieldWorld& world )
{
if( this->m_IsGeomNonlin ){
// ìÆìISt.Venant-KirchhoffëÃ
return Fem::Eqn::AddLinSys_StVenant2D_NonStatic_NewmarkBeta(
dt, gamma, beta, ls,
m_lambda, m_myu, m_rho, m_g_x, m_g_y,
world, m_IdFieldDisp,
is_initial,
m_id_ea);
}
else{
if( !world.IsIdField(m_IdFieldTemperature) ){
// ìÆìIê¸å`íeê´ëÃ
return Fem::Eqn::AddLinSys_LinearSolid2D_NonStatic_NewmarkBeta(
dt, gamma, beta, ls,
m_lambda, m_myu, m_rho, m_g_x, m_g_y,
world, m_IdFieldDisp,
is_initial,
m_id_ea);
}
else{
// ìÆìIê¸å`íeê´ëÃ
return Fem::Eqn::AddLinSys_LinearSolidThermalStress2D_NonStatic_NewmarkBeta(
dt, gamma, beta, ls,
m_lambda, m_myu, m_rho, m_g_x, m_g_y, 0.02,
world, m_IdFieldDisp, m_IdFieldTemperature,
is_initial,
m_id_ea);
}
}
return false;
}
bool CEqn_Scalar3D::SetDomain(unsigned int id_base, Fem::Field::CFieldWorld& world)
{
m_IdFieldVal = world.MakeField_FieldElemDim(id_base,3,SCALAR,VALUE,CORNER);
this->ClearLinearSystemPreconditioner();
this->m_aIdFixField.clear();
return true;
}
unsigned int CEqn_Fluid3D::AddFixElemAry( unsigned int id_ea, Fem::Field::CFieldWorld& world, int idof)
{
if( !world.IsIdEA( id_ea ) ) return 0;
std::vector<unsigned int> aIdEA;
aIdEA.push_back(id_ea);
return this->AddFixElemAry( aIdEA, world, idof );
}
bool CEqn_Scalar3D::AddFixField(const unsigned int id_field, Fem::Field::CFieldWorld& world, int idof)
{
if( !world.IsIdField( id_field ) ) return false;
m_aIdFixField.push_back( std::make_pair(id_field,idof) );
this->ClearLinearSystem();
return true;
}
bool CEqnSystem_Scalar2D::SetDomain_FieldElemAry(unsigned int id_base, unsigned int id_ea, Fem::Field::CFieldWorld& world)
{
m_IdFieldVal = world.MakeField_FieldElemAry(id_base,id_ea,SCALAR,VELOCITY|VALUE,CORNER);
{
m_aEqn.clear();
const CField& field = world.GetField(m_IdFieldVal);
const std::vector<unsigned int>& aIdEA = field.GetAryIdEA();
for(unsigned int iiea=0;iiea<aIdEA.size();iiea++){
const unsigned int id_ea = aIdEA[iiea];
m_aEqn.push_back( CEqn_Scalar2D(id_ea,m_IdFieldVal) );
}
}
this->ClearLinearSystemPreconditioner();
this->m_aIdFixField.clear();
return true;
}
bool CEqnSystem_Solid2D::UpdateDomain_Field(unsigned int id_base, Fem::Field::CFieldWorld& world)
{
m_IdFieldDisp = world.MakeField_FieldElemDim(id_base,2,
Fem::Field::VECTOR2,VALUE|VELOCITY|ACCELERATION,CORNER);
assert( world.IsIdField(m_IdFieldDisp) );
{ // ìØÇ∂óvëfîzóÒIDÇéùǬï˚íˆéÆÇ™Ç Ç¡ÇΩÇÁÅCǪÇÍÇégǧÅDÇ»ÇØÇÍÇŒêVãKÇ…í«â¡
std::vector<CEqn_Solid2D> aEqn_old = m_aEqn;
m_aEqn.clear();
const CField& field = world.GetField(m_IdFieldDisp);
const std::vector<unsigned int>& aIdEA = field.GetAryIdEA();
for(unsigned int iiea=0;iiea<aIdEA.size();iiea++){
const unsigned int id_ea = aIdEA[iiea];
unsigned int ieqn0=0;
for(;ieqn0<aEqn_old.size();ieqn0++){
if( aEqn_old[ieqn0].GetIdEA() == id_ea ){
const unsigned int ieqn1 = m_aEqn.size();
m_aEqn.push_back( aEqn_old[ieqn0] );
m_aEqn[ieqn1].SetIdFieldDisp(m_IdFieldDisp);
break;
}
}
if( ieqn0 != aEqn_old.size() ){ continue; }
CEqn_Solid2D eqn1(id_ea,m_IdFieldDisp);
eqn1.SetYoungPoisson(m_young_back, m_poisson_back, m_is_plane_stress_back);
eqn1.SetRho(m_rho_back);
eqn1.SetGeometricalNonlinear(m_is_geom_nonlin_back);
m_aEqn.push_back( eqn1 );
}
}
std::cout << "Size Eqn : " << m_aEqn.size() << std::endl;
for(unsigned int ieqn=0;ieqn<m_aEqn.size();ieqn++){
const CEqn_Solid2D& eqn = m_aEqn[ieqn];
double young, poisson;
eqn.GetYoungPoisson(young,poisson);
// std::cout << ieqn << " " << eqn.GetIdEA() << " " << young << " " << poisson << " " << std::endl;
// m_aEqn[ieqn].SetGravitation(0,-0.0);
}
if( !world.IsIdField(m_IdFieldDisp) ) return false;
this->ClearLinearSystemPreconditioner();
this->m_aIdFixField.clear();
return true;
}
bool CLinearSystem_SaveDiaM_Newmark::UpdateValueOfField(
unsigned int id_field, Fem::Field::CFieldWorld& world, Fem::Field::FIELD_DERIVATION_TYPE fdt )
{
if( !world.IsIdField(id_field) ) return false;
CField& field = world.GetField(id_field);
{
unsigned int id_na_val = field.GetNodeSegInNodeAry(CORNER).id_na_va;
if( id_na_val != 0 ){
const unsigned int ilss0 = this->FindIndexArray_Seg(id_field,CORNER,world);
CVector_Blk* pUpdate = this->m_ls.m_Update[ilss0];
assert( pUpdate != 0 );
CNodeAry& na = world.GetNA(id_na_val);
const unsigned int nblk = na.Size();
CNodeAry::CNodeSeg& ns_u = field.GetNodeSeg(CORNER,true,world,VALUE);
CNodeAry::CNodeSeg& ns_v = field.GetNodeSeg(CORNER,true,world,VELOCITY);
assert( ns_v.Length() == ns_u.Length() );
const unsigned int nlen = ns_u.Length();
const CBCFlag& bc_flag = m_ls.GetBCFlag(ilss0);//this->m_ls.m_BCFlag[ilss0];
assert( nblk == bc_flag.NBlk() );
assert( (int)nlen == bc_flag.LenBlk() );
double* velo0 = new double [nlen];
double* velo1 = new double [nlen];
for(unsigned int iblk=0;iblk<nblk;iblk++){
ns_v.GetValue(iblk,velo0);
ns_u.GetValue(iblk,velo1);
for(unsigned int ilen=0;ilen<nlen;ilen++){
if( bc_flag.GetBCFlag(iblk,ilen) == 0 ){
const double velo1 = pUpdate->GetValue(iblk,ilen);
// 値を更新
ns_u.AddValue(iblk,ilen,dt*(1-gamma)*velo0[ilen]+dt*gamma*velo1);
}
else{
pUpdate->SetValue(iblk,ilen,velo0[ilen]);
// pUpdate->SetValue(iblk,ilen,velo1[ilen]);
}
}
}
delete[] velo0;
const unsigned int id_ns_v = field.GetNodeSegInNodeAry(CORNER).id_ns_ve;
na.SetValueToNodeSegment(id_ns_v,*pUpdate);
}
}
return true;
}
bool CDrawerImageBasedFlowVis::Set(unsigned int id_field_velo, const Fem::Field::CFieldWorld& world)
{
if( !world.IsIdField(id_field_velo) ){ return false; }
this->m_IdFieldVelo = id_field_velo;
const Fem::Field::CField& fv = world.GetField(id_field_velo);
////////////////////////////////
{ // 要素配列の設定
const std::vector<unsigned int>& aIdEA = fv.GetAryIdEA();
for(unsigned int iiea=0;iiea<aIdEA.size();iiea++){
const unsigned int id_ea = aIdEA[iiea];
assert( world.IsIdEA(id_ea) );
const unsigned int id_es_c = fv.GetIdElemSeg(id_ea,CORNER,true, world);
assert( id_es_c != 0 );
CIndexArrayElem* pIAE = new CIndexArrayElem(id_ea,id_es_c,world);
pIAE->ilayer = fv.GetLayer(id_ea);
this->m_apIndexArrayElem.push_back( pIAE );
}
}
// if( aVelo ==0 ){ aVelo = new double [nnode*2]; }
// if( aCoord == 0 ){ aCoord = new double [nnode*2]; }
/*
const std::vector<unsigned int>& aIdEA = fv.GetAryIdEA();
unsigned int nelem0 = 0;
for(unsigned int iiea=0;iiea<aIdEA.size();iiea++){
const unsigned int id_ea = aIdEA[iiea];
assert( world.IsIdEA(id_ea) );
const Fem::Field::CElemAry& ea = world.GetEA(id_ea);
nelem0 += ea.Size();
}
if( nelem != nelem0 ){
nelem = nelem0;
if( aXYVeloElem != 0 ){ delete[] aXYVeloElem; }
if( aXYElem != 0 ){ delete[] aXYElem; }
aXYVeloElem = new double [nelem*6];
aXYElem = new double [nelem*6];
if( world.IsIdField(m_IdFieldColor) ){
if( aColorElem != 0 ){ delete[] aColorElem; }
aColorElem = new double [nelem*3];
}
}
*/
return this->Update(world);
}
void CDrawerFace::SetTexScale(double scale, const Fem::Field::CFieldWorld& world){
tex_scale = scale;
if( pUVArray != 0 ){
if( !world.IsIdField(m_id_field) ) return;
const Fem::Field::CField& field = world.GetField(m_id_field);
// set the vertex array
unsigned int id_na_c_co = field.GetNodeSegInNodeAry(CORNER).id_na_co;
assert( world.IsIdNA(id_na_c_co) );
// const Fem::Field::CNodeAry& na_c_co = world.GetNA(id_na_c_co);
assert( field.IsNodeSeg(CORNER,false,world) );
const Fem::Field::CNodeAry::CNodeSeg& ns_c_co = field.GetNodeSeg(CORNER,false,world);
for(unsigned int ino=0;ino<ns_c_co.Size();ino++){
double c[3]; ns_c_co.GetValue(ino,c);
pUVArray[ino*2+0] = c[0]*tex_scale;
pUVArray[ino*2+1] = c[1]*tex_scale;
}
}
}
bool CEqn_Scalar3D::ClearFixElemAry(
unsigned int id_ea, Fem::Field::CFieldWorld& world)
{
if( !world.IsIdEA( id_ea ) ) return false;
for(unsigned int ifix=0;ifix<m_aIdFixField.size();ifix++){
const unsigned int id_field_fix = m_aIdFixField[ifix].first;
const Fem::Field::CField& field = world.GetField(id_field_fix);
const std::vector<unsigned int>& aIdEA = field.GetAryIdEA();
if( aIdEA.size() != 1 ){
std::cout << "Error!-->Not Implimented" << std::endl;
assert(0);
}
if( aIdEA[0] == id_ea ){
m_aIdFixField.erase( m_aIdFixField.begin()+ifix );
this->ClearLinearSystem();
}
}
return true;
}
int Ls::CLinearSystem_RigidField2::FindIndexArray_Seg(
unsigned int id_field,
Fem::Field::ELSEG_TYPE type,
const Fem::Field::CFieldWorld& world )
{
if( !world.IsIdField(id_field) ) return -1;
const Fem::Field::CField& field = world.GetField(id_field);
unsigned int id_field_parent;
{
if( field.GetIDFieldParent() == 0 ){ id_field_parent = id_field; }
else{ id_field_parent = field.GetIDFieldParent(); }
}
for(unsigned int ils=0;ils<m_aSegRF.size();ils++){
if( m_aSegRF[ils].id_field==id_field_parent && m_aSegRF[ils].node_config==type ){
return ils;
}
}
return -1;
}
bool Fem::Eqn::AddLinearSystem_Wave(
Fem::Ls::CLinearSystem_Eigen& ls,
double rho, double alpha, double source,
const Fem::Field::CFieldWorld& world,
const unsigned int id_field_val )
{
if( !world.IsIdField(id_field_val) ) return false;
const CField& val_field = world.GetField(id_field_val);
if( val_field.GetFieldType() != SCALAR ) return false;
const std::vector<unsigned int>& aIdEA = val_field.GetAryIdEA();
for(unsigned int iiea=0;iiea<aIdEA.size();iiea++){
const unsigned int id_ea = aIdEA[iiea];
if( val_field.GetInterpolationType(id_ea,world) == TRI11 ){
AddLinearSystem_Wave2D_P1(rho,alpha,source,ls,id_field_val,world,id_ea);
}
}
return true;
}
bool CZLinearSystem_GeneralEigen::SetVector_fromField(int iv1,
unsigned int id_field, const Fem::Field::CFieldWorld& world, Fem::Field::FIELD_DERIVATION_TYPE fdt )
{
if( !world.IsIdField(id_field) ){ assert(0); return false; }
const CField& field = world.GetField(id_field);
if( field.GetFieldType() != ZSCALAR ) return false;
const unsigned int nseg = this->m_aSeg.size();
if( nseg == 0 ) return true;
std::vector< CZVector_Blk* >* paVec1 = 0;
if( iv1 >= 0 && iv1 < (int)this->GetTmpVectorArySize() ) paVec1 = &m_TmpVectorArray[iv1];
else if( iv1 == -1 ) paVec1 = &this->m_Residual;
else if( iv1 == -2 ) paVec1 = &this->m_Update;
else assert(0);
// コーナー節点について値を更新
{
/* const int ilss0 = this->FindIndexArray_Seg(id_field,CORNER,world);
assert( ilss0 != -1 );
std::cout << ilss0 << std::endl;*/
unsigned int ilss0 = 0;
assert( ilss0 < (*paVec1).size() );
CZVector_Blk* pVec = (*paVec1)[ilss0];
const CField& field = world.GetField(id_field);
unsigned int id_na = field.GetNodeSegInNodeAry(CORNER).id_na_va;
const CNodeAry& na = world.GetNA(id_na);
const CNodeAry::CNodeSeg& ns = field.GetNodeSeg(CORNER,true,world,fdt);
const unsigned int nblk = na.Size();
const unsigned int nlen = ns.Length();
assert( nlen == 2 );
double* val = new double [nlen];
for(unsigned int iblk=0;iblk<nblk;iblk++){
ns.GetValue(iblk,val);
pVec->SetValue(iblk,0, Com::Complex(val[0],val[1]) );
}
delete[] val;
}
return true;
}
bool Fem::Eqn::AddLinSys_Poisson(
Fem::Ls::CLinearSystem_Save& ls,
double alpha, double source,
const Fem::Field::CFieldWorld& world,
const unsigned int id_field_val,
unsigned int id_ea )
{
if( !world.IsIdField(id_field_val) ) return false;
const CField& val_field = world.GetField(id_field_val);
if( val_field.GetFieldType() != SCALAR ) return false;
if( id_ea != 0 ){
if( val_field.GetInterpolationType(id_ea,world) == TRI11 ){
AddLinearSystem_Poisson2D_P1(alpha,source,ls,id_field_val,world,id_ea);
}
else if( val_field.GetInterpolationType(id_ea,world) == TRI1011 ){
AddLinearSystem_Poisson2D_P1b(alpha,source,ls,id_field_val,world,id_ea);
}
else if( val_field.GetInterpolationType(id_ea,world) == TET11 ){
std::cout << "Error!-->Not Implimented" << std::endl;
assert(0);
}
}
else{
const std::vector<unsigned int>& aIdEA = val_field.GetAryIdEA();
for(unsigned int iiea=0;iiea<aIdEA.size();iiea++){
const unsigned int id_ea = aIdEA[iiea];
bool res = Fem::Eqn::AddLinSys_Poisson(
ls,
alpha, source,
world,
id_field_val,
id_ea );
if( !res ) return false;
}
return true;
}
return true;
}
void Fem::Field::CFieldValueSetter::SetConstant
(double val, unsigned int idof, Fem::Field::FIELD_DERIVATION_TYPE fdt,
Fem::Field::CFieldWorld& world)
{
if( !world.IsIdField(id_field_) ){ return; }
Fem::Field::CField& field = world.GetField(id_field_);
const unsigned int nlen = field.GetNLenValue();
if( idof >= nlen ) return;
if( fdt & Fem::Field::VALUE ){
aValueFieldDof_[idof+nlen*0].SetValue(val);
return;
}
if( fdt & Fem::Field::VELOCITY ){
aValueFieldDof_[idof+nlen*1].SetValue(val);
return;
}
if( fdt & Fem::Field::ACCELERATION ){
aValueFieldDof_[idof+nlen*2].SetValue(val);
return;
}
}
bool CEqn_Fluid2D::AddLinSys(Fem::Ls::CLinearSystem_Field& ls,
const Fem::Field::CFieldWorld& world )
{
// std::cout << "CEqn_Fluid2D::AddLinSys" << std::endl;
if( !world.IsIdEA(m_id_ea) ) return false;
return Fem::Eqn::AddLinSys_Stokes2D_Static(
m_myu, m_g_x, m_g_y,
ls,
this->m_IdFieldVelo, this->m_IdFieldPress,world,
m_id_ea );
// return false;
}