wheelchair code for alexa integration

Dependencies:   mbed

Fork of wheelchaircontrol by ryan lin

main.cpp

Committer:
ryanlin97
Date:
2018-07-12
Revision:
1:c0beadca1617
Parent:
0:fc0c4a184482
Child:
2:c2d049efc266

File content as of revision 1:c0beadca1617:

#include "wheelchair.h"

Serial pc(USBTX, USBRX);

DigitalOut off(D0);
DigitalOut on(D1);
DigitalOut up(D2);
DigitalOut down(D3);
int main(void)
{
    Wheelchair smart(xDir,yDir);
    on = 1;
    while(1) {
        if( pc.readable()) {
            char c = pc.getc();
            if( c == 'w') {
                pc.printf("up \n");
                smart.forward();
            }

            else if( c == 'd') {
                pc.printf("left \n");
                smart.left();
            }

            else if( c == 'a') {
                pc.printf("right \n");
                smart.right();
            }

            else if( c == 's') {
                pc.printf("down \n");
                smart.backward();
            }

            else {
                pc.printf("none \n");
                smart.stop();
                if( c == 'o') {
                    pc.printf("turning on");
                    on = 0;
                    wait(process);
                    on = 1;
                }

                else if( c == 'k') {
                    off = 0;
                    wait(process);
                    off = 1;
                }

                else if( c == 'u') {
                    up = 0;
                    wait(process);
                    up = 1;
                }

                else if( c == 'p') {
                    down = 0;
                    wait(process);
                    down = 1;
                }
            }
        }

        else {
            pc.printf("nothing pressed \n");
            smart.stop();
        }

        wait(process);
    }

}