@Override public void set(ArmTrajectoryCommand other) { set(other.robotSide, other.getTrajectoryPointLists()); commandId = other.commandId; executionMode = other.executionMode; previousCommandId = other.previousCommandId; }
public void set(RobotSide robotSide, RecyclingArrayList<? extends SimpleTrajectoryPoint1DList> trajectoryPointListArray) { clear(robotSide); for (int i = 0; i < trajectoryPointListArray.size(); i++) set(i, trajectoryPointListArray.get(i)); }
@Override public void set(ArmTrajectoryMessage message) { set(message.getRobotSide(), message.getTrajectoryPointLists()); commandId = message.getUniqueId(); executionMode = message.getExecutionMode(); previousCommandId = message.getPreviousMessageId(); }
@Override public void set(WholeBodyTrajectoryCommand other) { for (RobotSide robotSide : RobotSide.values) { handTrajectoryControllerCommands.get(robotSide).set(other.handTrajectoryControllerCommands.get(robotSide)); armTrajectoryControllerCommands.get(robotSide).set(other.armTrajectoryControllerCommands.get(robotSide)); footTrajectoryControllerCommands.get(robotSide).set(other.footTrajectoryControllerCommands.get(robotSide)); } chestTrajectoryControllerCommand.set(other.chestTrajectoryControllerCommand); pelvisTrajectoryControllerCommand.set(other.pelvisTrajectoryControllerCommand); }
@Override public void set(WholeBodyTrajectoryMessage message) { clear(); for (RobotSide robotside : RobotSide.values) { HandTrajectoryMessage handTrajectoryMessage = message.getHandTrajectoryMessage(robotside); if (handTrajectoryMessage.getUniqueId() != Packet.INVALID_MESSAGE_ID) handTrajectoryControllerCommands.get(robotside).set(handTrajectoryMessage); ArmTrajectoryMessage armTrajectoryMessage = message.getArmTrajectoryMessage(robotside); if (armTrajectoryMessage.getUniqueId() != Packet.INVALID_MESSAGE_ID) armTrajectoryControllerCommands.get(robotside).set(armTrajectoryMessage); FootTrajectoryMessage footTrajectoryMessage = message.getFootTrajectoryMessage(robotside); if (footTrajectoryMessage.getUniqueId() != Packet.INVALID_MESSAGE_ID) footTrajectoryControllerCommands.get(robotside).set(footTrajectoryMessage); } ChestTrajectoryMessage chestTrajectoryMessage = message.getChestTrajectoryMessage(); if (chestTrajectoryMessage.getUniqueId() != Packet.INVALID_MESSAGE_ID) chestTrajectoryControllerCommand.set(chestTrajectoryMessage); PelvisTrajectoryMessage pelvisTrajectoryMessage = message.getPelvisTrajectoryMessage(); if (pelvisTrajectoryMessage.getUniqueId() != Packet.INVALID_MESSAGE_ID) pelvisTrajectoryControllerCommand.set(pelvisTrajectoryMessage); }
armTrajectoryCommand.set(otherArmTrajectoryCommand); armTrajectoryCommand.epsilonEquals(otherArmTrajectoryCommand, 1e-8);