Diff: main.cpp

Revision:

0:9f5a70453c7c

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Mar 05 20:57:25 2020 +0000
@@ -0,0 +1,37 @@
+#include "mbed.h"
+#include "USBJoystick.h"
+DigitalOut led_red(LED_RED);
+DigitalOut led_green(LED_GREEN);
+DigitalIn sw2(SW2);
+DigitalIn sw3(SW3);
+Serial pc(USBTX, USBRX);
+
+AnalogIn throt(A0);
+AnalogIn yaw(A1);
+AnalogIn pitch(A2);
+AnalogIn roll(A3);
+
+USBJoystick joystick;
+
+int main() {
+    int c;
+    led_green = 1;
+    led_red = 1;
+    pc.baud(115200);
+    pc.printf("Hello World from FRDM-K64F board.\n");
+
+    while (true) {
+        c += 1;
+        joystick.update(
+            throt.read() * 32767.0,
+            yaw.read() * 32767.0,
+            pitch.read() * 32767.0,
+            roll.read() * 32767.0
+        );
+
+        led_red = 1;
+        wait(0.005);
+        //led_red = 0;
+        //wait(0.01);
+    }
+}