Mircroprocessor revised code 9/22

Dependencies:   m3pi mbed

Fork of m3pi_HelloWorld by Chris Styles

main.cpp

Committer:
SpicedPork
Date:
2014-09-22
Revision:
9:b723c1cdaae4
Parent:
8:abc27ba9f8f3

File content as of revision 9:b723c1cdaae4:

#include "mbed.h"
#include "m3pi.h"
 
m3pi m3pi;
 
DigitalOut myled(LED1);
 
 
int main() {
    
   
    m3pi.locate(0,1);
    m3pi.printf("START");
    
    m3pi.right_motor(-0.246); 
    m3pi.left_motor(0.246);
    wait(0.260);
    
    m3pi.forward(0.241);
    wait(1.00);
    
    m3pi.right_motor(0.093);
    m3pi.left_motor(0.1825);
    wait(1.220);
    
    m3pi.forward(0.241);
    wait(4.500);
    
    m3pi.right_motor(0.093);
    m3pi.left_motor(0.1825);
    wait(1.220);
    
    m3pi.forward(0.482);
    wait(1.000);
    
    m3pi.stop();
    
    while(1) 
    {
        m3pi.locate(0,1);
        m3pi.printf("FARTS");
    
        myled = 1;
        wait(0.500);
        myled = 0;
        wait(0.500);
    }
    
}