Steven Rhodes / Mbed 2 deprecated CNCAirbrushCode

main.cpp

Committer:
stvnrhodes
Date:
2012-04-17
Revision:
0:22803b0c80a9
Child:
1:648d1f317624

File content as of revision 0:22803b0c80a9:

#include "mbed.h"
#include "Wifly.h"
LocalFileSystem local("local");
Serial pc(USBTX, USBRX);
DigitalOut led(LED1);
Wifly wifi(p9, p10, p8);
Command * cmd;

int main() {
    pc.baud(460800);
    printf("Test Airbrush!\r\n");
    wifi.createAdhocNetwork();
    while (1) {
        while(pc.readable()) {
            wifi.putc(pc.getc());
        }
        while(wifi.readable()){
            pc.putc(wifi.getc());
        }
        if(wifi.hasCmd()){
            cmd = wifi.getCmd();
            switch(cmd->cmd) {
              case 0x00:
                pc.printf("Move to x: %d, y:%d, z:%d\n\r", cmd->l[0], cmd->l[1], cmd->l[2]);
                wait(3);
                wifi.send("Done"); // Make sure to always send confirmation
                break;
              default:
                pc.printf("You should probably do something with case %x\n\r", cmd->cmd);
                wifi.send("No code");
            }
        }
    }
}