Move flexedge sparse Jacobian indices to mjModel.
PiperOrigin-RevId: 855718305 Change-Id: Ic136f4efa6735b934288f65c332d71ee8b0f6da5
This commit is contained in:
committed by
Copybara-Service
parent
09a6fb7d4d
commit
a49576e469
@@ -414,9 +414,9 @@ static void mj_springdamper(const mjModel* m, mjData* d) {
|
||||
|
||||
// transform to joint torque, add to qfrc_{spring, damper}: dense or sparse
|
||||
if (issparse) {
|
||||
int end = d->flexedge_J_rowadr[e] + d->flexedge_J_rownnz[e];
|
||||
for (int j=d->flexedge_J_rowadr[e]; j < end; j++) {
|
||||
int colind = d->flexedge_J_colind[j];
|
||||
int end = m->flexedge_J_rowadr[e] + m->flexedge_J_rownnz[e];
|
||||
for (int j=m->flexedge_J_rowadr[e]; j < end; j++) {
|
||||
int colind = m->flexedge_J_colind[j];
|
||||
mjtNum J = d->flexedge_J[j];
|
||||
d->qfrc_spring[colind] += J * frc_spring;
|
||||
d->qfrc_damper[colind] += J * frc_damper;
|
||||
|
||||
Reference in New Issue
Block a user