Skip to content

Commit 9fd4858

Browse files
committed
added manipulator constants
1 parent b2f2c96 commit 9fd4858

1 file changed

Lines changed: 33 additions & 11 deletions

File tree

Lines changed: 33 additions & 11 deletions
Original file line numberDiff line numberDiff line change
@@ -1,10 +1,17 @@
11
package frc.robot.subsystems.manipulator;
2+
import static edu.wpi.first.units.Units.Amps;
23
import static edu.wpi.first.units.Units.Degrees;
4+
import static edu.wpi.first.units.Units.Meters;
5+
import static edu.wpi.first.units.Units.MetersPerSecond;
36
import static edu.wpi.first.units.Units.RadiansPerSecond;
7+
import static edu.wpi.first.units.Units.Volts;
8+
49
import org.littletonrobotics.junction.AutoLog;
510
import edu.wpi.first.units.measure.Angle;
611
import edu.wpi.first.units.measure.AngularVelocity;
712
import edu.wpi.first.units.measure.Current;
13+
import edu.wpi.first.units.measure.Distance;
14+
import edu.wpi.first.units.measure.LinearVelocity;
815
import edu.wpi.first.units.measure.Voltage;
916

1017

@@ -13,15 +20,30 @@ public interface ManipulatorIO {
1320
@AutoLog
1421
public static class ManipulatorIOInputs {
1522
//inputs of postion,current,voltage and velocity (acceleration)
16-
public class ArmStatus {
17-
public boolean armReady = false;
18-
public Angle armPosition = Degrees.of(0);
19-
public Current armCurrent = null;
20-
public Voltage armVoltage = null;
21-
public AngularVelocity armVelocity = RadiansPerSecond.of(0);
22-
public Angle armRawMotorPosition = Degrees.of(0);
23-
public AngularVelocity armRawMotorVelocity = DegreesperSecond
24-
25-
23+
public static final AngularVelocity DegreesperSecond = null;
24+
25+
public class ArmStatus {
26+
27+
public boolean armReady = false;
28+
public Angle armPosition = Degrees.of(0);
29+
public Current armCurrent = null;
30+
public Voltage armVoltage = null;
31+
public AngularVelocity armVelocity = RadiansPerSecond.of(0);
32+
public Angle armRawMotorPosition = Degrees.of(0);
33+
public AngularVelocity armRawMotorVelocity = DegreesperSecond;
34+
public int syncCount = Integer.MAX_VALUE;
35+
36+
//constants for elevator part of the manipulator
37+
public Distance elevatorPostion = Meters.of(0);
38+
public LinearVelocity elevatorVelocity = MetersPerSecond.of(0);
39+
public Angle elevatorRawMotorPostion = Degrees.of(syncCount);
40+
}
41+
}
42+
//elevator contants (inputs of voltage and postion)
43+
public boolean elevator1isReady = false;
44+
public Voltage elevator1vVoltage = Volts.of(0);
45+
public Current elevator1Current = Amps.of(0);
46+
2647
}
27-
}
48+
49+

0 commit comments

Comments
 (0)