Switch mjData.{qH,qLD} from full ("M") to reduced ("C") inertia matrix structure.
PiperOrigin-RevId: 758273074 Change-Id: If1a2e663ea70044694af985e0119afd6d58115ac
This commit is contained in:
committed by
Copybara-Service
parent
436b5a8e1f
commit
627fffdef9
@@ -1126,12 +1126,12 @@ void mj_printFormattedData(const mjModel* m, const mjData* d, const char* filena
|
||||
|
||||
printInertia("QM", d->qM, m, fp, float_format);
|
||||
|
||||
printSparse("QLD", d->qLD, m->nv, d->M_rownnz,
|
||||
d->M_rowadr, d->M_colind, fp, float_format);
|
||||
printSparse("QLD", d->qLD, m->nv, d->C_rownnz,
|
||||
d->C_rowadr, d->C_colind, fp, float_format);
|
||||
printArray("QLDIAGINV", m->nv, 1, d->qLDiagInv, fp, float_format);
|
||||
|
||||
if (!mju_isZero(d->qHDiagInv, m->nv)) {
|
||||
printSparse("QH", d->qH, m->nv, d->M_rownnz, d->M_rowadr, d->M_colind, fp, float_format);
|
||||
printSparse("QH", d->qH, m->nv, d->C_rownnz, d->C_rowadr, d->C_colind, fp, float_format);
|
||||
printArray("QHDIAGINV", m->nv, 1, d->qHDiagInv, fp, float_format);
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user