Bertl Robot with fiunctions

Dependencies:   mbed HCSR

Committer:
Enenkel
Date:
Thu Nov 13 18:19:47 2014 +0000
Revision:
0:0b7c22955b8c
Child:
1:f2d7bec926ce
MOTOREN 1sec an

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Enenkel 0:0b7c22955b8c 1 /***********************************
Enenkel 0:0b7c22955b8c 2 name: BERTL_2014_TEST
Enenkel 0:0b7c22955b8c 3 author: Gottfried Enenkel HTL BULME
Enenkel 0:0b7c22955b8c 4 email: ene@bulme.at
Enenkel 0:0b7c22955b8c 5 description:
Enenkel 0:0b7c22955b8c 6 Der BERTL fährt 1 sec lang VORWÄRTS!
Enenkel 0:0b7c22955b8c 7 Danach steht er für 1 sec
Enenkel 0:0b7c22955b8c 8
Enenkel 0:0b7c22955b8c 9 Wenn an auf den Moter sieht, ist da + Zeichen
Enenkel 0:0b7c22955b8c 10 immer LINKS OBEN zu sehen !
Enenkel 0:0b7c22955b8c 11 ***********************************/
Enenkel 0:0b7c22955b8c 12 #include "mbed.h"
Enenkel 0:0b7c22955b8c 13
Enenkel 0:0b7c22955b8c 14 // ************ DEKLARATIONEN **************
Enenkel 0:0b7c22955b8c 15 DigitalOut MotorL_EN(p34);
Enenkel 0:0b7c22955b8c 16 DigitalOut MotorL_FORWARD(P1_1);
Enenkel 0:0b7c22955b8c 17 DigitalOut MotorL_REVERSE(P1_0);
Enenkel 0:0b7c22955b8c 18
Enenkel 0:0b7c22955b8c 19 DigitalOut MotorR_EN(p36);
Enenkel 0:0b7c22955b8c 20 DigitalOut MotorR_FORWARD(P1_3);
Enenkel 0:0b7c22955b8c 21 DigitalOut MotorR_REVERSE(P1_4);
Enenkel 0:0b7c22955b8c 22
Enenkel 0:0b7c22955b8c 23 // ************* Hauptprogramm ************
Enenkel 0:0b7c22955b8c 24 int main() { // Start Hauptprogramm
Enenkel 0:0b7c22955b8c 25 MotorR_EN=MotorL_EN=1; // Beide Motoren ENABLE
Enenkel 0:0b7c22955b8c 26 while(1) { // Anfang der Schleife (ohne Abbruch)
Enenkel 0:0b7c22955b8c 27 MotorR_FORWARD = MotorL_FORWARD = 1; // Beide Motoren vorwärts EIN
Enenkel 0:0b7c22955b8c 28 wait (1); // warte 1 Sekunde
Enenkel 0:0b7c22955b8c 29 MotorR_FORWARD = MotorL_FORWARD = 0; // Motoren AUS
Enenkel 0:0b7c22955b8c 30 wait (1); // warte 1 Sekunde
Enenkel 0:0b7c22955b8c 31 } // Springe zum Anfang der Schleife
Enenkel 0:0b7c22955b8c 32 }
Enenkel 0:0b7c22955b8c 33
Enenkel 0:0b7c22955b8c 34 // ************** ENDE *************