Geschwindigkeit kann nun geändert werden

Dependencies:   mbed

main.cpp

Committer:
PatrickMarterer
Date:
2016-05-25
Revision:
6:dc02e3e244e6
Parent:
5:f6930387a28e
Child:
7:006fee3cc64e

File content as of revision 6:dc02e3e244e6:

/***********************************
name:   BERTL_16_MOTOR_TEST  8.1.2016
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

    Wenn der Motor richtig eingebaut ist,
    steht über dem Linken Anschluß ein PLUS
    Wenn sich der BERTL dreht, ist ein Motor verkehrt eingebaut.

***********************************/
#include "mbed.h"

// ************ DEKLARATIONEN **************
DigitalOut Von (P2_13);  

PwmOut MotorL (P1_19);
DigitalOut MotorL_EN(P1_19);      
DigitalOut MotorL_FORWARD(P2_15); 
DigitalOut MotorL_REVERSE(P2_14); 

PwmOut MotorR (P2_19);
DigitalOut MotorR_EN(P2_19);      
DigitalOut MotorR_FORWARD(P2_20); 
DigitalOut MotorR_REVERSE(P2_21);


// *************  Hauptprogramm ************
int main()
{
    DigitalOut LED1 (P1_10);
    DigitalOut LED2 (P1_11);
    DigitalOut LED3 (P1_12);
    DigitalOut LED4 (P1_12);
    DigitalOut LED5 (P1_13);
    DigitalOut LED6 (P1_14);
    DigitalOut LED7 (P1_15);
    DigitalOut LED8 (P1_16);
    DigitalOut LED9 (P1_17);
    DigitalOut LED10 (P1_18);
    DigitalOut LED11 (P2_16);
    DigitalOut LED12 (P1_20);
    DigitalOut LED13 (P1_21);
    DigitalOut LED20 (P1_5);
    DigitalOut LED24 (P1_5);
    DigitalOut LED25 (P1_6);
    DigitalOut TA1 (P1_23);
    Von=1;
    MotorR_EN=MotorL_EN=1;
    //int a;
    //a=0;
    while(1) {
        MotorL = 0.75f;  //Bereich zwischen 1 und 0 stellt dei Geschwindigkeit ein.
        MotorR = 1f;     //Bereich zwischen 1 und 0 stellt dei Geschwindigkeit ein.
        if(TA1==1)
        {
            MotorL_REVERSE=1;
            MotorR_REVERSE=1;
            wait(2.0);
            MotorR_REVERSE=0;
            MotorL_REVERSE=0;
            wait (0.5);
            
            MotorR_REVERSE=1;
            MotorL_FORWARD=1;
            wait (0.25);
            MotorR_REVERSE=0;
            MotorL_FORWARD=0;
        }
        
        else
        {  
            int b;
            //int c;
            int d;
    
            LED1=LED2=LED4=LED5=LED6=LED7=LED8=LED9=LED10=LED11=LED12=LED13=LED20=LED24=1;
            LED1=LED4=0;
            LED20=LED24=0;
            MotorL_FORWARD = 1;
            MotorR_FORWARD = 1;
    
            wait (7.0);
    
            MotorL_FORWARD = 0;
            MotorR_FORWARD = 0;
    
            LED1=LED4=1;
            LED7=LED9=0;
            b=0;
            while (b<2) {
                LED8=0;
                LED5=0;
                wait (0.5);
                LED5=1;
                LED8=1;
                wait (0.5);
                b=b++;
            }
    
    
    
            MotorL_FORWARD =1;
            MotorR_REVERSE =1;
            wait (0.25);
            MotorL_FORWARD = 0;
            MotorR_REVERSE = 0;
            wait (2.0);
            LED7=LED9= 1;
    
            LED1=LED4=0;
            MotorL_FORWARD=1;
            MotorR_FORWARD=1;
            wait (4.0);
            MotorL_FORWARD=0;
            MotorR_FORWARD=0;
            wait (0.0);
            LED1=LED4=1;
    
            LED7=LED9=0;
    
            d=0;
            while(d<2) {
                LED8=LED5=0;
                wait (0.5);
                LED8=LED5=1;
                wait (0.5);
                d=d++;
            }
            MotorL_FORWARD=1;
            MotorR_REVERSE=1;
            wait (0.25);
            MotorL_FORWARD=0;
            MotorR_REVERSE=0;
            wait (0.5);
            LED7=LED9=1;
            LED1=LED4=LED20=LED24=0;
        }

        

        //a=a++;

    }
}
// **************     ENDE     *************