Skip to content

Commit

Permalink
fixed merge conflicts?
Browse files Browse the repository at this point in the history
  • Loading branch information
Juliaaaahhhh committed Mar 6, 2024
1 parent 81ae651 commit f4e16c1
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions src/main/java/org/carlmontrobotics/subsystems/Arm.java
Original file line number Diff line number Diff line change
Expand Up @@ -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);

Expand Down Expand Up @@ -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);
Expand Down

0 comments on commit f4e16c1

Please sign in to comment.