File content as of revision 7:eed677b636d3:

#include "mbed.h"

Serial pc(USBTX,USBRX);
PwmOut ServoPWMpin(D9);

double ServoAngle = 89 ;
float Pulsew = 0.0015;
double treshold = 0.3;
bool binary_input_signal = 0;
bool binary_input_signal_previous = 0;

void control_servo(double input_signal){
    pc.printf("/n/r %f", input_signal);
    if (input_signal > treshold){                        // convert the emg to a zero or a one
        binary_input_signal = 1;
    } else {
        binary_input_signal = 0;
    }
    if(( binary_input_signal!= binary_input_signal_previous)&& binary_input_signal){
        if( ServoAngle < 45){                           // check wether it is more opened or closed
            ServoAngle = 89;                            // open 
        }
        else{
            ServoAngle = 1;                             // close 
        }
    }
    Pulsew = 0.0015+(ServoAngle)/180000;                // calculate the pulsewidth in the range 1 to 2 milliseconds
    ServoPWMpin.pulsewidth(Pulsew);                     // write the pulsewidth
    pc.printf("\n\r Pulsew is %f",Pulsew);
    
    binary_input_signal_previous = binary_input_signal;
}