Fährt 4*2 Kurven und stoppt dann

Dependencies:   mbed

Fork of _B16_T3_Motor by Gottfried Enenkel

main.cpp

Committer:
PatrickMarterer
Date:
2016-05-13
Revision:
4:2bf2ab6a1163
Parent:
3:acd2b6fdcd7f

File content as of revision 4:2bf2ab6a1163:

/***********************************
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);           // Motor Spannung ab BERTL15 nötig !
DigitalOut MotorL_EN(P1_19);      // Enable        OB DIE LINKS ODER RECHTS IST NOCH NICHT KLAR !
DigitalOut MotorL_FORWARD(P2_15); // Forwerts
DigitalOut MotorL_REVERSE(P2_14); // Rückwerts

DigitalOut MotorR_EN(P2_19);      //Die Leitung führt zum Pin PO_21 am Prozessor
DigitalOut MotorR_FORWARD(P2_20); //Die Leitung führt zum Pin P1_3 am Prozessor
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(a<4) {
        



        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     *************