Diff: main.cpp

Revision:

0:99038ba270aa

diff -r 000000000000 -r 99038ba270aa main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Aug 10 16:55:18 2018 +0000
@@ -0,0 +1,49 @@
+#include "mbed.h"
+
+DigitalOut led1(PTC5);
+
+DigitalOut leds[5]  = { PTE6, PTE5, PTE4 ,PTE3, PTE2 };
+int        power[5] = {    0,   25,   50,   75,  100 };
+
+DigitalOut m1(PTA5);
+PwmOut     pwm1(PTA13);
+AnalogIn   fb1(PTB2);
+
+Serial     pc(USBTX, USBRX);
+
+void setMotor(int p)
+{
+    pc.printf("Motor at %d%% power\n\r", p);
+    pwm1.write(p);
+}
+
+int main()
+{
+    pc.printf("Starting Active System test...\n\r");
+    wait(0.5);
+    pwm1.period(4.0f);
+
+    while (true) {
+        pc.printf("----  Forward Test  ----\n\r");
+        led1 = 1;
+        m1 = 0;
+        for ( int i = 0; i < 5; i++ ) {
+            setMotor(power[i]);
+            leds[i] = 1;
+            printf("Current Reading: %f\n\r", fb1);
+            wait(1);
+            leds[i] = 0;
+        }
+
+        pc.printf("---- Backwards Test ----\n\r");
+        led1 = 0;
+        m1 = 1;
+        for ( int i = 0; i < 5; i++ ) {
+            setMotor(power[i]);
+            leds[i] = 1;
+            printf("Current Reading: %f\n\r", fb1);
+            wait(1);
+            leds[i] = 0;
+        }
+    }
+}
\ No newline at end of file