Homec4science
Diffusion contact_internodes (master) Browse

rCONTACTINTERNODES/Code/Westergaard/assembleInternodesMat.m
fccc43844265master

Last Change
Raw File

assembleInternodesMat.m
View Options

function[A, b]=assembleInternodesMat(Mesh, Data, Solution, K)
% assembleInternodesMat: Assembles the entire INTERNODES matrix
% INPUT:
% Mesh: Structure containing all the mesh parameters
% Data: Structure containing all the data parameters
% Solution: Structure containing the solution
% K: Global stiffness matrix
% OUTPUT:
% A: Global INTERNODES matrix
% b: Global right-hand side
% Retrieve mesh parameters
% Coordinate matrix
coord=Mesh.coord_mat;
% Retrieve data parameters
% Free degrees of freedom
Nf=Data.Nf;
% Blocked degrees of freedom
Nd=Data.Nd;
% Retrieve bodies
body=Data.body;
% Right-hand side force vector
f=Data.F;
% Rescaling parameter
r=Data.Contact.rescaling;
% Retrive solution
U=Solution.U;
% Number of free degrees of freedom
nf=length(Nf);
% Number of constraints
nc=length(body{1}.interface_dof);
% Retrieve local degrees of freedom
indx1=body{1}.indx_local;
indx2=body{2}.indx_local;
% Retrieve nodes making up the interfaces
nodes1=Data.body{1}.interface_nodes;
nodes2=Data.body{2}.interface_nodes;
% Retrieve coordinates of nodes making up the interfaces
coord1=coord(nodes1,:);
coord2=coord(nodes2,:);
% Initialization
b=zeros(nf+nc,1);
B=sparse(nf,nc);
B_tilde=sparse(nc,nf);
C=sparse(nc,nc);
Kff=1/r*K(Nf, Nf);
Diff=Data.R12_normal*coord2-coord1;
% Assemblage
% Right-hand side vector
b(1:nf)=1/r*(f(Nf)-K(Nf,Nd)*U(Nd));
b(nf+1:nf+nc)=reshape(Diff', [],1);
% B and B_tilde
B(indx1,:)=-body{1}.interface_mass;
B(indx2,:)=body{2}.interface_mass*Data.R21;
B_tilde(:,indx1)=speye(nc,nc);
B_tilde(:,indx2)=-Data.R12;
% INTERNODES matrix
A1=horzcat(Kff, B);
A2=horzcat(B_tilde, C);
A=vertcat(A1, A2);
end
c4science · Help