für holdor

Dependencies:   Servo mbed pixy

Fork of PES by Gruppe 3

main.cpp

Committer:
itslinear
Date:
2017-04-04
Revision:
1:4e84271a70c6
Parent:
0:306a2438de17
Child:
2:953263712480

File content as of revision 1:4e84271a70c6:

#include <mbed.h>
#include "Roboter.h"

DigitalOut led(LED1);

//Periphery for distance sensors
AnalogIn distance(PB_1);
DigitalOut enable(PC_1);
DigitalOut bit0(PH_1);
DigitalOut bit1(PC_2);
DigitalOut bit2(PC_3);
IRSensor sensors[6];

PwmOut pwmL( PA_8 );
PwmOut pwmR( PA_9 );

//motor stuff
DigitalOut enableMotorDriver(PB_2);

//indicator leds arround robot
DigitalOut leds[] = { PC_8, PC_6, PB_12, PA_7, PC_0, PC_9 };

Roboter roboter1(&distance, &bit0, &bit1, &bit2, &pwmL, &pwmR);

int main()
{
    enable = 1;
    enableMotorDriver = 1;

    while(1) {

        roboter1.bandeAusweichen();
       // roboter.readSensor1();
        
        wait(0.1f);

    }
}