private void setDesiredAccelerationsToZero() { for (InverseDynamicsJoint joint : jointsInOrder) { joint.setDesiredAccelerationToZero(); joint.setVelocity(new DenseMatrix64F(joint.getDegreesOfFreedom(), 1), 0); } }
private void setDesiredAccelerationsToZero() { for (InverseDynamicsJoint joint : jointsInOrder) { joint.setDesiredAccelerationToZero(); joint.setVelocity(new DenseMatrix64F(joint.getDegreesOfFreedom(), 1), 0); } }