Template project for University of York ELE00032C Lab 6

Dependencies:   UoY-serial

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 
00003 DigitalOut dir1(D2);
00004 DigitalOut dir2(D3);
00005 PwmOut pwm(D4);
00006 
00007 void setMotorSpeed(float speed) {
00008     if (speed > 0) {
00009         dir1 = true;
00010         dir2 = false;
00011         pwm = speed;
00012     } else {
00013         dir1 = false;
00014         dir2 = true;
00015         pwm = -speed;
00016     }
00017 }
00018 
00019 int main() {
00020     while (true) {
00021         setMotorSpeed(1.0);
00022         thread_sleep_for(1000);
00023         setMotorSpeed(0.0);
00024         thread_sleep_for(1000);
00025         setMotorSpeed(-0.5);
00026         thread_sleep_for(1000);
00027         setMotorSpeed(0);
00028         thread_sleep_for(1000);
00029     }
00030 }