1 files changed, 73 insertions, 0 deletions
diff --git a/src/example_main.cpp b/src/example_main.cpp
new file mode 100644
index 0000000..8c90b7d
--- /dev/null
+++ b/src/example_main.cpp
@@ -0,0 +1,73 @@
+#include "wiring.h"
+#include "HardwareSerial.h"
+#include "math.h"
+#include "usb.h"
+
+int ledPin = 13;
+uint8_t bytes_in;
+
+BootVectTable* mapleVect;
+
+void usb_tx_cb(void) {
+}
+
+void usb_rx_cb(void) {
+  bytes_in = usb_serialGetRecvLen();
+}
+
+void setup()
+{
+    pinMode(ledPin, OUTPUT);
+    Serial2.begin(9600);
+    Serial2.println("setup start");
+
+    pinMode(6, PWM);
+    pwmWrite(6, 0x8000);
+    pinMode(7, OUTPUT);
+
+    Serial2.println("setup end");
+
+    mapleVect = (BootVectTable*)(BOOTLOADER_VECT_TABLE);
+    mapleVect->serial_tx_cb = usb_tx_cb;
+    mapleVect->serial_rx_cb = usb_rx_cb;
+}
+
+
+int toggle = 0;
+
+const char* testMsg = "hello world!\n";
+
+static inline void loop() {
+    toggle ^= 1;
+    digitalWrite(ledPin, toggle);
+    delay(1000);
+    usb_serialWriteStr("blink...\n");
+
+    if (bytes_in > 0) {
+      int i;
+      for (i=0;i<bytes_in;i++) {
+	usb_serialWriteStr("b,");
+      }
+      bytes_in = 0;
+      usb_serialWriteStr("\n");
+    }
+}
+
+
+int main(void) {
+    init();
+    setup();
+
+    while (1) {
+        loop();
+    }
+    return 0;
+}
+
+/* Required for C++ hackery */
+/* TODO: This really shouldn't go here... move it later
+ * */
+extern "C" void __cxa_pure_virtual(void) {
+    while(1)
+        ;
+}