File content as of revision 1:1e448c750b63:

#include "mbed.h"
#include "tsi_sensor.h"
#include "MMA8451Q.h"
#include "LED_line.h"

/* This defines will be replaced by PinNames soon */
#if defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
  #define ELEC0 9
  #define ELEC1 10
#elif defined (TARGET_KL05Z)
  #define ELEC0 9
  #define ELEC1 8
#else
  #error TARGET NOT DEFINED
#endif

#if   defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
  PinName const SDA = PTE25;
  PinName const SCL = PTE24;
#elif defined (TARGET_KL05Z)
  PinName const SDA = PTB4;
  PinName const SCL = PTB3;
#elif defined (TARGET_K20D50M)
  PinName const SDA = PTB1;
  PinName const SCL = PTB0;
#else
  #error TARGET NOT DEFINED
#endif

#define MMA8451_I2C_ADDRESS (0x1d<<1)

Thread thread_run(osPriorityNormal);

bool sym=false;
bool prn=false;

#define SENSOR_LIMIT 1000
enum sensor {SENSOR_ON=1, SENSOR_OFF=0} s0=SENSOR_OFF, s1=SENSOR_OFF, s2=SENSOR_OFF;
unsigned int s0_counter=0, s1_counter=0, s2_counter=0;

DigitalIn sens_0(PTC1);
DigitalIn sens_1(PTC2);
DigitalIn sens_2(PTB3);

LED_line l1 (PTB0, L_LED_OFF, L_LED_ON, L_CYCLE, false);
LED_line l2 (PTB1, L_LED_OFF, L_LED_ON, L_CYCLE, true);

LED_line led_green(LED_GREEN, L_LED_OFF, L_LED_ON, L_CYCLE, false);
LED_line led_red(LED_RED, L_LED_OFF, L_LED_ON, L_CYCLE, true);
LED_line led_blue(LED_BLUE, L_LED_OFF, L_LED_ON, L_CYCLE, false);

TSIAnalogSlider tsi(ELEC0, ELEC1, 40);
MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);

float x, y, z;
float p;
uint32_t d;

inline void measure_once(void)
{
    x = acc.getAccX();
    y = acc.getAccY();
    z = acc.getAccZ();
    
    p = tsi.readPercentage();
    d = tsi.readDistance();
}

inline void sensors_once(void)
{
    if (sym)
    {
        s0 = ((d>1) && (d<10))?SENSOR_ON:SENSOR_OFF;
        s1 = ((d>10) && (d<20))?SENSOR_ON:SENSOR_OFF;
        s2 = ((d>20) && (d<30))?SENSOR_ON:SENSOR_OFF;
    }
    else
    {
        s0 = (sens_0 == 1) ? SENSOR_ON : SENSOR_OFF;
        s1 = (sens_1 == 1) ? SENSOR_ON : SENSOR_OFF;
        s2 = (sens_2 == 1) ? SENSOR_ON : SENSOR_OFF;
    }
    
    if (SENSOR_OFF == s0)
    {
        s0_counter = 0;
    }
    else
    {
        if (s0_counter > SENSOR_LIMIT)
        {
            s0 = SENSOR_OFF;
        }
        else
        {
            s0_counter++;
        }
    }
    
    if (SENSOR_OFF == s1)
    {
        s1_counter = 0;
    }
    else
    {
        if (s1_counter > SENSOR_LIMIT)
        {
            s1 = SENSOR_OFF;
        }
        else
        {
            s1_counter++;
        }
    }
    
    if (SENSOR_OFF == s2)
    {
        s2_counter = 0;
    }
    else
    {
        if (s2_counter > SENSOR_LIMIT)
        {
            s2 = SENSOR_OFF;
        }
        else
        {
            s2_counter++;
        }
    }
    
    if (d > 35) 
    {
        sym = !sym;
        ThisThread::sleep_for(1000);
    }
    
    if ((!sym) && (d>1) && (d<10))
    {
        prn = !prn;
        ThisThread::sleep_for(1000);
    }
}

inline void action_once(void)
{
    if (s0 == SENSOR_ON) 
    {
        led_green.light();
        l1.light();
    }
    if (s1 == SENSOR_ON) 
    {
        led_red.light();
        l1.light();
        l2.light();
    }
    if (s2 == SENSOR_ON) 
    {
        led_blue.light();
        l2.light();
    }
}

inline void print_once(void)
{
    if (prn)
    {
        printf("%3.3s ", sym?"Sym":"IO ");
        printf("S0=%1d ", s0);
        printf("S1=%1d ", s1);
        printf("S2=%1d ", s2);
        printf("l1=%5d ", (int)l1.level());
        printf("l2=%5d ", (int)l2.level());
        printf("R=%5d ", (int)led_red.level());
        printf("G=%5d ", (int)led_green.level());
        printf("B=%5d ", (int)led_blue.level());
        printf("s:%5.2f ", p);
        printf("d:%2dmm ", d);
        printf("X: %1.2f, Y: %1.2f, Z: %1.2f\r\n", x, y, z);
        printf("\r\n");
    }
}

void run_thread(void)
{
    printf(" Started\r\n");
    while (true) {
        measure_once();
        sensors_once();
        action_once();
        print_once();
        ThisThread::sleep_for(500); //wait(1);
    }
}

int main(void) 
{
    printf("\nStarting...");

    thread_run.start(run_thread);

    while (true) 
    {
        l1.LED_run();
        l2.LED_run();

        led_green.LED_run();
        led_red.LED_run();
        led_blue.LED_run();
        ThisThread::yield();
    }
}