Diff: main.cpp

Revision:

0:f02641e3fb91

Child:

1:7c3dbf140bfc

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Oct 16 08:05:52 2015 +0000
@@ -0,0 +1,48 @@
+#include"mbed.h"
+#include "PID.h"
+InterruptIn encoderA(D6);
+InterruptIn encoderB(D5);
+
+//DigitalIn encoderB(D5);
+
+
+Serial pc(SERIAL_TX,SERIAL_RX);
+ int Encoderpos = 0;
+ int valocity =0;
+
+void EncoderA()
+{   if(encoderB==0)
+        { Encoderpos = Encoderpos + 1;}
+    else
+   { Encoderpos = Encoderpos -1;}
+   // pc.printf("do");
+   //Encoderpos = Encoderpos + 1;
+   valocity+=1;
+   pc.printf("%d \n",Encoderpos);
+}
+  
+
+void EncoderB()
+{ 
+    if(encoderA==1)
+    { Encoderpos = Encoderpos + 1;}
+    else
+    { Encoderpos = Encoderpos -1;}
+    pc.printf("%d",Encoderpos);
+}
+
+int main()
+{
+    pc.baud(115200);
+    encoderA.rise(&EncoderA);
+   pc.printf("Encode\n");
+    
+    
+    while(1)
+    {
+       // pc.printf("Encode\n");
+        //wait(1);
+       // pc.printf("%d \n",Encoderpos);
+         
+    }  
+}
\ No newline at end of file