File content as of revision 6:93e21d47480b:

#include "mbed.h"
#include "Motor.h"
#include "rtos.h"
#include "uLCD_4DGL.h"
#include "mpr121.h"
#include "ultrasonic.h"
uLCD_4DGL uLCD(p28,p27,p29); // serial tx, serial rx, reset pin;
DigitalOut speaker(p18);
Motor m1(p23, p12, p11); // pwm, fwd, rev
Motor m2(p24, p12, p11); // pwm, fwd, rev
I2C i2c(p9, p10);
Mpr121 mpr121(&i2c, Mpr121::ADD_VSS);

DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);

enum {ROAM, STOP, SLEEP};
volatile unsigned int state = ROAM;

volatile int energy = 70;
volatile bool touched;
volatile bool fed;
volatile bool blocked;

void dist(int distance)
{
    blocked = false;
    //put code here to execute when the distance has changed
    if (state == ROAM && distance < 50) {
        //turn the bot
        blocked = true;
    } else if (state == STOP && distance < 10) {
        //increase food status
        fed = true;
        Thread::wait(3000); // make sure fed state lasts atleast 3 seconds
        fed = false;
    }
}
ultrasonic mu(p6, p7, .1, 1, &dist);

void sonar(void const *argument) {
    while(1) {
        mu.checkDistance();
        Thread::wait(100);
    }
}

void touchpad(void const *argument) {
    while(1) {
        if (mpr121.read(0x00)) { // touchpad has any interaction
            touched = true;
            Thread::wait(5000); // make sure touched state lasts 5 seconds
        }
        else { // no touchpad interaction
            touched = false;
        }
        Thread::wait(100); // runs 10 times a second
    }
}

void screen(void const *argument) {
    while(1) {
        uLCD.filled_rectangle(0, 0, 127, 127, BLACK); // clear screen
        switch(state) {
            case ROAM: {
                uLCD.circle(64, 64, 50, BLUE); // blue circle in the center
            } break;
            case STOP: {
                uLCD.locate(0,0);
                if (energy < 30) { // tired
                    uLCD.color(RED+GREEN);
                    uLCD.printf("0"); // yellow 0's
                } else if (fed || touched) { // touched or fed
                    uLCD.color(RED);
                    uLCD.printf("<3");
                } else { // wondering
                    uLCD.color(BLUE);
                    uLCD.printf("?"); // blue ?'s
                }
            } break;
            case SLEEP: {
                uLCD.locate(0,0);
                uLCD.color(BLUE);
                uLCD.printf("Z"); // blue Z's
            }
        }
        
        Thread::wait(100);    
    }
}

void sound(void const *argument) {
    while(1) {
        switch(state) {
            case STOP: {
                if (energy < 30) { // tired
                    
                } else if (fed || touched) { // touched or fed
                    
                } else { // wondering
                    
                }
            } break;
            case SLEEP: {
                
            }
        }
        
        Thread::wait(100);    
    }
}

void wheels(void const *argument) {
    while(1) {
        if(state == ROAM) {
            if (blocked) {
                // code to turn bot
            } else {
                m1.speed(1); 
                m2.speed(1);
            }
        } else {
            m1.speed(0);
            m2.speed(0);
        }      
        Thread::wait(100);
    }
}

int main() {
    uLCD.cls();
    uLCD.printf("Change baudrate.....");
    uLCD.baudrate(3000000); //jack up baud rate to max
    uLCD.background_color(BLACK);
    uLCD.text_bold(ON);
    uLCD.text_mode(OPAQUE);
    uLCD.text_width(5);
    uLCD.text_height(5);
    uLCD.cls();
    mu.startUpdates();

    //Thread thread1(sonar);
    Thread thread2(touchpad);
    Thread thread3(screen);
    //Thread thread4(sound);
    //Thread thread5(wheels);
    
    while(1) {
        // Status LEDS
        led1 = state > 0; // no leds on = ROAM, 1 led on = STOP, both on = SLEEP
        led2 = state > 1;
        led3 = touched;
        led4 = fed;
        
        // Update state
        if (energy < 5) { // sleeps for 10 seconds and wake up with 50 more energy
            state = SLEEP;
            Thread::wait(10000);
            energy += 50;
        } else if (energy < 30 || touched || fed) {
            state = STOP;
        } else {
            state = ROAM;
        }
        
        // Update energy
        switch(state) {
            case ROAM: energy -= 2;
                break;
            case STOP : energy -= 1;
                break;
        }
        
        // Make sure energy stays in 0-100
        if (energy < 0) {
            energy = 0;
        } else if (energy > 100) {
            energy = 100;
        }
        
        Thread::wait(1000); // runs once per second
    }
}