File content as of revision 6:03ba3e18ced2:

#include "Verzender.h"

#define NUM_SAMPLES 2000 // size of sample series

Serial pc(USBTX, USBRX);

DigitalIn pb(p25);

Verzender sent;

AnalogIn   ain(p17);

float tare = 0;
float massa = 0;

/*
enum State {State_init,
            State_tare,
            State_position,
            State_read,
            State_send,
            State_receive
           };
*/

Timer t2;

State current_state = State_init;

void setCurrentState( State setState )
{
    current_state = setState;
}


State getCurrentState()
{
    return current_state;
}

float getAverageSamples(int samples)
{
    float AVERAGE = 0;
    int num_samples = 0;
    while (num_samples < samples) {
        float r = ain.read();
        AVERAGE += r;
        num_samples++;
    }

    AVERAGE /= num_samples;
    num_samples = 0;

    return AVERAGE;
}

float getAverageTime()
{
    t2.start();
    t2.reset();
    float AVERAGE = 0;
    int num_samples = 0;
    while (!pb &t2.read() <= 1) {
        float r = ain.read();
        AVERAGE += r;
        num_samples++;
    }

    AVERAGE /= num_samples;
    num_samples = 0;

    return AVERAGE;
}




int main()
{
    while(1) {
        sent.update();
        switch (current_state) {
            case State_init:
                pc.baud(9600);
                wait_ms(1000);
                pc.printf("--Verzender--Tx\n\r");
                pb.mode(PullUp);
                setCurrentState(State_read);
                payload_t payload;
                break;

            case State_position:
                pc.printf("State: position\n\r");
                if (!pb)
                    setCurrentState(State_tare);
                break;


            case State_tare:
                pc.printf("State: tare\n\r");
                tare = getAverageSamples(50000);
                pc.printf("tare = %f\r\n",tare*3.3);
                
                setCurrentState(State_read);
                break;

            case State_read:
                pc.printf("State: read\n\r");
                if (!pb) {
                    massa = getAverageTime() - tare;
                    pc.printf("massa = %f\r\n", massa*3.3);
                    payload.reedsensor = !pb;
                    payload.milligram = 2;
                    setCurrentState(State_send);
                }

                break;
            
            case State_send:
                pc.printf("State: send\n\r");
                sent.update();
                bool ok = sent.write(payload);
                if (ok) {
                    pc.printf("ok.\n\r");
                } else {
                    pc.printf("failed.\n\r");
                }
                setCurrentState(State_receive);
                break;

            case State_receive:
                pc.printf("State :receive");
                sent.update();
                if (sent.available()) {
                    state_Packet state;
                    state = sent.read();
                    if(state.setstate == State_position) {
                        setCurrentState(State_position);
                        break;
                    }
                }
                setCurrentState(State_read);
                break;
        }
    }
}