Increment Geber Test

Dependencies:   mbed

main.cpp

Committer:
Enenkel
Date:
2015-01-25
Revision:
3:9def5e647f70
Parent:
2:5f2dae8a94fa

File content as of revision 3:9def5e647f70:

/***********************************
name:   BERTL_2014_TEST Motorsensoren 
author: Gottfried Enenkel   HTL BULME
email:  ene@bulme.at
description:
    Der BERTL fährt 1 sec lang  VORWÄRTS! 
    Danach steht er für 1 sec
    Dabei sind die Radsensoren auf die D10 bzw. D13 geschalten.
    Wenn an auf den Moter sieht, ist da + Zeichen 
    immer LINKS OBEN zu sehen !  
***********************************/
#include "mbed.h"

// ************ DEKLARATIONEN **************
DigitalOut MotorL_EN(p34);        // Motor Links = mg1 
DigitalOut MotorL_FORWARD(P1_1);   
DigitalOut MotorL_REVERSE(P1_0);   

DigitalOut MotorR_EN(p36);        //Motor Rechts = mg2
DigitalOut MotorR_FORWARD(P1_3);
DigitalOut MotorR_REVERSE(P1_4);

PwmOut mg1(P1_15);           //PWM Ausgang zum Motor Links
PwmOut mg2(P0_21);           //PWM Ausgang zum Motor Rechts
float speedy=0.3;            //Motor speed 1 = Vollgas  0.3 sehr langsam
                             // wenn kleiner als 0.2,
                             // kann der Motor ev nicht mehr anfahren
DigitalOut LED_D10(P1_8);    // LED D10 und D13 definieren
DigitalOut LED_D13(P1_11);   //      

DigitalIn SensorL(P1_12);    // Sensor Links  bei mg1      
DigitalIn SensorR(P1_13);    // Sensor Rechts bei mg2
int a;                       // Variable a
// *************  Hauptprogramm ************
int main() {                 // Start Hauptprogramm
    mg1=mg2=speedy;
    MotorR_EN=MotorL_EN=(1); // Beide Motoren ENABLE
    
    while (1){
      a=0;                   //Variable a auf 0 setzen    
      while(a<1000) {        // mache solang a<1000   
        MotorR_FORWARD = MotorL_FORWARD = 1;  // Beide Motoren vorwärts EIN
        LED_D10 = SensorL;   //  LED D10 blinkt
        LED_D13 = SensorR;   //  LED D13 blinkt 
        a++;
        wait_ms(1);          //  warte 1 mSekunde  
      }    
        MotorR_FORWARD = MotorL_FORWARD = 0;  // Motoren AUS  
        wait (1);            //  warte 1 Sekunde 
    }                        //  Springe zum Anfang der Schleife 
}       

// **************     ENDE     *************