Team4388/RiseOfRidgebotics2020
1
0
Fork 0
mirror of https://github.com/Team4388/RiseOfRidgebotics2020.git synced 2026-06-09 08:48:01 -06:00
Code Issues Packages Projects Releases Wiki Activity

Modify Turning PID

Browse Source 
- Uses a modified Velocity PID to keep robot still while rotating
- Could also use a Position PID to keep robot still but should be looked into further
This commit is contained in:
Keenan D. Buckley
2020-01-30 21:46:56 -07:00
parent ae5fc4cb00
commit 5cb458082a
2 changed files with 7 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/Constants.java
+1
View File
@@ -53,6 +53,7 @@ public final class Constants {
public static final double TICKS_PER_MOTOR_REV = 2048; public static final double TICKS_PER_MOTOR_REV = 2048;
public static final double MOTOR_TO_WHEEL_GEAR_RATIO = 12.5; public static final double MOTOR_TO_WHEEL_GEAR_RATIO = 12.5;
public static final double WHEEL_DIAMETER_INCHES = 6; public static final double WHEEL_DIAMETER_INCHES = 6;
public static final double TICKS_PER_GYRO_REV = 8192;
/* Ratio Calculation */ /* Ratio Calculation */
public static final double TICK_TIME_TO_SECONDS = 0.1; public static final double TICK_TIME_TO_SECONDS = 0.1;
src/main/java/frc4388/robot/subsystems/Drive.java
+6 -5
View File
@@ -329,12 +329,13 @@ public class Drive extends SubsystemBase {
talon.set(TalonFXControlMode.MotionMagic, targetPos); talon.set(TalonFXControlMode.MotionMagic, targetPos);
} }
/**
* Runs a Turning PID to rotate a to a target angle
* @param targetAngle target angle in degrees
*/
public void runTurningPID(double targetAngle){ public void runTurningPID(double targetAngle){
//m_rightFrontMotor.selectProfileSlot(DriveConstants.SLOT_VELOCITY, DriveConstants.PID_PRIMARY); double targetGyro = (targetAngle/360)*DriveConstants.TICKS_PER_GYRO_REV;
m_rightFrontMotor.selectProfileSlot(DriveConstants.SLOT_TURNING, DriveConstants.PID_TURN); runVelocityPID(0, targetGyro);
m_rightFrontMotor.set(TalonFXControlMode.Velocity, 0, DemandType.AuxPID, targetAngle);
//m_leftFrontMotor.follow(m_rightFrontMotor, FollowerType.AuxOutput1);
//m_rightFrontMotor.set(DemandType.AuxPID, 0);
} }
public double getGyroYaw() { public double getGyroYaw() {