public double getDesiredElbowAngle(RobotSide robotSide) { return getArmJointAngles(robotSide)[3]; }
public double getDesiredElbowAngle(RobotSide robotSide) { return getArmJointAngles(robotSide)[3]; }
public SideDependentList<double[]> getArmJointAngles() { double[] leftArmJointAngles = armPose.getArmJointAngles(RobotSide.LEFT); double[] rightArmJointAngles = armPose.getArmJointAngles(RobotSide.RIGHT); return new SideDependentList<double[]>(leftArmJointAngles, rightArmJointAngles); }
public SideDependentList<double[]> getArmJointAngles() { double[] leftArmJointAngles = armPose.getArmJointAngles(RobotSide.LEFT); double[] rightArmJointAngles = armPose.getArmJointAngles(RobotSide.RIGHT); return new SideDependentList<double[]>(leftArmJointAngles, rightArmJointAngles); }