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 #include <stdlib.h>
00033
00034 #include <OPS_Globals.h>
00035 #include <Domain.h>
00036 #include <Node.h>
00037 #include <MP_Constraint.h>
00038 #include <Matrix.h>
00039 #include <ID.h>
00040 #include <RigidRod.h>
00041
00042
00043 RigidRod::RigidRod(Domain &theDomain, int nR, int nC, int mPtag) {
00044
00045
00046
00047 Node *nodeR = theDomain.getNode(nR);
00048 if (nodeR == 0) {
00049 opserr << "RigidRod::RigidRod - retained Node" << nR << "not in domain\n";
00050 return;
00051 }
00052 Node *nodeC = theDomain.getNode(nC);
00053 if (nodeR == 0) {
00054 opserr << "RigidRod::RigidRod - constrained Node" << nC << "not in domain\n";
00055 return;
00056 }
00057
00058
00059 const Vector &crdR = nodeR->getCrds();
00060 const Vector &crdC = nodeC->getCrds();
00061 int dimR = crdR.Size();
00062 int dimC = crdC.Size();
00063 if (dimR != dimC) {
00064 opserr << "RigidRod::RigidRod - mismatch in dimension " <<
00065 "between constrained Node " << nC << " and Retained node " << nR << endln;
00066 return;
00067 }
00068
00069
00070 int numDOF = nodeR->getNumberDOF();
00071 if (numDOF != nodeC->getNumberDOF()){
00072 opserr << "RigidRod::RigidRod - mismatch in numDOF " <<
00073 "between constrained Node " << nC << " and Retained node " << nR << endln;
00074 return;
00075 }
00076
00077
00078 if(numDOF < dimR){
00079 opserr << "RigidRod::RigidRod - numDOF at nodes " << nR << " and " << nC <<
00080 "must be >= dimension of problem\n";
00081
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(mPtag, nR, nC, mat, id, id);
00101
00102 if (newC == 0) {
00103 opserr << "RigidRod::RigidRod - for nodes " << nR << " and " << nC << " out of memory\n";
00104 exit(-1);
00105 } else {
00106
00107 if (theDomain.addMP_Constraint(newC) == false) {
00108 opserr << "RigidRod::RigidRod - for nodes " << nC << " and " << nR << " could not add to domain\n",
00109 delete newC;
00110 }
00111 }
00112 }
00113
00114
00115 RigidRod::~RigidRod()
00116 {
00117
00118 }
00119
00120
00121