void realizeInstance(const SBStateDigest& sbs) const {
// Initialize cache entries that will never be changed at later stages.
SBTreeVelocityCache& vc = sbs.updTreeVelocityCache();
SBDynamicsCache& dc = sbs.updDynamicsCache();
SBTreeAccelerationCache& ac = sbs.updTreeAccelerationCache();
updY(dc) = SpatialMat(Mat33(0));
updA_GB(ac) = 0;
}
void realizeDynamics(const SBArticulatedBodyInertiaCache& abc,
const SBStateDigest& sbs) const {
// Mobilizer-specific.
const SBTreePositionCache& pc = sbs.getTreePositionCache();
const SBTreeVelocityCache& vc = sbs.getTreeVelocityCache();
SBDynamicsCache& dc = sbs.updDynamicsCache();
// Mobilizer independent.
calcJointIndependentDynamicsVel(pc,abc,vc,dc);
}
