Betterfrost / Mbed 2 deprecated timer_based_1kHz_ramp

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Fork of BoxBrovoEcho_OCt3 by Betterfrost

main.cpp@4:2c5dbea00157, 2018-09-12 (annotated)

Committer:
rafael210
Date:
Wed Sep 12 16:37:35 2018 +0000
Revision:
4:2c5dbea00157
Parent:
3:d56766563719
Child:
5:0d28bca5dd26
New version

Who changed what in which revision?

UserRevisionLine numberNew contents of line
rafael210 0:b265ed6faf6c 1 #include "mbed.h"
rafael210 1:fa78d980522c 2 #include "math.h"
hsarfraz 2:98bc0c7668e3 3
rafael210 0:b265ed6faf6c 4 Ticker scheduler1;
rafael210 0:b265ed6faf6c 5 Ticker scheduler2;
rafael210 0:b265ed6faf6c 6 Ticker scheduler3;
rafael210 0:b265ed6faf6c 7 Ticker scheduler4;
rafael210 0:b265ed6faf6c 8
rafael210 1:fa78d980522c 9 Serial pc(USBTX, USBRX); // tx, rx
rafael210 1:fa78d980522c 10
rafael210 1:fa78d980522c 11 DigitalOut task_1_pin(p8, 0);
rafael210 1:fa78d980522c 12 DigitalOut task_2_pin(p9, 0);
hsarfraz 2:98bc0c7668e3 13 DigitalOut task_3_pin(p10, 0);
rafael210 1:fa78d980522c 14
hsarfraz 2:98bc0c7668e3 15 DigitalOut THY_S(p5, 0);
hsarfraz 2:98bc0c7668e3 16 DigitalOut IGBT_G(p6, 0);
hsarfraz 2:98bc0c7668e3 17
rafael210 0:b265ed6faf6c 18 DigitalOut led1(LED1, 0);
rafael210 0:b265ed6faf6c 19 DigitalOut led2(LED2, 0);
rafael210 1:fa78d980522c 20 DigitalOut led3(LED3, 0);
rafael210 3:d56766563719 21 DigitalOut led4(LED4, 0);
rafael210 0:b265ed6faf6c 22
hsarfraz 2:98bc0c7668e3 23 InterruptIn ButtonPress(p21);
rafael210 1:fa78d980522c 24
rafael210 1:fa78d980522c 25 AnalogIn current(p15);
rafael210 3:d56766563719 26 AnalogIn voltage(p16);
rafael210 1:fa78d980522c 27
hsarfraz 2:98bc0c7668e3 28 // ------------------------- Main Parameters ------------------------------- //
rafael210 3:d56766563719 29 float resistance = 10.0;
hsarfraz 2:98bc0c7668e3 30 float V_batt = 160.0;
rafael210 3:d56766563719 31 float I_out = 10.0;
hsarfraz 2:98bc0c7668e3 32 float V_out = 0.0;
rafael210 4:2c5dbea00157 33 float freq = 30; //switching frequency in Hz
rafael210 1:fa78d980522c 34
hsarfraz 2:98bc0c7668e3 35 // -------------------- Current Sensor Parameters --------------------------- //
rafael210 3:d56766563719 36 float HSens_gain = 31;
rafael210 4:2c5dbea00157 37 float I_LIMIT = 15.0;
rafael210 3:d56766563719 38 float i_offset = 0.58;
rafael210 1:fa78d980522c 39 float i_load = 0;
rafael210 3:d56766563719 40 float i_load_sum = 0;
rafael210 3:d56766563719 41 float i_load_avg = 0;
hsarfraz 2:98bc0c7668e3 42 float i_loadpre = 0;
hsarfraz 2:98bc0c7668e3 43 float i_avg = 0;
hsarfraz 2:98bc0c7668e3 44 float i_sum = 0;
hsarfraz 2:98bc0c7668e3 45 int NUM_SAMPLES = 5;
hsarfraz 2:98bc0c7668e3 46 int count = 0;
rafael210 1:fa78d980522c 47 int c_i = 0;
hsarfraz 2:98bc0c7668e3 48 int a = 0;
rafael210 3:d56766563719 49 int avg_c = 0;
rafael210 3:d56766563719 50 float v_in = 0;
rafael210 3:d56766563719 51 int once = 0;
rafael210 1:fa78d980522c 52
rafael210 1:fa78d980522c 53 // ------------------------- Ramp up parameters ----------------------------- //
rafael210 3:d56766563719 54 float N = 20; // number of steps
rafael210 3:d56766563719 55 float tramp = 5000; // ramp time in ms
rafael210 1:fa78d980522c 56 float tstep = 0; // step time
hsarfraz 2:98bc0c7668e3 57 float toff = 1; // cycle off time
hsarfraz 2:98bc0c7668e3 58 float ton_sat = 0; // ON time saturation value
hsarfraz 2:98bc0c7668e3 59 float toff_sat = 0; // OFF time saturation value - determines the final duty cycle
hsarfraz 2:98bc0c7668e3 60 float ton = 1; // on time
rafael210 1:fa78d980522c 61 float d = 0; // duty cycle starting point
hsarfraz 2:98bc0c7668e3 62 float d_sat = 0.0; // determines the final duty cycle
rafael210 1:fa78d980522c 63 int c = 0; // step counter
rafael210 1:fa78d980522c 64 int i = 0; // cycle counter
rafael210 1:fa78d980522c 65 int Ncycles = 0; // Number of cycles
rafael210 1:fa78d980522c 66
rafael210 1:fa78d980522c 67
hsarfraz 2:98bc0c7668e3 68
hsarfraz 2:98bc0c7668e3 69 // ----------------------------- Task 1 ------------------------------------- //
hsarfraz 2:98bc0c7668e3 70 // ----------------Current reading and limit testing---------------------------
hsarfraz 2:98bc0c7668e3 71 void task1()
hsarfraz 2:98bc0c7668e3 72 {
rafael210 3:d56766563719 73 task_1_pin = !task_1_pin;
rafael210 3:d56766563719 74 i_load = HSens_gain *3.3*(v_in/3)*( (1.0-current.read())- (1-(v_in*0.5/3)));
rafael210 4:2c5dbea00157 75
rafael210 4:2c5dbea00157 76
rafael210 3:d56766563719 77 if(i_load_avg > I_LIMIT) //Overcurrrent
rafael210 3:d56766563719 78 {
hsarfraz 2:98bc0c7668e3 79 c_i++;
rafael210 3:d56766563719 80 if(c_i == 5)
rafael210 3:d56766563719 81 {
rafael210 3:d56766563719 82
rafael210 3:d56766563719 83 led3 = 1;
hsarfraz 2:98bc0c7668e3 84 c_i = 0;
hsarfraz 2:98bc0c7668e3 85 }
hsarfraz 2:98bc0c7668e3 86 }
rafael210 3:d56766563719 87
rafael210 3:d56766563719 88 if((abs(i_load_avg-i_loadpre) > 1)&&(i_loadpre != 0)) // resistance checking
rafael210 3:d56766563719 89 {
rafael210 3:d56766563719 90 led2 = 1;
rafael210 3:d56766563719 91 }
rafael210 3:d56766563719 92
rafael210 3:d56766563719 93
rafael210 3:d56766563719 94
rafael210 3:d56766563719 95
rafael210 3:d56766563719 96
rafael210 3:d56766563719 97 avg_c++;
rafael210 3:d56766563719 98 i_load_sum = i_load_sum + i_load; //integration
rafael210 4:2c5dbea00157 99 if(avg_c == (int)(1/freq/0.0001))
rafael210 3:d56766563719 100 {
rafael210 3:d56766563719 101 avg_c = 0;
rafael210 4:2c5dbea00157 102 i_load_avg = (i_load_sum/(1/freq/0.0001));
rafael210 3:d56766563719 103 i_load_sum = 0;
rafael210 3:d56766563719 104 }
rafael210 3:d56766563719 105
hsarfraz 2:98bc0c7668e3 106 }
hsarfraz 2:98bc0c7668e3 107
rafael210 1:fa78d980522c 108
hsarfraz 2:98bc0c7668e3 109 // ----------------------------- Task 2 ------------------------------------- //
hsarfraz 2:98bc0c7668e3 110 //------------------------Serial communication----------------------------------
hsarfraz 2:98bc0c7668e3 111 void task2()
hsarfraz 2:98bc0c7668e3 112 {
hsarfraz 2:98bc0c7668e3 113 task_2_pin = !task_2_pin;
rafael210 3:d56766563719 114 pc.printf("\r %f", i_load_avg );
rafael210 3:d56766563719 115 //pc.printf("\r %f", v_in);
rafael210 3:d56766563719 116 //pc.printf("\r %f", i_loadpre );
hsarfraz 2:98bc0c7668e3 117 }
hsarfraz 2:98bc0c7668e3 118
hsarfraz 2:98bc0c7668e3 119
hsarfraz 2:98bc0c7668e3 120 // ------------------------------ Task 3 ------------------------------------- //
hsarfraz 2:98bc0c7668e3 121 //----------------------------Remote Control----------------------------------
hsarfraz 2:98bc0c7668e3 122 void button()
hsarfraz 2:98bc0c7668e3 123 {
rafael210 3:d56766563719 124 led1 = !led1;
hsarfraz 2:98bc0c7668e3 125 }
hsarfraz 2:98bc0c7668e3 126 void task3()
hsarfraz 2:98bc0c7668e3 127 {
hsarfraz 2:98bc0c7668e3 128 task_3_pin = !task_3_pin;
rafael210 3:d56766563719 129 ButtonPress.rise(&button);
rafael210 3:d56766563719 130 v_in = 3.3*(voltage.read());
hsarfraz 2:98bc0c7668e3 131 }
rafael210 1:fa78d980522c 132
rafael210 1:fa78d980522c 133
hsarfraz 2:98bc0c7668e3 134 // ------------------------------ Task 4 ------------------------------------- //
hsarfraz 2:98bc0c7668e3 135 //----------------------------XXXXXXXXXXXXXXX----------------------------------
hsarfraz 2:98bc0c7668e3 136 void task4()
hsarfraz 2:98bc0c7668e3 137 {
rafael210 3:d56766563719 138 //led2 = !led2;
hsarfraz 2:98bc0c7668e3 139 }
rafael210 1:fa78d980522c 140
hsarfraz 2:98bc0c7668e3 141 // -------------------------- Power Convertor ------------------------------- //
hsarfraz 2:98bc0c7668e3 142 void pw()
hsarfraz 2:98bc0c7668e3 143 {
hsarfraz 2:98bc0c7668e3 144 IGBT_G= 1; // set IGBT Ground side pin to high
hsarfraz 2:98bc0c7668e3 145 wait_us(50);
hsarfraz 2:98bc0c7668e3 146 THY_S= 1;
hsarfraz 2:98bc0c7668e3 147 wait_us(10);
hsarfraz 2:98bc0c7668e3 148 THY_S= 0;
hsarfraz 2:98bc0c7668e3 149 wait_us(200);
hsarfraz 2:98bc0c7668e3 150 wait_ms(ton);
hsarfraz 2:98bc0c7668e3 151 IGBT_G.write(0);
hsarfraz 2:98bc0c7668e3 152 wait_ms(toff);
hsarfraz 2:98bc0c7668e3 153 }
hsarfraz 2:98bc0c7668e3 154
hsarfraz 2:98bc0c7668e3 155 // ------------------------------- MAIN ------------------------------------- //
hsarfraz 2:98bc0c7668e3 156 int main()
hsarfraz 2:98bc0c7668e3 157 {
hsarfraz 2:98bc0c7668e3 158 pc.baud (115200);
hsarfraz 2:98bc0c7668e3 159 NVIC_SetPriority(TIMER3_IRQn, 0);
hsarfraz 2:98bc0c7668e3 160 // set mbed tickers to higher priority than other things
hsarfraz 2:98bc0c7668e3 161
hsarfraz 2:98bc0c7668e3 162 task_1_pin = 0;
hsarfraz 2:98bc0c7668e3 163 task_2_pin = 0;
hsarfraz 2:98bc0c7668e3 164 task_2_pin = 0;
hsarfraz 2:98bc0c7668e3 165 THY_S = 0;
hsarfraz 2:98bc0c7668e3 166 IGBT_G = 0;
hsarfraz 2:98bc0c7668e3 167 led1 = 0;
hsarfraz 2:98bc0c7668e3 168 led2 = 0;
hsarfraz 2:98bc0c7668e3 169 led3 = 0;
rafael210 3:d56766563719 170 led4 = 0;
hsarfraz 2:98bc0c7668e3 171
hsarfraz 2:98bc0c7668e3 172 scheduler1.attach(&task1, 0.0001); // R check
hsarfraz 2:98bc0c7668e3 173 scheduler2.attach(&task2, 0.2); // Reading Hall Sensor
hsarfraz 2:98bc0c7668e3 174 scheduler3.attach(&task3, 0.5); // Turn OFF Power
hsarfraz 2:98bc0c7668e3 175 //scheduler4.attach(&task4, 0.01); //
hsarfraz 2:98bc0c7668e3 176
hsarfraz 2:98bc0c7668e3 177
hsarfraz 2:98bc0c7668e3 178 /* Remote Start Prompt */
rafael210 3:d56766563719 179
hsarfraz 2:98bc0c7668e3 180 while(1) {
hsarfraz 2:98bc0c7668e3 181 if(led1==1) {
hsarfraz 2:98bc0c7668e3 182 break; // Waiting for start Button (pin21)
hsarfraz 2:98bc0c7668e3 183 }
hsarfraz 2:98bc0c7668e3 184 }
hsarfraz 2:98bc0c7668e3 185 led1 = 0;
rafael210 3:d56766563719 186 led2 = 0;
rafael210 3:d56766563719 187 wait_ms(1);
hsarfraz 2:98bc0c7668e3 188
hsarfraz 2:98bc0c7668e3 189
rafael210 3:d56766563719 190 //--------Ramp up Start ----------//
hsarfraz 2:98bc0c7668e3 191
hsarfraz 2:98bc0c7668e3 192 d_sat = resistance*I_out/V_batt;
hsarfraz 2:98bc0c7668e3 193
hsarfraz 2:98bc0c7668e3 194 if (d_sat > 0.99) {
hsarfraz 2:98bc0c7668e3 195 d_sat = 0.99; // duty cycle maximum value
hsarfraz 2:98bc0c7668e3 196 }
hsarfraz 2:98bc0c7668e3 197 ton_sat = d_sat/freq;
hsarfraz 2:98bc0c7668e3 198 toff_sat = (1/freq)-ton_sat;
hsarfraz 2:98bc0c7668e3 199 ton_sat = ton_sat*1000;
hsarfraz 2:98bc0c7668e3 200 toff_sat = toff_sat*1000;
hsarfraz 2:98bc0c7668e3 201
hsarfraz 2:98bc0c7668e3 202 d = 0;
hsarfraz 2:98bc0c7668e3 203 c = 0;
hsarfraz 2:98bc0c7668e3 204 tstep = tramp/N; //step time calculation
hsarfraz 2:98bc0c7668e3 205 while(c < (int)N) {
hsarfraz 2:98bc0c7668e3 206
rafael210 3:d56766563719 207 //d = d + (d_sat/(tramp/1000)); //duty cycle increment
rafael210 3:d56766563719 208 d = d + (d_sat/N); //duty cycle increment
hsarfraz 2:98bc0c7668e3 209 if (d>d_sat){d=d_sat;}
hsarfraz 2:98bc0c7668e3 210 ton = d/freq;
hsarfraz 2:98bc0c7668e3 211 toff = (1/freq)-ton; //calculation of time off
hsarfraz 2:98bc0c7668e3 212 ton = ton*1000;
rafael210 3:d56766563719 213 toff = toff*1000;
hsarfraz 2:98bc0c7668e3 214 Ncycles = (int)(tstep/(ton+toff)); //calculation of the number of cycles
hsarfraz 2:98bc0c7668e3 215 i = 0;
hsarfraz 2:98bc0c7668e3 216 while(i < Ncycles) {
hsarfraz 2:98bc0c7668e3 217 pw();
hsarfraz 2:98bc0c7668e3 218 i++;
hsarfraz 2:98bc0c7668e3 219 }
hsarfraz 2:98bc0c7668e3 220 c++;
hsarfraz 2:98bc0c7668e3 221 }
rafael210 3:d56766563719 222 //led3 = 0;
rafael210 3:d56766563719 223 led4 = 1; //indicates the ramp up is done
rafael210 3:d56766563719 224 //--------Ramp up End ----------//
rafael210 1:fa78d980522c 225
hsarfraz 2:98bc0c7668e3 226 while(1) {
rafael210 0:b265ed6faf6c 227
hsarfraz 2:98bc0c7668e3 228 d = d_sat; // 0>d<1 duty cycle
rafael210 1:fa78d980522c 229 ton = d/freq;
rafael210 1:fa78d980522c 230 toff = (1/freq)-ton;
rafael210 1:fa78d980522c 231 ton = ton*1000;
rafael210 1:fa78d980522c 232 toff = toff*1000;
rafael210 3:d56766563719 233
rafael210 3:d56766563719 234 if((led1 == 1)||(led2 == 1)||(led3 == 1)) //test conditions for break
rafael210 3:d56766563719 235 {
rafael210 1:fa78d980522c 236 break;
rafael210 3:d56766563719 237 }
rafael210 3:d56766563719 238
hsarfraz 2:98bc0c7668e3 239 pw();
rafael210 3:d56766563719 240 if(once==0)
rafael210 3:d56766563719 241 {
rafael210 3:d56766563719 242 once = 1;
rafael210 3:d56766563719 243 i_loadpre = i_load_avg; //acquire reference value
rafael210 3:d56766563719 244 }
rafael210 0:b265ed6faf6c 245 }
rafael210 3:d56766563719 246
rafael210 3:d56766563719 247 while(1) // wait for the remote signal before resetting
rafael210 3:d56766563719 248 {
rafael210 3:d56766563719 249 if(led1 == 1)
rafael210 3:d56766563719 250 {
rafael210 3:d56766563719 251 break;
rafael210 3:d56766563719 252 }
rafael210 3:d56766563719 253 }
rafael210 3:d56766563719 254
rafael210 3:d56766563719 255 NVIC_SystemReset();
rafael210 3:d56766563719 256
rafael210 0:b265ed6faf6c 257 }