Liniensensor_Bendel

Dependencies:   BertlLib mbed

Fork of BertlTemplate2 by michael hollegha

LinienSensor_Pendel.cpp

Committer:
Lippi
Date:
2016-03-14
Revision:
3:b6754e794335
Child:
4:c157810a12c5

File content as of revision 3:b6754e794335:


#include "mbed.h"
#include "Serial_HL.h"
#include "Bertl14.h"
#include "BertlObjects.h"

//              main=2^0  LS    ENC 2^2
BusOut boardPow(p30,      P1_6, P1_7);
Timer t1, t2;
AnalogInHL ls1(p18), ls2(p16), ls3(p20), ls4(p19), ls5(p17);


int main(void)
{
    boardPow=3;
    wait_ms(10);
    InitBertl();
    pex.useISR=0;
    leds=9;
    pex.ClearLeds();
    t1.start();
    t2.start();
    
    while(1) {
        pex.ReadButtons();
        if(pex.IsButton(BTN_FM))
        {
        if (ls3.Read()>400)
        {
            mL.SetPow(0.1);
            mR.SetPow(0.3);
        }
        else
        {
            mL.SetPow(0.3);
            mR.SetPow(0.1);
        }  
        } 
       
    }

    return 1;
}