Werkend motorscript met led feedback

Dependencies:   Encoder MODSERIAL mbed

Fork of frdm_Motortryout2 by Robert Schulte

main.cpp

Committer:
Rvs94
Date:
2015-09-21
Revision:
2:2b8a8be38c85
Parent:
1:4e65a72b622e
Child:
3:051c91b04acd

File content as of revision 2:2b8a8be38c85:

#include "mbed.h"
#include "encoder.h"
#include "MODSERIAL.h"
 
Serial pc(USBTX, USBRX); // tx, rx
DigitalOut led1(LED_RED);
DigitalOut led2(LED_BLUE);
DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield)
PwmOut motor2speed(D5);
DigitalIn button1(SW3);
DigitalIn button2(SW2);

const int ledOff = 1;
const int ledOn = 0;

int main()
{
    motor2direction = 1;
    motor2speed = 0;
    led1 = ledOff;
    led2 = ledOff;
    pc.baud(9600);
    while(true)
    {
            for(button1 == 0);
                {
                    motor2speed = 0.5f;
                    pc.printf("het werkt");
                    wait(1);
                    led1 = ledOn;
                    wait(0.2f);
                    motor2speed = 0;
                    led1 = ledOff;
                }
            for(button2 == 0);
                {
                    motor2speed = 1;
                    led2 = ledOn;
                    wait(0.5f);
                    led2 = ledOff;
                }

    }   
}