Couldn't build model after I add CoordinateSet
Posted: Fri Nov 11, 2016 1:39 am
I try to build my own model from my solidwork files, but it crashes after I add CoordinateSet
I believe I follow the tutorial
My code looks like this
Is there any problem with it?
I believe I follow the tutorial
My code looks like this
Code: Select all
double lHipJointMidMass=0.03685667;
Vec3 lHipJointMidMassCenter(-0,0.03979000,0);
Inertia lHipJointMidInertia(Mat33(0.00001597,0.00000000,0.00000000,0.00000000,0.00000479,0.00000000,0.00000000,0.00000000,0.00001597));
OpenSim::Body *lHipJointMid = new OpenSim::Body("lHipJointMid",lHipJointMidMass,lHipJointMidMassCenter,lHipJointMidInertia);
lHipJointMid->addDisplayGeometry("..\\Geometry\\exo\\JointMid.STL");
Vec3 lHipJointMidOriParent(Vec3(SimTK::Pi,0,0));
Vec3 lHipJointMidLocatParent(Vec3(0,0.017144999999999994,-0.017145000000000001));
Vec3 lHipJointMidLocatBody(Vec3(0,0.062434999999994439,-0.016645000000000042));
Vec3 lHipJointMidOriBody(Vec3(SimTK::Pi,0,0));
PinJoint *lHipJointMidToTop=new PinJoint("lHipJointMidToTop",*lHipJointTop,lHipJointMidLocatParent,lHipJointMidOriParent,*lHipJointMid,lHipJointMidLocatBody,lHipJointMidOriBody);
CoordinateSet& lHipJointMidToTopCorSet = lHipJointMidToTop->upd_CoordinateSet();
lHipJointMidToTopCorSet[0].setRange(angleRange);
lHipJointMidToTopCorSet[1].setRange(angleRange);
lHipJointMidToTopCorSet[2].setRange(angleRange);
lHipJointMidToTopCorSet[3].setRange(positionRange);
lHipJointMidToTopCorSet[4].setRange(positionRange);
lHipJointMidToTopCorSet[5].setRange(positionRange);
osimModel.addBody(lHipJointMid);