private void setDesiredAccelerationsToZero() { for (JointBasics joint : jointsInOrder) { joint.setJointAccelerationToZero(); joint.setJointVelocity(0, new DenseMatrix64F(joint.getDegreesOfFreedom(), 1)); } }
private void setDesiredAccelerationsToZero() { for (JointBasics joint : jointsInOrder) { joint.setJointAccelerationToZero(); joint.setJointVelocity(0, new DenseMatrix64F(joint.getDegreesOfFreedom(), 1)); } }