robot

Dependencies:   FastPWM3 mbed

Revision:
8:70122bad5f90
Parent:
7:caebf421f288
--- a/PositionSensor/PositionSensor.cpp	Wed Mar 30 06:50:11 2016 +0000
+++ b/PositionSensor/PositionSensor.cpp	Sat Apr 23 21:29:32 2016 +0000
@@ -81,12 +81,14 @@
     }
 }
 
+int PositionSensorEncoder::GetRawPosition() {
+    return TIM2->CNT;
+}
+
 void PositionSensorEncoder::ZeroEncoderCount(void){
     if (ZSense->read() == 1){
         if (ZSense->read() == 1){
-            ZTest->write(state);
             TIM2->CNT=0;
-            state = !state;
         }
     }
 }
\ No newline at end of file