File content as of revision 2:98bc0c7668e3:

#include "mbed.h"
#include "math.h"

Ticker scheduler1;
Ticker scheduler2;
Ticker scheduler3;
Ticker scheduler4;

Serial pc(USBTX, USBRX); // tx, rx

DigitalOut task_1_pin(p8, 0);
DigitalOut task_2_pin(p9, 0);
DigitalOut task_3_pin(p10, 0);

DigitalOut THY_S(p5, 0);
DigitalOut IGBT_G(p6, 0);

DigitalOut led1(LED1, 0);
DigitalOut led2(LED2, 0);
DigitalOut led3(LED3, 0);
DigitalOut RemoteLED(LED4, 0);

InterruptIn ButtonPress(p21);

AnalogIn current(p15);

// ------------------------- Main Parameters  ------------------------------- //
float resistance = 15.0;
float V_batt = 160.0;
float I_out = 7.0;
float V_out = 0.0;
float freq = 50;     //switching frequency in Hz

// -------------------- Current Sensor Parameters  --------------------------- //
float HSens_gain = 39.85;
float I_LIMIT = 13.0;
float i_offset = 0.57;
float i_load = 0;
float i_loadpre = 0;
float i_avg = 0;
float i_sum = 0;
int NUM_SAMPLES = 5;
int count = 0;
int c_i = 0;
int a = 0;

// ------------------------- Ramp up parameters  ----------------------------- //
float N = 10;        // number of steps
float tramp = 10000;  // ramp time in ms
float tstep = 0;     // step time
float toff = 1;    // cycle off time
float ton_sat = 0;   // ON time saturation value
float toff_sat = 0;  // OFF time saturation value - determines the final duty cycle
float ton = 1;     // on time
float d = 0;         // duty cycle starting point
float d_sat = 0.0;   // determines the final duty cycle
int c = 0;           // step counter
int i = 0;           // cycle counter
int Ncycles = 0;     // Number of cycles



// ----------------------------- Task 1 ------------------------------------- //
// ----------------Current reading and limit testing---------------------------
void task1()
{
    task_1_pin = !task_1_pin;
    i_load = HSens_gain *( (1.0-current.read())- i_offset );

    if( (i_load > I_LIMIT) || (i_load > i_loadpre+0.5) ) {
        c_i++;
        if(c_i == 5) {
            led3 = 1;
            c_i = 0;
        }
    }
}


// ----------------------------- Task 2 ------------------------------------- //
//------------------------Serial communication----------------------------------
void task2()
{
    task_2_pin = !task_2_pin;
    pc.printf("\n\r Current = %f", i_load );
}


// ------------------------------ Task 3 ------------------------------------- //
//----------------------------Remote Control----------------------------------
void button()
{
    led1 = 1;
}
void task3()
{
    task_3_pin = !task_3_pin;
    ButtonPress.rise(&button);
    led1 = 0;
}


// ------------------------------ Task 4 ------------------------------------- //
//----------------------------XXXXXXXXXXXXXXX----------------------------------
void task4()
{
    led2 = !led2;
}

// -------------------------- Power Convertor ------------------------------- //
void pw()
{
    IGBT_G= 1;          // set IGBT Ground side pin to high
    wait_us(50);
    THY_S= 1;
    wait_us(10);
    THY_S= 0;
    wait_us(200);
    wait_ms(ton);
    IGBT_G.write(0);
    wait_ms(toff);
}

// ------------------------------ Setup  ------------------------------------- //
// ------------------------ Initial Current value ---------------------------- //
void setup()
{

    count = 0;
    while(count < NUM_SAMPLES) {
        IGBT_G= 1;          // set IGBT Ground side pin to high
        wait_us(50);
        THY_S= 1;
        wait_us(10);
        THY_S= 0;
        wait_us(200);
        i_loadpre = HSens_gain *( (1.0-current.read())- i_offset );
        wait_ms(ton);

        IGBT_G.write(0);
        wait_ms(toff);
        count++;
    }
    count = 0;
}

// ------------------------------- MAIN ------------------------------------- //
int main()
{
    pc.baud (115200);
    NVIC_SetPriority(TIMER3_IRQn, 0);
    // set mbed tickers to higher priority than other things

    task_1_pin = 0;
    task_2_pin = 0;
    task_2_pin = 0;
    THY_S = 0;
    IGBT_G = 0;
    led1 = 0;
    led2 = 0;
    led3 = 0;

    scheduler1.attach(&task1, 0.0001); // R check
    scheduler2.attach(&task2, 0.2);    // Reading Hall Sensor
    scheduler3.attach(&task3, 0.5);    // Turn OFF Power
    //scheduler4.attach(&task4, 0.01); //


    /* Remote Start Prompt */
    RemoteLED=0;
    while(1) {
        if(led1==1) {
            break; // Waiting for start Button (pin21)
        }
    }
    led1 = 0;
    RemoteLED=1;


    setup();


    //--------RAMP UP ----------//

    d_sat = resistance*I_out/V_batt;

    if (d_sat > 0.99) {
        d_sat = 0.99; // duty cycle maximum value
    }
    ton_sat = d_sat/freq;
    toff_sat = (1/freq)-ton_sat;
    ton_sat = ton_sat*1000;
    toff_sat = toff_sat*1000;

    d = 0;
    c = 0;
    tstep = tramp/N;                     //step time calculation
    while(c < (int)N) {
        
        d = d + (d_sat/(tramp/1000));           //duty cycle increment
        if (d>d_sat){d=d_sat;}
        ton = d/freq;
        toff = (1/freq)-ton;             //calculation of time off
        ton = ton*1000;
        toff = toff*1000;
        if(toff < toff_sat) {            //toff saturation
            toff = toff_sat;
        }
        Ncycles = (int)(tstep/(ton+toff));   //calculation of the number of cycles
        i = 0;
        while(i < Ncycles) {
            pw();
            i++;
        }
        c++;
    }



    while(1) {

        d = d_sat;            // 0>d<1 duty cycle
        ton = d/freq;
        toff = (1/freq)-ton;
        ton = ton*1000;
        toff = toff*1000;
        if( (led3==1)||(led1==1) ) {
            break;
        }
        pw();
    }
    RemoteLED = 0;
    NVIC_SystemReset();
}