BULME_BHEL18 / Mbed 2 deprecated 2BHEL_Drive05

ok

Dependencies:   mbed

main.cpp

Committer:
stueckler
Date:
2015-06-19
Revision:
0:e39ffc2e7160

File content as of revision 0:e39ffc2e7160:

#include "mbed.h"
#include "drive.h"

// Drive03: Bis zur Linie vorfahren und warten
// solange er auf der Linie ist.
 
BusIn  sensor(p18,p16,p19,p17);
int speed = 150;

void Links()
{
    MotR(speed);
    wait(0.5);
    BrakeMotR();
}
void Rechts()
{
    MotL(speed);
    while (sensor ==0); // Warten bis Linie getroffen
    BrakeMotL();
}
int main() {
    MotInit();    
    while(1)                //Endlosschleife
    {
           Links();         //ca. 90 Grad wegdrehen
           Rechts();        //bis zur Linie zurückdrehen
    }
}
// Drive05: An Linie entlangfahren mit einem Sensor (Linie zu breit für mehr)
// - ca. 90 Grad wegdrehen
// - bis zur Linie zurückdrehen
// - Vorgänge wiederholen