Christian Benitez
/
wheelchaircontrol
Wheelchair control
Fork of wheelchaircontrol by
Diff: main.cpp
- Revision:
- 6:8cd00c26bb47
- Parent:
- 5:e0ccaab3959a
--- a/main.cpp Tue Jul 17 07:19:04 2018 +0000 +++ b/main.cpp Tue Jul 17 19:19:26 2018 +0000 @@ -1,79 +1,92 @@ #include "wheelchair.h" +// Initialize Pins AnalogIn x(A0); AnalogIn y(A1); - + DigitalOut off(D0); DigitalOut on(D1); DigitalOut up(D2); DigitalOut down(D3); - + Wheelchair smart(xDir,yDir); int main(void) { on = 1; while(1){ - /* if( pc.readable()) { - char c = pc.getc(); - if( c == 'w') { - pc.printf("up \n"); - smart.forward(); + /* + // Waiting for command + if (pc.readable()) { + char c = pc.getc(); + + // Move Forward + if (c == 'w') { + pc.printf("up \n"); + smart.forward(); } - else if( c == 'd') { - pc.printf("left \n"); - smart.left(); + // Move Left + else if (c == 'd') { + pc.printf("left \n"); + smart.left(); + } + + // Move Right + else if (c == 'a') { + pc.printf("right \n"); + smart.right(); } - else if( c == 'a') { - pc.printf("right \n"); - smart.right(); - } - - else if( c == 's') { - pc.printf("down \n"); - smart.backward(); + // Move Backward + 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; + + // Read non-move commands + else { + pc.printf("none \n"); + smart.stop(); + + // Turn On + if (c == 'o') { + pc.printf("Turning on.\n"); + on = 0; + wait(process); + on = 1; + } + + // Turn Off + else if (c == 'k') { + off = 0; + wait(process); + off = 1; + } + + + else if (c == 'u') { + up = 0; + wait(process); + up = 1; } - else if( c == 'k') { - off = 0; - wait(process); - off = 1; + else if (c == 'p') { + down = 0; + wait(process); + down = 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(); - } - */ - smart.move(x,y); - wait(process); - } - + else { + pc.printf("Nothing pressed.\n"); + smart.stop(); + } + */ + + smart.move(x,y); + wait(process); + } }