Automatic Cocktail Maker

// Automatic Cocktail Maker

#include "mbed.h"
#include "rtos.h"
 
DigitalOut valve1(p15);
DigitalOut valve2(p16);
DigitalOut valve3(p17);

AnalogIn distSensor(p19);

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

DigitalOut latch(p8);
DigitalOut enable(p9);

SPI sBrite(p11, p12, p13);

Serial pc(USBTX, USBRX);

int vTime[3];
bool t_enabled, distSens_on = true;
osThreadId mainThreadID;

// Valve 1 Timer Thread
void thread1(void const *args) {
    while(1) {
        if(t_enabled) {
            valve1 = 1; led1 = 1;
            int waitTime = (int)(vTime[0] * 100);
            Thread::wait(waitTime);
            valve1 = 0; led1 = 0;
            t_enabled = false;
            osSignalSet(mainThreadID, 0x1);
        }
    }
}

// Valve 2 Timer Thread
void thread2(void const *args) {
    while(1) {
        if(t_enabled) {
            valve2 = 1; led2 = 1;
            int waitTime = (int)(vTime[1] * 100);
            Thread::wait(waitTime);
            valve2 = 0; led2 = 0;
            t_enabled = false;
            osSignalSet(mainThreadID, 0x2);
        }
    }
}

// Valve 3 Timer Thread
void thread3(void const *args) {
    while(1) {
        if(t_enabled) {
            valve3 = 1; led3 = 1;
            int waitTime = (int)(vTime[2] * 100);
            Thread::wait(waitTime);
            valve3 = 0; led3 = 0;
            t_enabled = false;
            osSignalSet(mainThreadID, 0x4);
        }
    }
}

// Shiftbrite light effects
void thread4(void const *args) {

    int red=0;
    int green=0;
    int blue=0;
    sBrite.format(16,0);
    sBrite.frequency(500000);
    enable=0;
    latch=0;
    Thread::wait(2000);

    unsigned int low_color=0;
    unsigned int high_color=0;
     
    while(1) {
        for (red = 0; red<1000; red += 200) {
            for (green = 0; green<1000; green += 200) {
                for (blue = 0; blue<1000; blue += 200)
                {
                    low_color=0;
                    high_color=0;
                    high_color=(blue<<4)|((red&0x3C0)>>6);
                    low_color=(((red&0x3F)<<10)|(green));
                    sBrite.write(high_color);
                    sBrite.write(low_color);
                    Thread::wait(0.02);
                    latch=1;
                    Thread::wait(0.02);
                    latch=0;
                    Thread::wait(250);
                }
            }
        }
    }
}

// Distance sensor trigger
void thread5(void const *args) {
    while(1) {
        if(distSensor > 0.1 && distSens_on) {
            Thread::wait(50);
            if(distSensor > 0.1 && distSens_on) {
                Thread::wait(50);
                if(distSensor > 0.1 && distSens_on) {
                    pc.putc('l');
                    distSens_on = false;
                }
            }
        }
        Thread::wait(500);
    }
}

int main() {
    
    mainThreadID = osThreadGetId();
    Thread t1(thread1);
    Thread t2(thread2);
    Thread t3(thread3);
    Thread t4(thread4);
    Thread t5(thread5);
    t_enabled = false;
    char message;
    char msg[10];
    char m[4];

    int i;
    
    // Main serial communication loop
    while(1) {
        if(pc.readable()) {
            message = pc.getc();
            if(message=='g') {
                i=0;
                while(i<10) {
                    if(pc.readable()) {
                        msg[i] = pc.getc();
                        i++;
                    }
                }
                sprintf(m, "%.4s", msg);
                vTime[0] = atoi(m);

                sprintf(m, "%.3s", msg+4);
                vTime[1] = atoi(m);

                sprintf(m, "%.3s", msg+7);
                vTime[2] = atoi(m);

                t_enabled = true;
                osSignalWait(0x7, osWaitForever);
                
                // Signal the PC that all solenoids turned off
                pc.putc('j');
            }
            if(message=='a') {
                valve1 = 1; led1 = 1;
            }
            if(message=='b') {
                valve1 = 0; led1 = 0;
            }
            if(message=='c') {
                valve2 = 1; led2 = 1;
            }
            if(message=='d') {
                valve2 = 0; led2 = 0;
            }
            if(message=='e') {
                valve3 = 1; led3 = 1;
            }
            if(message=='f') {
                valve3 = 0; led3 = 0;
            }
            if(message=='h') {
                distSens_on = true;
            }
        }
    }
}