From cdf2d64157315905ecd8666832e9895693dd414f Mon Sep 17 00:00:00 2001 From: Aarav Shah <91212@psdschools.org> Date: Tue, 18 Feb 2020 19:22:18 -0700 Subject: [PATCH 1/3] Renamed speedShift, declared coolFalcon --- src/main/java/frc4388/robot/subsystems/Drive.java | 12 +++++++----- 1 file changed, 7 insertions(+), 5 deletions(-) diff --git a/src/main/java/frc4388/robot/subsystems/Drive.java b/src/main/java/frc4388/robot/subsystems/Drive.java index 9571f66..aef4006 100644 --- a/src/main/java/frc4388/robot/subsystems/Drive.java +++ b/src/main/java/frc4388/robot/subsystems/Drive.java @@ -63,7 +63,8 @@ public class Drive extends SubsystemBase { public final DifferentialDriveOdometry m_odometry; - public DoubleSolenoid speedShift; + public DoubleSolenoid m_speedShift; + public DoubleSolenoid m_coolFalcon; public long m_lastTime, m_deltaTime; //in milliseconds @@ -83,8 +84,9 @@ public class Drive extends SubsystemBase { m_odometry = new DifferentialDriveOdometry(Rotation2d.fromDegrees(getHeading()), new Pose2d(0, 0, new Rotation2d())); - speedShift = new DoubleSolenoid(7,0,1); - + m_speedShift = new DoubleSolenoid(7,0,1); + m_coolFalcon = new DoubleSolenoid(7,3,2); + /* set back motors as followers */ m_leftBackMotor.follow(m_leftFrontMotor); m_rightBackMotor.follow(m_rightFrontMotor); @@ -626,10 +628,10 @@ public class Drive extends SubsystemBase { */ public void setShiftState(boolean state) { if (state == true) { - speedShift.set(DoubleSolenoid.Value.kForward); + m_speedShift.set(DoubleSolenoid.Value.kForward); } if (state == false) { - speedShift.set(DoubleSolenoid.Value.kReverse); + m_speedShift.set(DoubleSolenoid.Value.kReverse); } } } From 14793f3cef10ed843e63426693d5132c5629ca3a Mon Sep 17 00:00:00 2001 From: Aarav Shah <91212@psdschools.org> Date: Tue, 18 Feb 2020 19:25:32 -0700 Subject: [PATCH 2/3] Added method to open and close solenoid, started solenoid closed --- .../java/frc4388/robot/subsystems/Drive.java | 16 ++++++++++++++++ 1 file changed, 16 insertions(+) diff --git a/src/main/java/frc4388/robot/subsystems/Drive.java b/src/main/java/frc4388/robot/subsystems/Drive.java index aef4006..9fa438a 100644 --- a/src/main/java/frc4388/robot/subsystems/Drive.java +++ b/src/main/java/frc4388/robot/subsystems/Drive.java @@ -86,6 +86,8 @@ public class Drive extends SubsystemBase { m_speedShift = new DoubleSolenoid(7,0,1); m_coolFalcon = new DoubleSolenoid(7,3,2); + + coolFalcon(false); /* set back motors as followers */ m_leftBackMotor.follow(m_leftFrontMotor); @@ -634,4 +636,18 @@ public class Drive extends SubsystemBase { m_speedShift.set(DoubleSolenoid.Value.kReverse); } } + + /** + * Set to open or close solenoid that cools the falcon, true = open, false = close + * @param state Chooses between open and close + */ + public void coolFalcon(boolean state) { + if (state == true) { + m_coolFalcon.set(DoubleSolenoid.Value.kForward); + } + if (state == false) { + m_coolFalcon.set(DoubleSolenoid.Value.kReverse); + } + } + } From 24e0d07f3a3b1755ea6586c60c8cf824b451abe6 Mon Sep 17 00:00:00 2001 From: Aarav Shah <91212@psdschools.org> Date: Tue, 18 Feb 2020 19:28:05 -0700 Subject: [PATCH 3/3] Added opening every 10 seconds --- src/main/java/frc4388/robot/subsystems/Drive.java | 9 +++++++++ 1 file changed, 9 insertions(+) diff --git a/src/main/java/frc4388/robot/subsystems/Drive.java b/src/main/java/frc4388/robot/subsystems/Drive.java index 9fa438a..58c14fb 100644 --- a/src/main/java/frc4388/robot/subsystems/Drive.java +++ b/src/main/java/frc4388/robot/subsystems/Drive.java @@ -66,6 +66,8 @@ public class Drive extends SubsystemBase { public DoubleSolenoid m_speedShift; public DoubleSolenoid m_coolFalcon; + public int m_currentTimeSec = (int)(System.currentTimeMillis() * 1000); + public long m_lastTime, m_deltaTime; //in milliseconds public double m_lastAngleYaw, m_currentAngleYaw, m_kinematicsTargetAngle; @@ -269,6 +271,13 @@ public class Drive extends SubsystemBase { @Override public void periodic() { + + if (m_currentTimeSec % 10 == 0) { + coolFalcon(true); + } else if ((m_currentTimeSec - 2) % 10 == 0) { + coolFalcon(false); + } + m_deltaTime = System.currentTimeMillis() - m_lastTime; m_lastTime = System.currentTimeMillis(); m_lastAngleYaw = m_currentAngleYaw;