Diff: main.cpp

Revision:

0:80f93308a3cd

Child:

1:f75a3567978c

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Oct 15 13:17:29 2018 +0000
@@ -0,0 +1,52 @@
+#include "mbed.h"
+#include "MODSERIAL.h"
+
+
+PwmOut Motor2PWR(D5);
+DigitalOut Motor2DIR(D4);
+PwmOut Motor1PWR(D6);
+DigitalOut Motor1DIR(D7);
+AnalogIn Pot1(PTB2);
+AnalogIn Pot2(PTB3);
+MODSERIAL pc(USBTX, USBRX);
+
+float x = 0;
+float y = 0;
+int main()
+{
+Motor1PWR.period_us(60);
+while(1){
+    if(Pot1<0.45f)
+    {
+        x = Pot1-1;
+    }
+    else if(Pot1>0.55f)
+    {
+        x = Pot1;
+    }
+    else
+    {
+        x = 0;   
+    }
+    
+    if(Pot2<0.45f)
+    {
+        y = Pot2-1;
+    }
+    else if(Pot2>0.55f)
+    {
+        y = Pot2;
+    }
+    else
+    {
+        y = 0;   
+    }
+    pc.printf("x = %f, y = %f\r\n",x,y);
+    Motor1PWR = fabs(y);
+    Motor1DIR = y > 0.0f;
+    Motor2PWR = fabs(x);
+    Motor2DIR = x > 0.0f;
+    wait(0.1f);
+    }
+return(0);
+}
\ No newline at end of file