@Override public int getNumberOfTrajectoryPoints() { return trajectoryPoints.size(); }
public int getNumberOfJoints() { return jointTrajectoryInputs.size(); }
public int getNumberOfTrajectoryPoints() { return trajectoryPoints.size(); }
@Override public int getNumberOfTrajectoryPoints() { return trajectoryPoints.size(); }
@Override public void addTimeOffset(double timeOffsetToAdd) { for (int i = 0; i < trajectoryPoints.size(); i++) trajectoryPoints.get(i).addTimeOffset(timeOffsetToAdd); }
public void retrieveJointsFromName(Map<String, OneDoFJoint> nameToJointMap) { for (int i = 0; i < jointspaceFeedbackControlCommands.size(); i++) { JointspaceFeedbackControlCommand command = jointspaceFeedbackControlCommands.get(i); command.retrieveJointsFromName(nameToJointMap); } }
public void retrieveJointsFromName(Map<String, OneDoFJoint> nameToJointMap) { for (int i = 0; i < jointspaceAccelerationCommands.size(); i++) { JointspaceAccelerationCommand command = jointspaceAccelerationCommands.get(i); command.retrieveJointsFromName(nameToJointMap); } }
public void appendWaypoints(RecyclingArrayList<? extends EuclideanTrajectoryPointInterface<?>> euclideanWaypoint) { checkNumberOfWaypoints(numberOfWaypoints.getIntegerValue() + euclideanWaypoint.size()); for (int i = 0; i < euclideanWaypoint.size(); i++) appendWaypointUnsafe(euclideanWaypoint.get(i)); }
@Override public void subtractTimeOffset(double timeOffsetToSubtract) { for (int i = 0; i < trajectoryPoints.size(); i++) trajectoryPoints.get(i).subtractTimeOffset(timeOffsetToSubtract); }
public void retrieveJointsFromName(Map<String, OneDoFJoint> nameToJointMap) { for (int i = 0; i < jointspaceVelocityCommands.size(); i++) { JointspaceVelocityCommand command = jointspaceVelocityCommands.get(i); command.retrieveJointsFromName(nameToJointMap); } }
public void changeFrame(ReferenceFrame referenceFrame) { if (this.referenceFrame == referenceFrame) return; for (int i = 0; i < trajectoryPoints.size(); i++) trajectoryPoints.get(i).changeFrame(referenceFrame); this.referenceFrame = referenceFrame; }
@Override public void subtractTimeOffset(double timeOffsetToSubtract) { for (int i = 0; i < trajectoryPoints.size(); i++) trajectoryPoints.get(i).subtractTimeOffset(timeOffsetToSubtract); }
@Override public void addTimeOffset(double timeOffsetToAdd) { for (int i = 0; i < trajectoryPoints.size(); i++) trajectoryPoints.get(i).addTimeOffset(timeOffsetToAdd); }
public void retrieveRigidBodiesFromName(Map<String, RigidBody> nameToRigidBodyMap) { for (int i = 0; i < spatialVelocityCommands.size(); i++) { SpatialVelocityCommand command = spatialVelocityCommands.get(i); command.setBase(nameToRigidBodyMap.get(command.getBaseName())); command.setEndEffector(nameToRigidBodyMap.get(command.getEndEffectorName())); } }
public void set(RecyclingArrayList<? extends SimpleTrajectoryPoint1DList> trajectoryPointListArray) { clear(); for (int i = 0; i < trajectoryPointListArray.size(); i++) { set(i, trajectoryPointListArray.get(i)); } }
public void setSwingWaypoints(RecyclingArrayList<Point3d> trajectoryWaypoints) { swingWaypoints.clear(); for (int i = 0; i < trajectoryWaypoints.size(); i++) swingWaypoints.add().set(trajectoryWaypoints.get(i)); }
public void appendWaypoints(RecyclingArrayList<? extends OneDoFTrajectoryPointInterface<?>> waypoints1D) { checkNumberOfWaypoints(numberOfWaypoints.getIntegerValue() + waypoints1D.size()); for (int i = 0; i < waypoints1D.size(); i++) appendWaypointUnsafe(waypoints1D.get(i).getTime(), waypoints1D.get(i).getPosition(), waypoints1D.get(i).getVelocity()); }
public void appendWaypoints(RecyclingArrayList<? extends OneDoFTrajectoryPointInterface<?>> waypoints1D) { checkNumberOfWaypoints(numberOfWaypoints.getIntegerValue() + waypoints1D.size()); for (int i = 0; i < waypoints1D.size(); i++) appendWaypointUnsafe(waypoints1D.get(i).getTime(), waypoints1D.get(i).getPosition(), waypoints1D.get(i).getVelocity()); }
@Override public void set(LidarScanCommand other) { timestamp = other.timestamp; lidarPose.setIncludingFrame(other.lidarPose); scan.clear(); for (int i = 0; i < other.scan.size(); i++) scan.add().set(other.scan.get(i)); }
@Override public void set(AdjustFootstepCommand other) { robotSide = other.robotSide; origin = other.origin; adjustedPosition.set(other.adjustedPosition); adjustedOrientation.set(other.adjustedOrientation); RecyclingArrayList<Point2d> otherPredictedContactPoints = other.predictedContactPoints; predictedContactPoints.clear(); for (int i = 0; i < otherPredictedContactPoints.size(); i++) predictedContactPoints.add().set(otherPredictedContactPoints.get(i)); }