Andy Pomfret / Mbed OS UoY-32C-lab6

Template project for University of York ELE00032C Lab 6

Dependencies:   UoY-serial

main.cpp

Committer:
ajp109
Date:
2022-02-16
Revision:
2:3eacc92b984b
Parent:
1:ec2d05bb8112

File content as of revision 2:3eacc92b984b:

#include "mbed.h"

DigitalOut dir1(D2);
DigitalOut dir2(D3);
PwmOut pwm(D4);

void setMotorSpeed(float speed) {
    if (speed > 0) {
        dir1 = true;
        dir2 = false;
        pwm = speed;
    } else {
        dir1 = false;
        dir2 = true;
        pwm = -speed;
    }
}

int main() {
    while (true) {
        setMotorSpeed(1.0);
        thread_sleep_for(1000);
        setMotorSpeed(0.0);
        thread_sleep_for(1000);
        setMotorSpeed(-0.5);
        thread_sleep_for(1000);
        setMotorSpeed(0);
        thread_sleep_for(1000);
    }
}