Added drive/stop

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "ICRS101.h"
00002 
00003 DigitalOut myled(LED1);
00004 DigitalIn SW1(p29);
00005 
00006 int main()
00007 {
00008     while(1) {
00009         speed(1);
00010         if(SW1) drive();
00011         else{
00012             stop();
00013             wait(1);
00014             speed(0.5);
00015             backward(1);
00016             wait(1);
00017             right(0.5);
00018             wait(1);
00019             }
00020     }
00021 }