File content as of revision 9:1bdf5107920f:

#include "mbed.h"
#define CURVE_BUFFER_SIZE 100
class Control {
private: 
    //----- SETTINGS -----
    //Curve
    enum curve_t    { OFF=0, CONSTANT_PRESSURE, CONSTANT_FLOW, CONSTANT_SPEED, MODE_SINUS, MODE_ARTERIAL
                    } curve_mode;
    float curve_buffer[CURVE_BUFFER_SIZE];
    float curve_min;    //[mmHg]
    float curve_max;   //[mmHg]
    float curve_period; //[ms]
    int curve_step;
    int curve_step_ms; //The time it takes to make one step
    
    //Constant variables
    float constant_pressure;
    float constant_flow;
    float constant_speed;
    
    //Ticker
    Ticker t;
    
    //Motor output    
    float gradient; //pressure/percentagemaxpowerorjustvoltiguess
    PwmOut motorOut;
    
    
    //----- PRIVATE FUNCTIONS -----
    void outputToPin(float input){
        float temp = gradient*input;   
        if(temp > 1){
            motorOut = 1;
        } else if(temp < 0){
            motorOut = 0;
        } else {
            motorOut = temp;
        }    
    }
    void run(){
        switch(curve_mode){
            case CONSTANT_PRESSURE:
                break;
            case CONSTANT_FLOW:
                break;
            case CONSTANT_SPEED:
                break;
            case MODE_SINUS:
                outputToPin(curve_buffer[curve_step]);
                curve_step++;
                if(curve_step >= CURVE_BUFFER_SIZE){
                    curve_step = 0;   
                }
                break;
            case MODE_ARTERIAL:
                break;
            default:
                break; 
        }   
        
    }
    void rebuild_buffer(){
        if(curve_mode == MODE_SINUS){
            float amplitude = (curve_max - curve_min)/2; //amplitude*sin(t) //van -amplitude naar +amplitude
            //Als sin(x) = 0, moet de curve exact in het midden van max en min zitten
            float offset = (curve_max+curve_min)/2;
            //Genereer een volle periode en zet het in de buffer
            float step = 2*3.1415926/CURVE_BUFFER_SIZE;
            for(int i=0;i<CURVE_BUFFER_SIZE;i++){        
                curve_buffer[i] = offset+amplitude*sin(step*i);
            }
        } else if(curve_mode == MODE_ARTERIAL){
           //Coming to a cinema near you... soon!                    
        }
    }
    
public:
    Control(PinName n_pin) : motorOut(n_pin){
        curve_step = 0;
        curve_min = 80;    //[mmHg]
        curve_max = 120;   //[mmHg]
        curve_period = 1000; //[ms]
        motorOut.period_ms(1); //1kHz
        rebuild_buffer();
    }   
    void start(){
        t.attach(callback(this, &Control::run), (curve_step_ms/1000.0));
    }
    void stop(){
        t.detach();        
    } 
    void normalize(AnalogIn& sensor){
        //f'(x) = a
        //f'(x) = dy/dx
        //g(x) = a*x+b
        //volt(pressure) = gradient*pressure+offset
        //gradient = dVolt/dPressure
        float   p1 = 0,
                p2 = 0;
        motorOut = 0.1;
        wait(2);
        p1 = sensor.read();
        motorOut = 0.2;
        wait(2);
        p2 = sensor.read();
        gradient = (p2-p1)/((float)0.1);
    }
    void set_curve(float min, float max, float period){
        curve_min = min; //mmHg
        curve_max = max; //mmHg
        curve_period = period; //ms
        curve_step_ms = curve_period/CURVE_BUFFER_SIZE;  
        rebuild_buffer();
    }
    void set_min(float min){
         curve_min = min;
         rebuild_buffer();
    }
    void set_max(float max){
        curve_max = max;
        rebuild_buffer();
    }
    void set_period(float period){
        curve_period = period; //ms
        curve_step_ms = curve_period/CURVE_BUFFER_SIZE;  
        rebuild_buffer();
    }
    void set_mode(int mode){
        curve_mode = (curve_t)mode;
        rebuild_buffer(); 
    }
    void set_constant_pressure(int pressure){   constant_pressure = pressure; }
    void set_constant_flow(int flow){           constant_flow = flow; }
    void set_constant_speed(int speed){         constant_speed = speed; }
};