Lu-Hsuan Chen / Mbed OS motorcar_pid

motor car with PID running feature

Dependencies:   Ping

main.cpp

Committer:
cudaChen
Date:
2018-08-13
Revision:
5:3caf5b6ed35a
Parent:
4:982dcc2390a2

File content as of revision 5:3caf5b6ed35a:

#include "mbed.h"

#include "motorcar.h"

DigitalOut led1(LED1); // LED indicating car is running
DigitalIn pb(USER_BUTTON); // car activate button
int lastButtonState = 0;
bool ledState = false;

// main() runs in its own thread in the OS
int main() {
    //init();
    
    while (true) {
        int reading1 = pb.read();

        if(reading1 != lastButtonState) {
            wait_ms(20);

            int reading2 = pb.read();

            if(reading2 == reading1) {
                lastButtonState = reading2;
            }

            if(lastButtonState == 1) {
                ledState = !ledState;
            }
        }

        led1.write(ledState);
        
        if(ledState) {
            readSensorValue();
            
            runPID();
        }
    }
}