Useless Robot

File content as of revision 1:0402db7e91f5:

#include "mbed.h"
#include "rtos.h"
#include "RGBLed.h"
#include "uLCD_4DGL.h"
 
DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);

// RGBLed myRGBled(p21,p22,p23); //RGB PWM pins

InterruptIn Switch(p15);

PwmOut red(p21);
PwmOut green(p22);
PwmOut blue(p23);

uLCD_4DGL uLCD(p9, p10, p11);

Thread t1; // Arm Response
Thread t2; // LED Color
Thread t3; // Speaker Music / Audio
Thread t4; // Motor Control

Mutex state;
int angerlevel;

bool pushFlag = false;
 
void ArmThread() 
{
    //basic if switch is toggled then use arm to turn it off
    //Want to add delay depedning on anger level
    //Potentially need a queue system
    if (pushFlag)
    {
        //start servo
        state.lock();   //lock to update the anger level
        angerlevel++;
        state.unlock();
    }
}

void LEDThread() {
    state.lock();   //lock to read the angerlevel
    switch(angerlevel)
        case 1:
            state.unlock();
            //turn on leds
            break;
        case 2:
            state.unlock();
            //LEDS/AUDIO
            break;
        case 3:
            state.unlock();
            //LEDS/AUDIO/motor
            break;
        default:
            state.unlock();
            //case 0 do nothing
            break;
    state.unlock();
}

void AudioThread() {
    //PWM/AMP? to play audio?
    //need to get sd card & angry sounds for audio
    state.lock();   //lock to read the angerlevel
    switch(angerlevel)
        case 2:
            state.unlock();
            //AUDIO
            break;
        case 3:
            state.unlock();
            //AUDIO/MOTOR
            break;
        default:
            state.unlock();
            //Nothing to do here
            break;
    state.unlock();
}

void WheelsThread() {
    //Drive around randomly
    state.lock();   //lock to read the angerlevel
    switch(angerlevel)
        case 3:
            state.unlock();
            //MOTOR
            break;
        default:
            state.unlock();
            //nothing
            break;
    state.unlock();
}

 
void fallInterrupt(){
    pushFlag=true;
}

void init(){
    interrupt.fall(&fallInterrupt);
    interrupt.mode(PullUp); 

}

int main() {
    init();
        
    t1.start(ArmThread);
    t2.start(LEDThread);
    t3.start(AudioThread);
    t4.start(WheelsThread);
    
}