diff --git a/src/main/java/org/carlmontrobotics/subsystems/Arm.java b/src/main/java/org/carlmontrobotics/subsystems/Arm.java index 7f543323..972e4ee5 100644 --- a/src/main/java/org/carlmontrobotics/subsystems/Arm.java +++ b/src/main/java/org/carlmontrobotics/subsystems/Arm.java @@ -91,7 +91,7 @@ public Arm() { // Comment out when running sysid armMasterEncoder.setPositionConversionFactor(ROTATION_TO_RAD); armMasterEncoder.setVelocityConversionFactor(ROTATION_TO_RAD); - armMasterEncoder.setZeroOffset​(ENCODER_OFFSET_RAD); + armMasterEncoder.setZeroOffset(ENCODER_OFFSET_RAD); // ------------------------------------------------------------ armMasterEncoder.setInverted(ENCODER_INVERTED); @@ -174,7 +174,7 @@ private void driveArm() { double armFeedVolts = armFeed.calculate(getArmPos(), setpoint.velocity); if ((getArmPos() < LOWER_ANGLE_LIMIT_RAD) || (getArmPos() > UPPER_ANGLE_LIMIT_RAD)) { - armFeedVolts = kG * (COM_ARM_LENGTH_METERS) * Math.cos(getArmPos()) + armFeed.calculate(getCurrentArmGoal().position, 0); + armFeedVolts = kG * (COM_ARM_LENGTH_METERS) * Math.cos(getArmPos()) + armFeed.calculate(getCurrentArmGoal().position, 0); //kg * cos(arm angle) * arm_COM_length } armPIDMaster.setReference(setpoint.position, CANSparkBase.ControlType.kPosition, 0, armFeedVolts);