mirror of
https://github.com/Team4388/2023WayOfTheRobot.git
synced 2026-06-09 08:38:02 -06:00
started arm subsystem
This commit is contained in:
@@ -31,10 +31,10 @@ public class RobotMap {
|
|||||||
public SwerveModule leftBack;
|
public SwerveModule leftBack;
|
||||||
public SwerveModule rightBack;
|
public SwerveModule rightBack;
|
||||||
|
|
||||||
|
|
||||||
public RobotMap() {
|
public RobotMap() {
|
||||||
configureLEDMotorControllers();
|
configureLEDMotorControllers();
|
||||||
configureDriveMotors();
|
configureDriveMotors();
|
||||||
|
configArmMotors();
|
||||||
}
|
}
|
||||||
|
|
||||||
/* LED Subsystem */
|
/* LED Subsystem */
|
||||||
@@ -128,4 +128,22 @@ public class RobotMap {
|
|||||||
this.rightBack = new SwerveModule(rightBackWheel, rightBackSteer, rightBackEncoder, SwerveDriveConstants.Configurations.RIGHT_BACK_ENCODER_OFFSET);
|
this.rightBack = new SwerveModule(rightBackWheel, rightBackSteer, rightBackEncoder, SwerveDriveConstants.Configurations.RIGHT_BACK_ENCODER_OFFSET);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// arm stuff
|
||||||
|
public WPI_TalonFX pivot = new WPI_TalonFX(-1); // TODO: Add real id
|
||||||
|
public WPI_TalonFX tele = new WPI_TalonFX(-1); // TODO: Add real id
|
||||||
|
|
||||||
|
public void configArmMotors() {
|
||||||
|
// config factory default
|
||||||
|
pivot.configFactoryDefault();
|
||||||
|
tele.configFactoryDefault();
|
||||||
|
|
||||||
|
// config open loop ramp
|
||||||
|
pivot.configOpenloopRamp(SwerveDriveConstants.Configurations.OPEN_LOOP_RAMP_RATE, SwerveDriveConstants.TIMEOUT_MS);
|
||||||
|
tele.configOpenloopRamp(SwerveDriveConstants.Configurations.OPEN_LOOP_RAMP_RATE, SwerveDriveConstants.TIMEOUT_MS);
|
||||||
|
|
||||||
|
// config closed loop ramp
|
||||||
|
pivot.configClosedloopRamp(SwerveDriveConstants.Configurations.CLOSED_LOOP_RAMP_RATE, SwerveDriveConstants.TIMEOUT_MS);
|
||||||
|
tele.configClosedloopRamp(SwerveDriveConstants.Configurations.CLOSED_LOOP_RAMP_RATE, SwerveDriveConstants.TIMEOUT_MS);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -0,0 +1,33 @@
|
|||||||
|
// 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 frc4388.robot.subsystems;
|
||||||
|
|
||||||
|
import com.ctre.phoenix.motorcontrol.can.WPI_TalonFX;
|
||||||
|
|
||||||
|
import edu.wpi.first.wpilibj2.command.SubsystemBase;
|
||||||
|
|
||||||
|
public class Arm extends SubsystemBase {
|
||||||
|
/** Creates a new Arm. */
|
||||||
|
private WPI_TalonFX pivot;
|
||||||
|
private WPI_TalonFX tele;
|
||||||
|
|
||||||
|
public Arm(WPI_TalonFX pivot, WPI_TalonFX tele) {
|
||||||
|
this.pivot = pivot;
|
||||||
|
this.tele = tele;
|
||||||
|
}
|
||||||
|
|
||||||
|
public void runPivot(double output) {
|
||||||
|
pivot.set(output);
|
||||||
|
}
|
||||||
|
|
||||||
|
public void runTelescope(double output) {
|
||||||
|
tele.set(output);
|
||||||
|
}
|
||||||
|
|
||||||
|
@Override
|
||||||
|
public void periodic() {
|
||||||
|
// This method will be called once per scheduler run
|
||||||
|
}
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user