Generalized velocity of the floating base about pinocchio HOT 7 CLOSED

Could you provide a short Python example to understand what you did exactly?

from pinocchio.

Could you provide a short Python example to understand what you did exactly?

Yes.Here's a pseudocode snippet in C++ to illustrate the issue. First, I construct a floating base model as follows:

pinocchio::JointModelComposite rootJoint(2); rootJoint.addJoint(pinocchio::JointModelTranslation()); rootJoint.addJoint(pinocchio::JointModelSphericalZYX()); pinocchio::urdf::buildModel(my_model_urdf_path, rootJoint, my_model);

then I get the Jacobian Jac

pinocchio::getFrameJacobian(my_model, data, ee_link_number, pinocchio::LOCAL_WORLD_ALIGNED, Jac); Eigen::Matrix3d Jac_v = Jac.topLeftCorner<3, 3>();

I find Jac_v was always an identity matrix. It's corresponding to linear velocity part of the floating base. If the velocity is represented in the LOCAL frame, Jac_v should vary with the floating base pose but it' didn't. So I think the floating base velocity is instead represented in the WORLD frame.

from pinocchio.

Could you give us the value of the configuration vector associated with the FF?

from pinocchio.

Could you give us the value of the configuration vector associated with the FF?

Actually I have tried many configurations randomly, results are the same. And other parts of the jacobian are correct. I just want to know whether the generalized velocity of the floating base is represented in WORLD frame when the root joints are JointModelTranslation() and JointModelSphericalZYX(). Could you clarify this for me?

from pinocchio.

hi @thuuzi, after several discussions we have recently merged a python script in #2143 that could help you. You can easily extend it to have a combination of JointModelTranslation and JointModelSphericalZYX as root joint and visualize it.

from pinocchio.

really appreciate it

from pinocchio.

After test, the floating base velocity is represented in the WORLD frame with JointModelTranslation and JointModelSphericalZYX as root joint

from pinocchio.