-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathArmExtend.java
43 lines (32 loc) · 1.1 KB
/
ArmExtend.java
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.subsystems;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
import frc.robot.Constants;
import com.revrobotics.CANSparkMax;
import com.revrobotics.CANSparkMax.IdleMode;
import com.revrobotics.CANSparkMaxLowLevel.MotorType;
public class ArmExtend extends SubsystemBase {
/** Creates a new WholeArm. */
private CANSparkMax extend;
public ArmExtend() {
extend = new CANSparkMax(Constants.EXTEND_ID, MotorType.kBrushless);
// set all NEOs to factory defaults
extend.setIdleMode(IdleMode.kBrake);
extend.restoreFactoryDefaults();
}
public void extend (double speed) {
extend.set(speed);
}
public double get_extend_encoder(){
return extend.getEncoder().getPosition();
}
public void home_extend_encoder(){
extend.getEncoder().setPosition(0.0);
}
@Override
public void periodic() {
// This method will be called once per scheduler run
}
}