Robot control using MIT APP inventor

Dependencies:   mbed

main.cpp

Committer:
kirathekiller
Date:
2018-03-20
Revision:
0:6709e55d3cdd

File content as of revision 0:6709e55d3cdd:

#include "mbed.h"
//#include <stdio.h>
//#include <string.h>





DigitalOut m1f(PTC2);
DigitalOut m1r(PTC3);
DigitalOut m2f(PTC4);
DigitalOut m2r(PTC12);

Serial pc(USBTX, USBRX);
Serial blue(PTC15, PTC14);
char c=0;

int main()
{
    while (true) {
           
        if(blue.readable()>0)
        {
            c=blue.getc();
            }
            if(c=='F')//forward
            {
                m1f = 1;
                m1r = 0;
                m2f = 1;
                m2r = 0;
            }
        
        else if(c=='B') //backward
        //wait(0.2f);
        {
            m1f = 0;
            m1r = 1;
            m2f = 0;
            m2r = 1;
        }
        else if(c=='L') //left
        {
            m1f = 1;
            m1r = 0;
            m2f = 0;
            m2r = 0;
        }
        else if(c=='R') //right
        {
            m1f = 0;
            m1r = 0;
            m2f = 1;
            m2r = 0;
        }
        else if(c=='S') //stop
        {
            m1f = 0;
            m1r = 0;
            m2f = 0;
            m2r = 0;
        }     
        
    }
}