File content as of revision 46:5ad0d78d045e:

#include "mbed.h"

DigitalOut led1(LED1);

// State machine
int    STATE;
const int NONE     = -1;
const int IDLE_LISTEN  = 0;
const int CALC_DELTA_T     = 1;
const int CALC_DELTA_S     = 2;
const int CALC_DELTA_PHI     = 3;
const int SEND     = 4;
const int WAIT     = 9;

// main() runs in its own thread in the OS
int main() {
    STATE = IDLE_LISTEN;
    while (true) {
        switch (STATE) {
            
            case IDLE_LISTEN:
            //code here
            STATE = CALC_DELTA_T
            break;
            
            case CALC_DELTA_T:
            //code here
            break; 

            case CALC_DELTA_S:
            //code here
            break;
            
            case CALC_DELTA_PHI:
            // code here
            break;
            
            case SEND:
            // code here
            break;
        
            }
    }
}
//Calculating distanse between sound and camera
double calcDis(double t, double v){
    double s = t*v;
    return s;
    
}
//Calculating angle in radians, D distanse between mic1 and mic2
double calcAng(double s, double D){
    double ang = asin(s/D);
    return ang;
}

//Presuming the input value is temp as a nuber and humidity as procent
double speedofsound(double temp, double hum){
    //Calculations done in Matlab

    double speed = 331.1190 + 0.6016*temp + 0.0126*hum;

    return speed;
}