@Override public void set(JointspaceTrajectoryCommand other) { setQueueableCommandVariables(other); set(other.getTrajectoryPointLists()); }
@Override public boolean epsilonEquals(JointspaceTrajectoryCommand other, double epsilon) { if (this.jointTrajectoryInputs.size() != other.getTrajectoryPointLists().size()) { return false; } for (int i = 0; i < this.jointTrajectoryInputs.size(); i++) { if (!this.jointTrajectoryInputs.get(i).epsilonEquals(other.getTrajectoryPointLists().get(i), epsilon)) { return false; } } return super.epsilonEquals(other, epsilon); }
@ContinuousIntegrationTest(estimatedDuration = 0.0) @Test(timeout = 30000, expected = IndexOutOfBoundsException.class) public void testClear() { ArmTrajectoryCommand armTrajectoryCommand = new ArmTrajectoryCommand(); armTrajectoryCommand.clear(); assertNull(armTrajectoryCommand.getRobotSide()); assertEquals(Packet.VALID_MESSAGE_DEFAULT_ID, armTrajectoryCommand.getJointspaceTrajectory().getCommandId()); assertEquals(0.0, armTrajectoryCommand.getExecutionDelayTime(), 1e-9); assertEquals(ExecutionMode.OVERRIDE, armTrajectoryCommand.getJointspaceTrajectory().getExecutionMode()); assertEquals(0.0, armTrajectoryCommand.getExecutionTime(), 1e-9); assertEquals(0, armTrajectoryCommand.getJointspaceTrajectory().getNumberOfJoints()); assertEquals(Packet.INVALID_MESSAGE_ID, armTrajectoryCommand.getJointspaceTrajectory().getPreviousCommandId()); assertEquals(0, armTrajectoryCommand.getJointspaceTrajectory().getTrajectoryPointLists().size()); armTrajectoryCommand.getJointspaceTrajectory().getJointTrajectoryPoint(0, 0); }
@ContinuousIntegrationTest(estimatedDuration = 0.0) @Test(timeout = 30000) public void testClearRobotSide() { ArmTrajectoryCommand armTrajectoryCommand = new ArmTrajectoryCommand(); assertNull(armTrajectoryCommand.getRobotSide()); armTrajectoryCommand.clear(RobotSide.LEFT); assertEquals(RobotSide.LEFT, armTrajectoryCommand.getRobotSide()); assertEquals(Packet.VALID_MESSAGE_DEFAULT_ID, armTrajectoryCommand.getJointspaceTrajectory().getCommandId()); assertEquals(0.0, armTrajectoryCommand.getExecutionDelayTime(), 1e-9); assertEquals(ExecutionMode.OVERRIDE, armTrajectoryCommand.getJointspaceTrajectory().getExecutionMode()); assertEquals(0.0, armTrajectoryCommand.getExecutionTime(), 1e-9); assertEquals(0, armTrajectoryCommand.getJointspaceTrajectory().getNumberOfJoints()); assertEquals(Packet.INVALID_MESSAGE_ID, armTrajectoryCommand.getJointspaceTrajectory().getPreviousCommandId()); assertEquals(0, armTrajectoryCommand.getJointspaceTrajectory().getTrajectoryPointLists().size()); }