@Override public void set(HandTrajectoryCommand other) { se3Trajectory.set(other.se3Trajectory); wrenchTrajectory.set(other.wrenchTrajectory); robotSide = other.robotSide; }
@Override public void set(ReferenceFrameHashCodeResolver resolver, HandTrajectoryMessage message) { se3Trajectory.set(resolver, message.getSe3Trajectory()); wrenchTrajectory.set(resolver, message.getWrenchTrajectory()); robotSide = RobotSide.fromByte(message.getRobotSide()); }