11package frc .robot .subsystems .manipulator ;
2+ import static edu .wpi .first .units .Units .Amps ;
23import 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 ;
36import static edu .wpi .first .units .Units .RadiansPerSecond ;
7+ import static edu .wpi .first .units .Units .Volts ;
8+
49import org .littletonrobotics .junction .AutoLog ;
510import edu .wpi .first .units .measure .Angle ;
611import edu .wpi .first .units .measure .AngularVelocity ;
712import edu .wpi .first .units .measure .Current ;
13+ import edu .wpi .first .units .measure .Distance ;
14+ import edu .wpi .first .units .measure .LinearVelocity ;
815import 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