diff --git a/src/main/java/frc/robot/maps/subsystems/ArmRotateMap.java b/src/main/java/frc/robot/maps/subsystems/ArmRotateMap.java new file mode 100644 index 0000000..8a47cc9 --- /dev/null +++ b/src/main/java/frc/robot/maps/subsystems/ArmRotateMap.java @@ -0,0 +1,29 @@ +package frc.robot.maps.subsystems; + +import com.chopshop166.chopshoplib.logging.DataWrapper; +import com.chopshop166.chopshoplib.logging.LoggableMap; +import com.chopshop166.chopshoplib.logging.data.MotorControllerData; +import com.chopshop166.chopshoplib.motors.SmartMotorController; +import com.chopshop166.chopshoplib.sensors.IEncoder; + +public class ArmRotateMap implements LoggableMap { + + public SmartMotorController motor; + public final IEncoder encoder; + + public ArmRotateMap(SmartMotorController motor, IEncoder encoder) { + this.motor = motor; + this.encoder = encoder; + } + + @Override + public void updateData(Data data) { + data.motor.updateData(motor); + data.rotationAbsAngleDegrees = encoder.getAbsolutePosition(); + } + + public static class Data extends DataWrapper { + public MotorControllerData motor = new MotorControllerData(); + public double rotationAbsAngleDegrees; + } +} diff --git a/src/main/java/frc/robot/subsystems/ArmRotate.java b/src/main/java/frc/robot/subsystems/ArmRotate.java new file mode 100644 index 0000000..28f0c2a --- /dev/null +++ b/src/main/java/frc/robot/subsystems/ArmRotate.java @@ -0,0 +1,18 @@ +package frc.robot.subsystems; + +import com.chopshop166.chopshoplib.logging.LoggedSubsystem; + +import frc.robot.maps.subsystems.ArmRotateMap; +import frc.robot.maps.subsystems.ArmRotateMap.Data; + +public class ArmRotate extends LoggedSubsystem { + + public ArmRotate(ArmRotateMap armRotateMap) { + super(new Data(), armRotateMap); + } + + @Override + public void safeState() { + + } +}