00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033 #include <G3Globals.h>
00034 #include <Domain.h>
00035 #include <Node.h>
00036 #include <MP_Constraint.h>
00037 #include <Matrix.h>
00038 #include <ID.h>
00039 #include <RigidBeam.h>
00040
00041
00042 RigidBeam::RigidBeam(Domain &theDomain, int nR, int nC, int startMPtag) {
00043
00044
00045
00046 Node *nodeR = theDomain.getNode(nR);
00047 if (nodeR == 0) {
00048 g3ErrorHandler->warning("RigidBeam::RigidBeam - %s %d %s\n",
00049 "retained Node", nR, "not in domain");
00050 return;
00051 }
00052 Node *nodeC = theDomain.getNode(nC);
00053 if (nodeR == 0) {
00054 g3ErrorHandler->warning("RigidBeam::RigidBeam - %s %d %s\n",
00055 "constrained Node", nC, "not in domain");
00056 return;
00057 }
00058
00059
00060 const Vector &crdR = nodeR->getCrds();
00061 const Vector &crdC = nodeC->getCrds();
00062 int dimR = crdR.Size();
00063 int dimC = crdC.Size();
00064 if (dimR != dimC) {
00065 g3ErrorHandler->warning("RigidBeam::RigidBeam - mismatch in dimension %s %d %s %d\n",
00066 "between constrained Node", nC, "and Retained node",nR);
00067 return;
00068 }
00069
00070
00071 int numDOF = nodeR->getNumberDOF();
00072 if (numDOF != nodeC->getNumberDOF()){
00073 g3ErrorHandler->warning("RigidBeam::RigidBeam - mismatch in numDOF %s %d %s %d\n",
00074 "between constrained Node", nC, "and Retained node",nR);
00075 return;
00076 }
00077
00078
00079 if(numDOF < dimR){
00080 g3ErrorHandler->warning("RigidBeam::RigidBeam - numDOF at nodes %d %d %s\n",
00081 nR, nC, "must be >= dimension of problem");
00082 return;
00083 }
00084
00085
00086
00087 ID id(numDOF);
00088
00089
00090 Matrix mat(numDOF,numDOF);
00091 mat.Zero();
00092
00093
00094 for (int i=0; i<numDOF; i++) {
00095 mat(i,i) = 1.0;
00096 id(i) = i;
00097 }
00098
00099
00100 if (dimR != numDOF) {
00101 if (dimR == 2 && numDOF == 3) {
00102 double deltaX = crdC(0) - crdR(0);
00103 double deltaY = crdC(1) - crdR(1);
00104 mat(0,2) = -deltaY;
00105 mat(1,2) = deltaX;
00106 } else if (dimR == 3 && numDOF == 6) {
00107 double deltaX = crdC(0) - crdR(0);
00108 double deltaY = crdC(1) - crdR(1);
00109 double deltaZ = crdC(2) - crdR(2);
00110
00111 mat(0,5) = -deltaY;
00112 mat(1,5) = deltaX;
00113
00114
00115 mat(0,4) = deltaZ;
00116 mat(2,4) = -deltaX;
00117
00118
00119 mat(1,3) = -deltaZ;
00120 mat(2,3) = deltaY;
00121 } else {
00122 g3ErrorHandler->warning("RigidBeam::RigidBeam - for nodes %d %d %s\n",
00123 nR, nC, "nodes do not have valid numDOF for their dimension");
00124 return;
00125 }
00126
00127 }
00128
00129
00130 MP_Constraint *newC = new MP_Constraint(startMPtag+1, nR, nC,
00131 mat, id, id);
00132 if (newC == 0) {
00133 g3ErrorHandler->warning("RigidBeam::RigidBeam - for nodes %d %d, out of memory\n",
00134 nC, nR);
00135 } else {
00136
00137 if (theDomain.addMP_Constraint(newC) == false) {
00138 g3ErrorHandler->warning("RigidBeam::RigidBeam - for nodes %d %d, could not add to domain\n",
00139 nC, nR);
00140 delete newC;
00141 }
00142 }
00143 }
00144
00145
00146 RigidBeam::~RigidBeam()
00147 {
00148
00149 }
00150
00151
00152