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 <RigidRod.h>
00040
00041
00042 RigidRod::RigidRod(Domain &theDomain, int nR, int nC, int startMPtag) {
00043
00044
00045
00046 Node *nodeR = theDomain.getNode(nR);
00047 if (nodeR == 0) {
00048 g3ErrorHandler->warning("RigidRod::RigidRod - %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("RigidRod::RigidRod - %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("RigidRod::RigidRod - 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("RigidRod::RigidRod - 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("RigidRod::RigidRod - numDOF at nodes %d %d %s\n",
00081 nR, nC, "must be >= dimension of problem");
00082 return;
00083 }
00084
00085
00086
00087 ID id(dimR);
00088
00089
00090 Matrix mat(dimR,dimR);
00091 mat.Zero();
00092
00093
00094 for (int i=0; i<dimR; i++) {
00095 mat(i,i) = 1.0;
00096 id(i) = i;
00097 }
00098
00099
00100 MP_Constraint *newC = new MP_Constraint(startMPtag+1, nR, nC,
00101 mat, id, id);
00102 if (newC == 0) {
00103 g3ErrorHandler->warning("RigidRod::RigidRod - for nodes %d %d, out of memory\n",
00104 nC, nR);
00105 } else {
00106
00107 if (theDomain.addMP_Constraint(newC) == false) {
00108 g3ErrorHandler->warning("RigidRod::RigidRod - for nodes %d %d, could not add to domain\n",
00109 nC, nR);
00110 delete newC;
00111 }
00112 }
00113 }
00114
00115
00116 RigidRod::~RigidRod()
00117 {
00118
00119 }
00120
00121
00122