working-est copy with class-based code. still open loop

Dependencies:   mbed

Fork of analoghalls6 by N K

Revision:
5:ee1e6c84c302
Parent:
1:1f58bdcf2956
Child:
7:76d6ceb23e0d
--- a/positionsensors.cpp	Mon Mar 02 11:17:15 2015 +0000
+++ b/positionsensors.cpp	Tue Mar 03 06:28:10 2015 +0000
@@ -40,6 +40,17 @@
     angle -= _offset;
     if (angle < 0.0f) angle += 360.0f;
     if (angle >= 360.0f) angle -= 360.0f;
+    /*
+    #ifdef __DEBUG
+    pc->printf("%f",angle);
+    pc->printf("\t");
+    pc->printf("%f",ascaled);
+    pc->printf("\t");
+    pc->printf("%f",bscaled);
+    pc->printf("\t");
+    pc->printf("\n\r");
+    #endif
+    */
     
     return angle;
 }
\ No newline at end of file