summaryrefslogtreecommitdiff
path: root/src/org/mckenzierobotics/lib/robot/RateLimitedPIDOutput.java
diff options
context:
space:
mode:
authorLuke Shumaker <lukeshu@sbcglobal.net>2016-01-16 15:14:37 -0500
committerLuke Shumaker <lukeshu@sbcglobal.net>2016-01-16 15:14:37 -0500
commit7fad9de275f72354deb1a86ee0e8312a420bf783 (patch)
tree075c09eccd19a5c24ee5a74a12d9a2e7964b5e49 /src/org/mckenzierobotics/lib/robot/RateLimitedPIDOutput.java
parent43771f1f16c8368fde4267ed64c4568dc620ad61 (diff)
mv src/org/mkenzierobotics/lib/robot/* src/org/usfirst/frc/team4272/robotlib
Diffstat (limited to 'src/org/mckenzierobotics/lib/robot/RateLimitedPIDOutput.java')
-rw-r--r--src/org/mckenzierobotics/lib/robot/RateLimitedPIDOutput.java50
1 files changed, 0 insertions, 50 deletions
diff --git a/src/org/mckenzierobotics/lib/robot/RateLimitedPIDOutput.java b/src/org/mckenzierobotics/lib/robot/RateLimitedPIDOutput.java
deleted file mode 100644
index 10f01ce..0000000
--- a/src/org/mckenzierobotics/lib/robot/RateLimitedPIDOutput.java
+++ /dev/null
@@ -1,50 +0,0 @@
-/**
- * Copyright (c) 2012 Precise Path Robotics, Inc
- *
- * This program is free software: you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation, either version 3 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program. If not, see <http://www.gnu.org/licenses/>.
- *
- * @author Luke Shumaker <lukeshu@sbcglobal.net>
- */
-
-package org.mckenzierobotics.lib.robot;
-
-import edu.wpi.first.wpilibj.PIDOutput;
-import edu.wpi.first.wpilibj.Timer;
-
-/**
- *
- * @author Luke Shumaker <lukeshu@sbcglobal.net>
- */
-public class RateLimitedPIDOutput implements PIDOutput {
- PIDOutput o;
- double m;
- double prev_rate = 0;
- double prev_time = 0;
-
- public RateLimitedPIDOutput(PIDOutput out, double maxChange) {
- o = out;
- m = maxChange;
- }
-
- public void pidWrite(double rate) {
- double time = Timer.getFPGATimestamp();
- double dTime = time-prev_time;
- double dRate = rate-prev_rate;
- if (Math.abs(dRate/dTime)>m) {
- int sign = (dRate<0?-1:1);
- rate = prev_rate+(m*dTime*sign);
- }
- o.pidWrite(rate);
- }
-}