Czosnekengine/UART

Dependencies:   mbed

Fork of Czosnekengine by Dominik Święch

main.cpp

Committer:
yruiewyrui3
Date:
2016-05-19
Revision:
1:3e89e116e4a7
Parent:
0:a0c8b50a7292

File content as of revision 1:3e89e116e4a7:

#include "Engine.h"
#include <string>

std::string s;
//int liczba =0;
int main() {
    //inicjalizacja silnikow - piny dzialaja:
    Engine eng_left = Engine(PB_13, PB_4, PB_10);
    Engine eng_right = Engine(PB_14, PB_5, PB_3);
    Serial pc(PA_2, PA_3);
    
    while(true) {
            eng_left.move(0);
            eng_right.move(0);
            s= pc.getc();
            pc.printf("%s  \n", s);
            //pc.putc(s);
            
            /*
            eng_left.move(liczba);
            eng_right.move(liczba);
            wait(5);
            
            if ((liczbaL==0) && (liczbaP==0)) {
                pc.printf("Pale gume w miejscu bo kazali mi stac");
                
                }
            else if ((liczbaL>0)&& (liczbaP>0)){
            
                pc.printf("Jade do przodu. Predkosc lewej strony to %d, a prawej strony to %d \n", liczbaL, liczbaP);
                }
                
            else if ((liczbaL<0)&& (liczbaP<0)){
                 pc.printf("Jade do tyłu. Predkosc lewej strony to %d, a prawej strony to %d \n", liczbaL, liczbaP);
                
                }
            else if ((liczbaL>=0)&& (liczbaP<=0)){
                 pc.printf("Obracam sie w prawo. Predkosc lewej strony to %d, a prawej strony to %d \n", liczbaL, liczbaP);
                }
            else if  ((liczbaL<=0)&& (liczbaP>=0)){
                pc.printf("Obracam sie w lewo. Predkosc lewej strony to %d, a prawej strony to %d \n", liczbaL, liczbaP);
                }
            */     
    }

}