Module 9 Super Team / PIDController1

Fork of PIDController by Kevin Hetterscheid

Revision:
6:48bb8aa4888b
Parent:
5:937b2f34a1ca
Child:
7:0fb420b3434f
--- a/pidControl.cpp	Tue Oct 20 09:42:24 2015 +0000
+++ b/pidControl.cpp	Tue Oct 20 09:56:40 2015 +0000
@@ -168,6 +168,11 @@
     pc.printf("Initialized\r\n");
 }
 
+void getCurrent(double& a, double& b) {
+    a = toRadians(enc1.getPulses());
+    b = toRadians(enc2.getPulses());   
+}
+
 int move(double a, double b) {
     while (true) {
         if (shutup) {