latticelink3dboundary.C

Go to the documentation of this file.

/*
 *
 *                 #####    #####   ######  ######  ###   ###
 *               ##   ##  ##   ##  ##      ##      ## ### ##
 *              ##   ##  ##   ##  ####    ####    ##  #  ##
 *             ##   ##  ##   ##  ##      ##      ##     ##
 *            ##   ##  ##   ##  ##      ##      ##     ##
 *            #####    #####   ##      ######  ##     ##
 *
 *
 *             OOFEM : Object Oriented Finite Element Code
 *
 *               Copyright (C) 1993 - 2025   Borek Patzak
 *
 *
 *
 *       Czech Technical University, Faculty of Civil Engineering,
 *   Department of Structural Mechanics, 166 29 Prague, Czech Republic
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */
 
#include "domain.h"
#include "../sm/Elements/LatticeElements/latticelink3dboundary.h"
#include "../sm/Materials/LatticeMaterials/latticematstatus.h"
#include "node.h"
#include "material.h"
#include "gausspoint.h"
#include "gaussintegrationrule.h"
#include "floatmatrix.h"
#include "intarray.h"
#include "floatarray.h"
#include "mathfem.h"
#include "../sm/Elements/LatticeElements/latticestructuralelement.h"
#include "classfactory.h"
#include "../sm/Materials/structuralmaterial.h"
#include "contextioerr.h"
#include "datastream.h"
#include "crosssection.h"
#include "dof.h"
#include "parametermanager.h"
#include "paramkey.h"
 
#ifdef __OOFEG
 #include "oofeggraphiccontext.h"
#endif
 
namespace oofem {
REGISTER_Element(LatticeLink3dBoundary);
ParamKey LatticeLink3dBoundary::IPK_LatticeLink3dBoundary_location("location");
 
LatticeLink3dBoundary :: LatticeLink3dBoundary(int n, Domain *aDomain) : LatticeLink3d(n, aDomain), location(2)
{
    numberOfDofMans = 3;
    geometryFlag = 0;
}
 
LatticeLink3dBoundary :: ~LatticeLink3dBoundary()
{}
 
 
void
LatticeLink3dBoundary :: computeStiffnessMatrix(FloatMatrix &answer, MatResponseMode rMode,
                                                TimeStep *tStep)
// Computes numerically the stiffness matrix of the receiver.
{
    FloatMatrix d, bi, bj, dbj, dij, bjt;
    FloatMatrix t(12, 18), tt;
    FloatMatrix answerTemp(12, 12), answerHelp, ttk(18, 12);
    bool matStiffSymmFlag = this->giveCrossSection()->isCharacteristicMtrxSymmetric(rMode);
    answerTemp.zero();
    answerHelp.zero();
    t.zero();
 
    if ( geometryFlag == 0 ) {
        computeGeometryProperties();
    }
 
 
    this->computeBmatrixAt(integrationRulesArray [ 0 ]->getIntegrationPoint(0), bj);
    this->computeConstitutiveMatrixAt(d, rMode, integrationRulesArray [ 0 ]->getIntegrationPoint(0), tStep);
 
    dbj.beProductOf(d, bj);
    bjt.beTranspositionOf(bj);
    answerTemp.beProductOf(bjt, dbj);
 
    answer.resize(computeNumberOfDofs(), computeNumberOfDofs() );
    answer.zero();
 
    answerHelp.resize(computeNumberOfDofs(), computeNumberOfDofs() );
    answerHelp.zero();
 
    for ( int m = 1; m <= 12; m++ ) {
        for ( int k = 1; k <= 12; k++ ) {
            answer.at(m, k) = answerTemp.at(m, k);
        }
    }
 
    if ( matStiffSymmFlag ) {
        answer.symmetrized();
    }
 
    // Rotate to global system add the projections and rotate back to local system.
 
    FloatMatrix R;
    if ( this->giveRotationMatrix(R) ) {
        answer.rotatedWith(R);
    }
 
    for ( int m = 1; m <= 12; m++ ) {
        for ( int k = 1; k <= 12; k++ ) {
            answerTemp.at(m, k) = answer.at(m, k);
        }
    }
 
    IntArray projectionComponentNodeOne(3);
    projectionComponentNodeOne.zero();
    if ( location.at(1) != 0 ) {
        giveSwitches(projectionComponentNodeOne, location.at(1) );
    }
 
    IntArray projectionComponentNodeTwo(3);
    projectionComponentNodeTwo.zero();
    if ( location.at(2) != 0 ) {
        giveSwitches(projectionComponentNodeTwo, location.at(2) );
    }
 
    for ( int k = 1; k <= 12; k++ ) {
        t.at(k, k) = 1.;
    }
    t.at(1, 13) = projectionComponentNodeOne.at(1);
    t.at(2, 14) = projectionComponentNodeOne.at(2);
    t.at(3, 15) = projectionComponentNodeOne.at(3);
 
 
    t.at(2, 16) = projectionComponentNodeOne.at(3);
    t.at(1, 17) = projectionComponentNodeOne.at(3);
    t.at(1, 18) = projectionComponentNodeOne.at(2);
 
 
    t.at(7, 13) = projectionComponentNodeTwo.at(1);
    t.at(8, 14) = projectionComponentNodeTwo.at(2);
    t.at(9, 15) = projectionComponentNodeTwo.at(3);
 
    t.at(8, 16) = projectionComponentNodeTwo.at(3);
    t.at(7, 17) = projectionComponentNodeTwo.at(3);
    t.at(7, 18) = projectionComponentNodeTwo.at(2);
 
 
    tt.beTranspositionOf(t);
 
    ttk.beProductOf(tt, answerTemp);
    answer.beProductOf(ttk, t);
 
    //Rotate back to local system
    FloatMatrix Rtranspose;
    Rtranspose.beTranspositionOf(R);
    answer.rotatedWith(Rtranspose);
 
    return;
}
 
void
LatticeLink3dBoundary :: recalculateCoordinates(int nodeNumber, FloatArray &coords) {
    coords.resize(3);
    coords.zero();
    Node *node;
 
    FloatArray specimenDimension(3);
    specimenDimension.at(1) =  this->giveNode(3)->giveCoordinate(1);
    specimenDimension.at(2) =  this->giveNode(3)->giveCoordinate(2);
    specimenDimension.at(3) =  this->giveNode(3)->giveCoordinate(3);
 
    IntArray projectionComponent(3);
    projectionComponent.zero();
 
    if ( nodeNumber == 1 ) {
        node  = this->giveNode(1);
        if ( location.at(1) != 0 ) {
            giveSwitches(projectionComponent, location.at(1) );
        }
    } else if ( nodeNumber == 2 ) {
        node  = this->giveNode(2);
        if ( location.at(2) != 0 ) {
            giveSwitches(projectionComponent, location.at(2) );
        }
    } else {
        OOFEM_ERROR("wrong element used in the vtk module");
    }
 
    for ( int i = 0; i < 3; i++ ) {
        coords.at(i + 1) =  node->giveCoordinate(i + 1) + projectionComponent.at(i + 1) * specimenDimension.at(i + 1);
    }
    return;
}
 
void
LatticeLink3dBoundary :: computeStrainVector(FloatArray &answer, GaussPoint *gp, TimeStep *stepN)
// Computes the vector containing the strains at the Gauss point gp of
// the receiver, at time step stepN. The nature of these strains depends
// on the element's type.
{
    FloatMatrix b;
    FloatArray u;
 
 
    //Compute strain vector
    //Get the 18 components of the displacement vector of this element
    this->computeVectorOf(VM_Total, stepN, u);
    this->computeBmatrixAt(gp, b);
 
 
    // subtract initial displacements, if defined
    if ( initialDisplacements ) {
        u.subtract(* initialDisplacements);
    }
 
    //Compute projection vector
    IntArray projectionComponentNodeOne(3);
    projectionComponentNodeOne.zero();
    if ( location.at(1) != 0 ) {
        giveSwitches(projectionComponentNodeOne, location.at(1) );
    }
 
    IntArray projectionComponentNodeTwo(3);
    projectionComponentNodeTwo.zero();
 
    if ( location.at(2) != 0 ) {
        giveSwitches(projectionComponentNodeTwo, location.at(2) );
    }
 
    FloatMatrix rotationMatrix;
    if ( this->computeGtoLRotationMatrix(rotationMatrix) ) {
        u.rotatedWith(rotationMatrix, 't');
    }
 
    //General expressions for the corrected displacements. Rotations at nodes are not influenced. Only translations
    u.at(1) = u.at(1) + projectionComponentNodeOne.at(1) * u.at(13) + projectionComponentNodeOne.at(2) * u.at(18) + projectionComponentNodeOne.at(3) * u.at(17);
    u.at(2) = u.at(2) + projectionComponentNodeOne.at(2) * u.at(14) + projectionComponentNodeOne.at(3) * u.at(16);
    u.at(3) = u.at(3) + projectionComponentNodeOne.at(3) * u.at(15);
 
    u.at(7) = u.at(7) + projectionComponentNodeTwo.at(1) * u.at(13) + projectionComponentNodeTwo.at(2) * u.at(18) + projectionComponentNodeTwo.at(3) * u.at(17);
    u.at(8) = u.at(8) + projectionComponentNodeTwo.at(2) * u.at(14) + projectionComponentNodeTwo.at(3) * u.at(16);
    u.at(9) = u.at(9) + projectionComponentNodeTwo.at(3) * u.at(15);
 
 
    if ( this->computeGtoLRotationMatrix(rotationMatrix) ) {
        u.rotatedWith(rotationMatrix, 'n');
    }
    //define a temp displacement vector
    FloatArray uTemp(12);
 
    for ( int i = 1; i <= 12; i++ ) {
        uTemp.at(i) = u.at(i);
    }
 
    answer.beProductOf(b, uTemp);
}
 
bool
LatticeLink3dBoundary :: computeGtoLRotationMatrix(FloatMatrix &answer)
{
    FloatMatrix lcs;
    int i, j;
 
    answer.resize(18, 18);
    answer.zero();
 
    this->giveLocalCoordinateSystem(lcs);
    for ( i = 1; i <= 3; i++ ) {
        for ( j = 1; j <= 3; j++ ) {
            answer.at(i, j) = lcs.at(i, j);
            answer.at(i + 3, j + 3) = lcs.at(i, j);
            answer.at(i + 6, j + 6) = lcs.at(i, j);
            answer.at(i + 9, j + 9) = lcs.at(i, j);
        }
    }
    answer.at(13, 13) = 1.;
    answer.at(14, 14) = 1.;
    answer.at(15, 15) = 1.;
    answer.at(16, 16) = 1.;
    answer.at(17, 17) = 1.;
    answer.at(18, 18) = 1.;
 
    return 1;
}
 
int
LatticeLink3dBoundary :: giveLocalCoordinateSystem(FloatMatrix &answer)
{
    if ( geometryFlag == 0 ) {
        computeGeometryProperties();
    }
 
    answer = this->localCoordinateSystem;
 
    return 1;
}
 
 
void
LatticeLink3dBoundary ::   giveDofManDofIDMask(int inode, IntArray &answer) const
{
    if ( inode == 3 ) {
        answer = { E_xx, E_yy, E_zz, G_yz, G_xz, G_xy };
    } else   {
        answer = { D_u, D_v, D_w, R_u, R_v, R_w };
    }
}
 
void
LatticeLink3dBoundary :: initializeFrom(InputRecord &ir, int priority)
{   
    ParameterManager &ppm = this->giveDomain()->elementPPM;
    LatticeLink3d :: initializeFrom(ir, priority);
 
    PM_UPDATE_PARAMETER(location, ppm, ir, this->number, IPK_LatticeLink3dBoundary_location, priority) ;    
}
 
void 
LatticeLink3dBoundary :: postInitialize()
{
    ParameterManager &ppm = this->giveDomain()->elementPPM;
    LatticeLink3d :: postInitialize();
    PM_ELEMENT_ERROR_IFNOTSET(ppm, this->number, IPK_LatticeLink3dBoundary_location) ;
}
 
 
 
void
LatticeLink3dBoundary :: giveInternalForcesVector(FloatArray &answer, TimeStep *tStep, int useUpdatedGpRecord)
{
    Material *mat = this->giveMaterial();
 
    FloatMatrix b, bt, A, R, GNT;
    FloatArray bs, TotalStressVector, u, strain;
 
    this->computeVectorOf(VM_Total, tStep, u);
 
    // subtract initial displacements, if defined
    if ( initialDisplacements ) {
        u.subtract(* initialDisplacements);
    }
 
    answer.resize(18);
    answer.zero();
 
    this->computeBmatrixAt(integrationRulesArray [ 0 ]->getIntegrationPoint(0), b);
 
    bt.beTranspositionOf(b);
    if ( useUpdatedGpRecord == 1 ) {
        TotalStressVector = ( ( StructuralMaterialStatus * ) mat->giveStatus(integrationRulesArray [ 0 ]->getIntegrationPoint(0) ) )
                            ->giveStressVector();
    } else
    if ( !this->isActivated(tStep) ) {
        strain.resize(StructuralMaterial :: giveSizeOfVoigtSymVector(integrationRulesArray [ 0 ]->getIntegrationPoint(0)->giveMaterialMode() ) );
        strain.zero();
    }
    this->computeStrainVector(strain, integrationRulesArray [ 0 ]->getIntegrationPoint(0), tStep);
 
    this->computeStressVector(TotalStressVector, strain, integrationRulesArray [ 0 ]->getIntegrationPoint(0), tStep);
 
    bs.beProductOf(bt, TotalStressVector);
 
    for ( int m = 1; m <= 12; m++ ) {
        answer.at(m) = bs.at(m);
    }
 
    if ( this->giveRotationMatrix(R) ) {
        answer.rotatedWith(R, 't');
    }
 
    IntArray projectionComponentNodeOne(3);
    projectionComponentNodeOne.zero();
    if ( location.at(1) != 0 ) {
        giveSwitches(projectionComponentNodeOne, location.at(1) );
    }
 
    IntArray projectionComponentNodeTwo(3);
    projectionComponentNodeTwo.zero();
 
    if ( location.at(2) != 0 ) {
        giveSwitches(projectionComponentNodeTwo, location.at(2) );
    }
 
    //Normal stresses
    answer.at(13) = projectionComponentNodeOne.at(1) * answer.at(1) + projectionComponentNodeTwo.at(1) * answer.at(7);
    answer.at(14) = projectionComponentNodeOne.at(2) * answer.at(2) + projectionComponentNodeTwo.at(2) * answer.at(8);
    answer.at(15) = projectionComponentNodeOne.at(3) * answer.at(3) + projectionComponentNodeTwo.at(3) * answer.at(9);
 
    //Shear stresses
    answer.at(16) = projectionComponentNodeOne.at(3) * answer.at(2) + projectionComponentNodeTwo.at(3) * answer.at(8);
    answer.at(17) = projectionComponentNodeOne.at(3) * answer.at(1) + projectionComponentNodeTwo.at(3) * answer.at(7);
    answer.at(18) = projectionComponentNodeOne.at(2) * answer.at(1) + projectionComponentNodeTwo.at(2) * answer.at(7);
 
    //Rotate to local system
    if ( this->giveRotationMatrix(R) ) {
        answer.rotatedWith(R, 'n');
    }
 
    return;
}
 
void
LatticeLink3dBoundary :: giveSwitches(IntArray &answer, int location) {
    int counter = 1;
    for ( int x = -1; x <  2; x++ ) {
        for ( int y = -1; y <  2; y++ ) {
            for ( int z = -1; z <  2; z++ ) {
                if ( !( z == 0 && y == 0 && x == 0 ) ) {
                    if ( counter == location ) {
                        answer(0) = x;
                        answer(1) = y;
                        answer(2) = z;
                    }
                    counter++;
                }
            }
        }
    }
    return;
}
 
void
LatticeLink3dBoundary :: computeGeometryProperties()
{
    Node *nodeA, *nodeB;
 
    FloatArray coordsA(3);
    FloatArray coordsB(3);
 
    nodeA  = this->giveNode(1);
    nodeB  = this->giveNode(2);
 
    FloatArray specimenDimension(3);
    specimenDimension.at(1) =  this->giveNode(3)->giveCoordinate(1);
    specimenDimension.at(2) =  this->giveNode(3)->giveCoordinate(2);
    specimenDimension.at(3) =  this->giveNode(3)->giveCoordinate(3);
 
    IntArray projectionComponentNodeOne(3);
    projectionComponentNodeOne.zero();
    if ( location.at(1) != 0 ) {
        giveSwitches(projectionComponentNodeOne, location.at(1) );
    }
 
    IntArray projectionComponentNodeTwo(3);
    projectionComponentNodeTwo.zero();
    if ( location.at(2) != 0 ) {
        giveSwitches(projectionComponentNodeTwo, location.at(2) );
    }
 
    for ( int i = 0; i < 3; i++ ) {
        coordsA.at(i + 1) =  nodeA->giveCoordinate(i + 1) + projectionComponentNodeOne.at(i + 1) * specimenDimension.at(i + 1);
        coordsB.at(i + 1) =  nodeB->giveCoordinate(i + 1) + projectionComponentNodeTwo.at(i + 1) * specimenDimension.at(i + 1);
    }
 
    //From here on the normal functions should be valid
 
    FloatArray rigidGlobal(3);
 
    //Calculate normal vector
    for ( int i = 0; i < 3; i++ ) {
        rigidGlobal.at(i + 1) = coordsB.at(i + 1) - coordsA.at(i + 1);
    }
 
    //Construct an initial temporary local coordinate system
    FloatArray normal(3), s(3), t(3);
 
    //Calculate normal vector
    normal = this->directionVector;
    normal.normalize();
 
    //Construct two perpendicular axis so that n is normal to the plane which they create
    //Check, if one of the components of the normal-direction is zero
    if ( normal.at(1) == 0 ) {
        s.at(1) = 0.;
        s.at(2) = normal.at(3);
        s.at(3) = -normal.at(2);
    } else if ( normal.at(2) == 0 ) {
        s.at(1) = normal.at(3);
        s.at(2) = 0.;
        s.at(3) = -normal.at(1);
    } else {
        s.at(1) = normal.at(2);
        s.at(2) = -normal.at(1);
        s.at(3) = 0.;
    }
 
    s.normalize();
 
    t.beVectorProductOf(normal, s);
    t.normalize();
 
    //Set up rotation matrix
    FloatMatrix lcs(3, 3);
 
    this->localCoordinateSystem.resize(3, 3);
    this->localCoordinateSystem.zero();
 
    for ( int i = 1; i <= 3; i++ ) {
        this->localCoordinateSystem.at(1, i) = normal.at(i);
        this->localCoordinateSystem.at(2, i) = s.at(i);
        this->localCoordinateSystem.at(3, i) = t.at(i);
    }
 
    // Rotate rigidarm vector into local coordinate system
 
    this->rigid.beProductOf(localCoordinateSystem, rigidGlobal);
 
    this->globalCentroid.resize(3);
    for ( int i = 1; i <= 3; i++ ) {
        this->globalCentroid.at(i) = coordsA.at(i);
    }
 
    this->geometryFlag = 1;
 
    return;
}
 
 
void
LatticeLink3dBoundary :: saveContext(DataStream &stream, ContextMode mode)
{
    LatticeLink3d :: saveContext(stream, mode);
 
    contextIOResultType iores;
 
    if ( ( mode & CM_Definition ) ) {
        if ( ( iores = location.storeYourself(stream) ) != CIO_OK ) {
            THROW_CIOERR(iores);
        }
    }
}
 
 
 
void
LatticeLink3dBoundary :: restoreContext(DataStream &stream, ContextMode mode)
{
    contextIOResultType iores;
 
    LatticeLink3d :: restoreContext(stream, mode);
 
    if ( mode & CM_Definition ) {
        if ( ( iores = this->location.restoreYourself(stream) ) != CIO_OK ) {
            THROW_CIOERR(iores);
        }
    }
}
 
 
 
#ifdef __OOFEG
 
void
LatticeLink3dBoundary :: drawYourself(oofegGraphicContext &gc, TimeStep *tStep)
{
    OGC_PlotModeType mode = gc.giveIntVarPlotMode();
 
    if ( mode == OGC_rawGeometry ) {
        this->drawRawGeometry(gc, tStep);
    } else if ( mode == OGC_deformedGeometry ) {
        this->drawDeformedGeometry(gc, tStep, DisplacementVector);
    } else if ( mode == OGC_elemSpecial ) {
        this->drawSpecial(gc, tStep);
    } else {
        OOFEM_ERROR("drawYourself : unsupported mode");
    }
}
 
 
 
 
void LatticeLink3dBoundary :: drawRawGeometry(oofegGraphicContext &gc, TimeStep *tStep)
{
    GraphicObj *go;
 
    WCRec p [ 2 ]; /* points */
    if ( !gc.testElementGraphicActivity(this) ) {
        return;
    }
 
    EASValsSetLineWidth(OOFEG_RAW_GEOMETRY_WIDTH);
    EASValsSetColor(gc.getActiveCrackColor() );
    EASValsSetLayer(OOFEG_RAW_GEOMETRY_LAYER);
 
 
    FloatArray specimenDimension(3);
    specimenDimension.at(1) =  this->giveNode(3)->giveCoordinate(1);
    specimenDimension.at(2) =  this->giveNode(3)->giveCoordinate(2);
    specimenDimension.at(3) =  this->giveNode(3)->giveCoordinate(3);
 
    //Compute projection vector
    IntArray projectionComponentNodeOne(3);
    projectionComponentNodeOne.zero();
    if ( location.at(1) != 0 ) {
        giveSwitches(projectionComponentNodeOne, location.at(1) );
    }
 
    IntArray projectionComponentNodeTwo(3);
    projectionComponentNodeTwo.zero();
 
    if ( location.at(2) != 0 ) {
        giveSwitches(projectionComponentNodeTwo, location.at(2) );
    }
 
    p [ 0 ].x = ( FPNum ) this->giveNode(1)->giveCoordinate(1) + projectionComponentNodeOne.at(1) * specimenDimension.at(1);
    p [ 0 ].y = ( FPNum ) this->giveNode(1)->giveCoordinate(2) + projectionComponentNodeOne.at(2) * specimenDimension.at(2);
    p [ 0 ].z = ( FPNum ) this->giveNode(1)->giveCoordinate(3) + projectionComponentNodeOne.at(3) * specimenDimension.at(3);
    p [ 1 ].x = ( FPNum ) this->giveNode(2)->giveCoordinate(1) + projectionComponentNodeTwo.at(1) * specimenDimension.at(1);
    p [ 1 ].y = ( FPNum ) this->giveNode(2)->giveCoordinate(2) + projectionComponentNodeTwo.at(2) * specimenDimension.at(2);
    p [ 1 ].z = ( FPNum ) this->giveNode(2)->giveCoordinate(3) + projectionComponentNodeTwo.at(3) * specimenDimension.at(3);
 
    go = CreateLine3D(p);
    EGWithMaskChangeAttributes(WIDTH_MASK | COLOR_MASK | LAYER_MASK, go);
    EGAttachObject(go, ( EObjectP ) this);
    EMAddGraphicsToModel(ESIModel(), go);
}
 
void LatticeLink3dBoundary :: drawDeformedGeometry(oofegGraphicContext &gc, TimeStep *tStep, UnknownType type)
{
    GraphicObj *go;
 
    if ( !gc.testElementGraphicActivity(this) ) {
        return;
    }
 
    double defScale = gc.getDefScale();
 
    WCRec p [ 2 ]; /* points */
 
    EASValsSetLineWidth(OOFEG_DEFORMED_GEOMETRY_WIDTH);
    EASValsSetColor(gc.getDeformedElementColor() );
    EASValsSetLayer(OOFEG_DEFORMED_GEOMETRY_LAYER);
 
    FloatArray specimenDimension(3);
    specimenDimension.at(1) =  this->giveNode(3)->giveCoordinate(1);
    specimenDimension.at(2) =  this->giveNode(3)->giveCoordinate(2);
    specimenDimension.at(3) =  this->giveNode(3)->giveCoordinate(3);
 
    FloatArray dispOne(6);
    dispOne.at(1) = this->giveNode(1)->giveDofWithID(D_u)->giveUnknown(VM_Total, tStep);
    dispOne.at(2) = this->giveNode(1)->giveDofWithID(D_v)->giveUnknown(VM_Total, tStep);
    dispOne.at(3) = this->giveNode(1)->giveDofWithID(D_w)->giveUnknown(VM_Total, tStep);
    dispOne.at(4) = this->giveNode(1)->giveDofWithID(R_u)->giveUnknown(VM_Total, tStep);
    dispOne.at(5) = this->giveNode(1)->giveDofWithID(R_v)->giveUnknown(VM_Total, tStep);
    dispOne.at(6) = this->giveNode(1)->giveDofWithID(R_w)->giveUnknown(VM_Total, tStep);
 
    FloatArray dispTwo(6);
    dispTwo.at(1) = this->giveNode(2)->giveDofWithID(D_u)->giveUnknown(VM_Total, tStep);
    dispTwo.at(2) = this->giveNode(2)->giveDofWithID(D_v)->giveUnknown(VM_Total, tStep);
    dispTwo.at(3) = this->giveNode(2)->giveDofWithID(D_w)->giveUnknown(VM_Total, tStep);
    dispTwo.at(4) = this->giveNode(2)->giveDofWithID(R_u)->giveUnknown(VM_Total, tStep);
    dispTwo.at(5) = this->giveNode(2)->giveDofWithID(R_v)->giveUnknown(VM_Total, tStep);
    dispTwo.at(6) = this->giveNode(2)->giveDofWithID(R_w)->giveUnknown(VM_Total, tStep);
 
    FloatArray dispThree(6);
    dispThree.at(1) = this->giveNode(3)->giveDofWithID(D_u)->giveUnknown(VM_Total, tStep);
    dispThree.at(2) = this->giveNode(3)->giveDofWithID(D_v)->giveUnknown(VM_Total, tStep);
    dispThree.at(3) = this->giveNode(3)->giveDofWithID(D_w)->giveUnknown(VM_Total, tStep);
    dispThree.at(4) = this->giveNode(3)->giveDofWithID(R_u)->giveUnknown(VM_Total, tStep);
    dispThree.at(5) = this->giveNode(3)->giveDofWithID(R_v)->giveUnknown(VM_Total, tStep);
    dispThree.at(6) = this->giveNode(3)->giveDofWithID(R_w)->giveUnknown(VM_Total, tStep);
 
    IntArray projectionComponentNodeOne(3);
    projectionComponentNodeOne.zero();
    if ( location.at(1) != 0 ) {
        giveSwitches(projectionComponentNodeOne, location.at(1) );
    }
 
    IntArray projectionComponentNodeTwo(3);
    projectionComponentNodeTwo.zero();
    if ( location.at(2) != 0 ) {
        giveSwitches(projectionComponentNodeTwo, location.at(2) );
    }
 
 
    //Modify dispOne and dispTwo
    dispOne.at(1) = dispOne.at(1) + projectionComponentNodeOne.at(1) * dispThree.at(1) + projectionComponentNodeOne.at(2) * dispThree.at(4) + projectionComponentNodeOne.at(3) * dispThree.at(5);
    dispOne.at(2) = dispOne.at(2) + projectionComponentNodeOne.at(2) * dispThree.at(2) + projectionComponentNodeOne.at(3) * dispThree.at(6);
    dispOne.at(3) = dispOne.at(3) + projectionComponentNodeOne.at(3) * dispThree.at(3);
 
 
    dispTwo.at(1) = dispTwo.at(1) + projectionComponentNodeTwo.at(1) * dispThree.at(1) + projectionComponentNodeTwo.at(2) * dispThree.at(4) + projectionComponentNodeTwo.at(3) * dispThree.at(5);
    dispTwo.at(2) = dispTwo.at(2) + projectionComponentNodeTwo.at(2) * dispThree.at(2) + projectionComponentNodeTwo.at(3) * dispThree.at(6);
    dispTwo.at(3) = dispTwo.at(3) + projectionComponentNodeTwo.at(3) * dispThree.at(3);
 
    double x1, y1, z1, x2, y2, z2;
    x1 = this->giveNode(1)->giveCoordinate(1) + projectionComponentNodeOne.at(1) * specimenDimension.at(1);
    y1 = this->giveNode(1)->giveCoordinate(2) + projectionComponentNodeOne.at(2) * specimenDimension.at(2);
    z1 = this->giveNode(1)->giveCoordinate(3) + projectionComponentNodeOne.at(3) * specimenDimension.at(3);
 
    x2 = this->giveNode(2)->giveCoordinate(1) + projectionComponentNodeTwo.at(1) * specimenDimension.at(1);
    y2 = this->giveNode(2)->giveCoordinate(2) + projectionComponentNodeTwo.at(2) * specimenDimension.at(2);
    z2 = this->giveNode(2)->giveCoordinate(3) + projectionComponentNodeTwo.at(3) * specimenDimension.at(3);
 
    p [ 0 ].x = ( FPNum ) x1 + defScale * dispOne.at(1);
    p [ 0 ].y = ( FPNum ) y1 + defScale * dispOne.at(2);
    p [ 0 ].z = ( FPNum ) z1 + defScale * dispOne.at(3);
 
    p [ 1 ].x = ( FPNum ) x2 + defScale * dispTwo.at(1);
    p [ 1 ].y = ( FPNum ) y2 + defScale * dispTwo.at(2);
    p [ 1 ].z = ( FPNum ) z2 + defScale * dispTwo.at(3);
 
    go = CreateLine3D(p);
    EGWithMaskChangeAttributes(WIDTH_MASK | COLOR_MASK | LAYER_MASK, go);
    EMAddGraphicsToModel(ESIModel(), go);
}
 
#endif
} // end namespace oofem