public DenseMatrixArrayList(int initialCapacity) { super(initialCapacity, createBuilder()); }
public DenseMatrix64F getDesiredVelocity(int jointIndex) { return desiredVelocities.get(jointIndex); }
public void addJoint(OneDoFJoint joint, double desiredVelocity) { joints.add(joint); jointNames.add(joint.getName()); DenseMatrix64F jointDesiredAcceleration = desiredVelocities.add(); jointDesiredAcceleration.reshape(1, 1); jointDesiredAcceleration.set(0, 0, desiredVelocity); }
public void clear() { joints.clear(); jointNames.clear(); desiredAccelerations.clear(); removeWeight(); }
@Override public void set(JointspaceVelocityCommand other) { clear(); for (int i = 0; i < other.getNumberOfJoints(); i++) { joints.add(other.joints.get(i)); jointNames.add(other.jointNames.get(i)); } desiredVelocities.set(other.desiredVelocities); weight = other.weight; }
public DenseMatrix64F getDesiredAcceleration(int jointIndex) { return desiredAccelerations.get(jointIndex); }
public void addJoint(OneDoFJoint joint, double desiredAcceleration) { joints.add(joint); jointNames.add(joint.getName()); DenseMatrix64F jointDesiredAcceleration = desiredAccelerations.add(); jointDesiredAcceleration.reshape(1, 1); jointDesiredAcceleration.set(0, 0, desiredAcceleration); }
public void clear() { joints.clear(); jointNames.clear(); desiredVelocities.clear(); removeWeight(); }
@Override public void set(JointspaceAccelerationCommand other) { clear(); for (int i = 0; i < other.getNumberOfJoints(); i++) { joints.add(other.joints.get(i)); jointNames.add(other.jointNames.get(i)); } desiredAccelerations.set(other.desiredAccelerations); hasWeight = other.hasWeight; weight = other.weight; }
public void addJoint(InverseDynamicsJoint joint, DenseMatrix64F desiredAcceleration) { checkConsistency(joint, desiredAcceleration); joints.add(joint); jointNames.add(joint.getName()); desiredAccelerations.add().set(desiredAcceleration); }
public DenseMatrixArrayList(int initialCapacity) { super(initialCapacity, createBuilder()); }
public void setDesiredAcceleration(int jointIndex, DenseMatrix64F desiredAcceleration) { checkConsistency(joints.get(jointIndex), desiredAcceleration); desiredAccelerations.get(jointIndex).set(desiredAcceleration); }
public void addJoint(InverseDynamicsJoint joint, DenseMatrix64F desiredVelocity) { checkConsistency(joint, desiredVelocity); joints.add(joint); jointNames.add(joint.getName()); desiredVelocities.add().set(desiredVelocity); }
public DenseMatrixArrayList() { super(createBuilder()); }
public void setDesiredAcceleration(int jointIndex, DenseMatrix64F desiredVelocity) { checkConsistency(joints.get(jointIndex), desiredVelocity); desiredVelocities.get(jointIndex).set(desiredVelocity); }