@Override public String toString() { String qAsString = String.format(EuclidCoreIOTools.DEFAULT_FORMAT, getQ()); String qdAsString = String.format(EuclidCoreIOTools.DEFAULT_FORMAT, getQd()); String qddAsString = String.format(EuclidCoreIOTools.DEFAULT_FORMAT, getQdd()); String tauAsString = String.format(EuclidCoreIOTools.DEFAULT_FORMAT, getTau()); return super.toString() + ", q: " + qAsString + ", qd: " + qdAsString + ", qdd: " + qddAsString + ", tau: " + tauAsString; } }
double q = joints.get(jointIndex).getQ() + dt * joints.get(jointIndex).getQd(); jointsInFuture.get(jointIndex).setQ(q);
double q = joints.get(jointIndex).getQ() + dt * joints.get(jointIndex).getQd(); jointsInFuture.get(jointIndex).setQ(q);