ready for comp (im geekin)

This commit is contained in:
Abhishrek05
2024-02-29 06:45:18 -07:00
parent de653a1edb
commit c5f5e6c57f
3 changed files with 94 additions and 61 deletions
@@ -129,12 +129,12 @@ public class Intake extends SubsystemBase {
// ! Talon Methods
public void talonPIDIn() {
PositionVoltage request = new PositionVoltage(-59);
talonPivot.setControl(request.withPosition(0)); //TODO: Find actual value
talonPivot.setControl(request.withPosition(0));
}
public void talonPIDOut() {
PositionVoltage request = new PositionVoltage(0);
talonPivot.setControl(request.withPosition(-59)); //TODO: Find actual value
talonPivot.setControl(request.withPosition(-59));
}
public void talonHandoff() {
@@ -87,12 +87,14 @@ public class SwerveDrive extends SubsystemBase {
setModuleStates(kinematics.toSwerveModuleStates(chassisSpeeds));
}
public void driveWithInputOrientation(Translation2d leftStick, Translation2d rightStick, boolean fieldRelative) {
public void driveWithInputOrientation(Translation2d leftStick, double rightX, double rightY, boolean fieldRelative) {
Translation2d rightStick = new Translation2d(rightX, rightY);
if(fieldRelative) {
double rot = 0;
if(rightStick.getNorm() > 0.5) {
orientRotTarget = rightStick.getAngle().minus(new Rotation2d(0, 1));
orientRotTarget = new Rotation2d(rightX, -rightY).minus(new Rotation2d(0,1));
rot = orientRotTarget.minus(gyro.getRotation2d()).getRadians();
}