TechMove / Mbed 2 deprecated TechMoveDXC

Dependencies:   mbed

TechMoveDXC.cpp

Committer:
IKn0Ww
Date:
2015-04-17
Revision:
2:a12d19da681a
Parent:
1:685f9717028d
Child:
3:381aaa338447

File content as of revision 2:a12d19da681a:

#include "mbed.h"

DigitalIn K1 (dp25);    //Keuzeschakelaar stand 1: Sumo.
DigitalIn K2 (dp16);    //Keuzeschakelaar stand 2: Straight line.
DigitalIn K3 (dp26);    //Keuzeschakelaar stand 3: Service.

AnalogIn SLV (dp9);    //Sensor links voor.
AnalogIn SRV (dp10);    //Sensor rechts voor.
AnalogIn SLA (dp11);    //Sensor links achter.
AnalogIn SRA (dp13);    //Sensor rechts achter.

DigitalOut MLL (dp5);  //Draairichting linker motor linksom.
DigitalOut MLR (dp6);  //Draairichting linker motor rechtsom.
DigitalOut MRL (dp1);  //Draairichting rechter motor linksom.
DigitalOut MRR (dp24);  //Draairichting rechter motor rechtsom.
DigitalOut LED (dp28);  //Indicatie LED.

PwmOut ML (dp18);   //PWM-signaal voor de linker motor.
PwmOut MR (dp2);   //PWM-signaal voor de rechter motor.

int main()
{
    int n = 0; //Variabel voor de straight line stand.
    MLL = false;
    MLR = false;
    MRL = false;
    MRR = false;
    LED = false;
    MR = 0;
    ML = 0;
    while (K1)  //Sumo stand.
        {
            n = 0;
        }
    while (K2)  //Straight line stand.
        {
            LED = !LED;
            n += 1;
            if (n == 6)
            {
                LED = true;
                MLR = true;
                MRR = true;
                MR = 1.0;
                ML = 1.0;
                wait (5.0);   //Tijd van het rijden.
                MLR = false;
                MRR = false;
                MR = 0;
                ML = 0;
            }
        wait (0.5);
              
        }
    while (K3)  //Service stand.
        {
            n = 0;
        }
}