computing jacobian: matlab and c++ api difference #3735

Provide easy-to-use, extensible software for modeling, simulating, controlling, and analyzing the neuromusculoskeletal system.
POST REPLY
User avatar
emanuele feola
Posts: 2
Joined: Tue Mar 22, 2022 12:43 am

computing jacobian: matlab and c++ api difference #3735

Post by emanuele feola » Wed Mar 13, 2024 5:38 am

My goal is to compute the jacobian of the model. Using matlab's api, it works as expected, but I'm having some trouble making it work using c++ api. Do you have any idea what I'm doing wrong? Here it follows both the matlab and the c++ code I'm testing, and some debug information at the end. Thank you in advance for any suggestion.

Using matlab it works correctly:

Code: Select all

model = Model("model.osim");
state = model.initSystem(); 
model.realizePosition(state);

force_position_vector = [0, 0, 0];
simbody_position_vector = Vec3.createFromMat(force_position_vector);
simbody_jacobian = Matrix();

smss = model.getMatterSubsystem();
smss.calcStationJacobian(state, 4, simbody_position_vector, simbody_jacobian);
jacob = simbody_jacobian.getAsMat; % correct output
If I use c++ api, an exception is raised (Access violation reading location 0x0000000000000000):

Code: Select all

Model* model = new Model("model.osim");
State& state = model->initSystem();
model->realizePosition(state);

SimbodyMatterSubsystem smss = model->getMatterSubsystem();
Matrix JS;
smss.calcStationJacobian(state, MobilizedBodyIndex(4), Vec3(0), JS); // exception (Access violation reading location 0x0000000000000000.)
Debugging I found the following info.
The model is loaded correctly, since model->printBasicInfo(); prints the correct number of joints (4) and bodies (4).

If I loop through the body set (model->getBodySet()) I can print the bodies names, but if I try to access their mobilizedbody another excpetion is thrown.

If I loop through the joint set, I can print the joints names but I can't access their child frames (joints.getChildFrame()) without raising another exception.

state.getNQ() and state.getNU() return the correct number.
model->getNumBodies(); returns the correct number of bodies
smss->getNumBodies(); returns 0, as if the model was not initialized correctly

Tags:

User avatar
Michael Sherman
Posts: 808
Joined: Fri Apr 01, 2005 6:05 pm

Re: computing jacobian: matlab and c++ api difference #3735

Post by Michael Sherman » Wed Mar 13, 2024 7:44 am

A quick look suggests you need to get a reference to the existing SimbodyMatterSubsystem rather than a copy:

Code: Select all

const SimbodyMatterSubsystem& smss = model->getMatterSubsystem();
Regards,
Sherm

User avatar
Michael Sherman
Posts: 808
Joined: Fri Apr 01, 2005 6:05 pm

Re: computing jacobian: matlab and c++ api difference #3735

Post by Michael Sherman » Wed Mar 13, 2024 7:44 am

A quick look suggests you need to get a reference to the existing SimbodyMatterSubsystem rather than a copy:

Code: Select all

const SimbodyMatterSubsystem& smss = model->getMatterSubsystem();
Regards,
Sherm

User avatar
emanuele feola
Posts: 2
Joined: Tue Mar 22, 2022 12:43 am

Re: computing jacobian: matlab and c++ api difference #3735

Post by emanuele feola » Wed Mar 13, 2024 9:04 am

It works! Thank you a lot for the fast support.
Have a nice day!

POST REPLY