Hochschule München
/
PowerDriverforH2m
Mosfet Driver
main.cpp@4:8c89e422bed7, 2013-05-07 (annotated)
- Committer:
- HMFK03LST1
- Date:
- Tue May 07 07:11:11 2013 +0000
- Revision:
- 4:8c89e422bed7
- Parent:
- 3:af6a6f498276
- Child:
- 5:d814001b8aae
V1.4 rc
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
HMFK03LST1 | 0:4f562ff70d13 | 1 | #include "mbed.h" |
HMFK03LST1 | 0:4f562ff70d13 | 2 | |
HMFK03LST1 | 2:bdd944abaf86 | 3 | LocalFileSystem local("local"); //init Flashdrive for reading config file |
HMFK03LST1 | 2:bdd944abaf86 | 4 | FILE *fp; //Pointer to local Config File |
HMFK03LST1 | 0:4f562ff70d13 | 5 | |
HMFK03LST1 | 0:4f562ff70d13 | 6 | #define USR_POWERDOWN (0x104) //Power Down Mbed Interface (save 50% or 45 mA) |
HMFK03LST1 | 0:4f562ff70d13 | 7 | |
HMFK03LST1 | 2:bdd944abaf86 | 8 | float version = 0.8; //Program Version |
HMFK03LST1 | 2:bdd944abaf86 | 9 | |
HMFK03LST1 | 2:bdd944abaf86 | 10 | bool mosfet1_open = true ; //Mosfet1 geschlossen |
HMFK03LST1 | 2:bdd944abaf86 | 11 | bool mosfet1_close = false; //Mosfet1 offen |
HMFK03LST1 | 1:19d350e383e6 | 12 | |
HMFK03LST1 | 0:4f562ff70d13 | 13 | DigitalOut myled (LED1); |
HMFK03LST1 | 0:4f562ff70d13 | 14 | DigitalOut myled1 (LED2); |
HMFK03LST1 | 0:4f562ff70d13 | 15 | DigitalOut myled2 (LED3); |
HMFK03LST1 | 1:19d350e383e6 | 16 | DigitalOut myled3 (LED4); |
HMFK03LST1 | 0:4f562ff70d13 | 17 | |
HMFK03LST1 | 0:4f562ff70d13 | 18 | DigitalOut purge (p33); |
HMFK03LST1 | 0:4f562ff70d13 | 19 | DigitalOut pump (p34); |
HMFK03LST1 | 0:4f562ff70d13 | 20 | DigitalOut mosfet1(p35); |
HMFK03LST1 | 0:4f562ff70d13 | 21 | DigitalOut mosfet2(p36); |
HMFK03LST1 | 0:4f562ff70d13 | 22 | DigitalIn In1 (p30); |
HMFK03LST1 | 0:4f562ff70d13 | 23 | DigitalIn In2 (p29); |
HMFK03LST1 | 0:4f562ff70d13 | 24 | DigitalIn In3 (p28); |
HMFK03LST1 | 0:4f562ff70d13 | 25 | DigitalIn In4 (p27); |
HMFK03LST1 | 0:4f562ff70d13 | 26 | AnalogIn AI1 (p17); |
HMFK03LST1 | 2:bdd944abaf86 | 27 | AnalogIn cur_in (p18); |
HMFK03LST1 | 0:4f562ff70d13 | 28 | AnalogIn bz_in (p19); |
HMFK03LST1 | 0:4f562ff70d13 | 29 | AnalogIn cap_in (p20); |
HMFK03LST1 | 0:4f562ff70d13 | 30 | |
HMFK03LST1 | 0:4f562ff70d13 | 31 | Serial pc(USBTX, USBRX); |
HMFK03LST1 | 2:bdd944abaf86 | 32 | Ticker PC_OUT_timer; // Output Monitoring to Serial |
HMFK03LST1 | 2:bdd944abaf86 | 33 | Ticker LED_timer; // Set Status LED´s |
HMFK03LST1 | 1:19d350e383e6 | 34 | |
HMFK03LST1 | 0:4f562ff70d13 | 35 | Timer t; |
HMFK03LST1 | 0:4f562ff70d13 | 36 | |
HMFK03LST1 | 2:bdd944abaf86 | 37 | |
HMFK03LST1 | 2:bdd944abaf86 | 38 | // Brennstoffzellen Parameter |
HMFK03LST1 | 2:bdd944abaf86 | 39 | float bz_max = 30.5; //Brennstoffzelle Spannung Abs. max. |
HMFK03LST1 | 3:af6a6f498276 | 40 | float bz_p_oben = 15.0; //Brennstoffzelle Prozent Load bei bz_max |
HMFK03LST1 | 2:bdd944abaf86 | 41 | float bz_on = 29.0; //Brennstoffzelle Spannung für Ladefreigabe) |
HMFK03LST1 | 2:bdd944abaf86 | 42 | float bz_min = 26.0; //Brennstoffzelle Spannung min. Laden beenden |
HMFK03LST1 | 2:bdd944abaf86 | 43 | float bz_p_unten = -20.0; //Brennstoffzelle Prozent Load bei bz_min |
HMFK03LST1 | 2:bdd944abaf86 | 44 | float bz_current = 1.5; //Brennstoffzellen Strom nominal |
HMFK03LST1 | 3:af6a6f498276 | 45 | float bz_cur_add = 2.0; //Brennstoffzellen Strom max |
HMFK03LST1 | 3:af6a6f498276 | 46 | float bz_c_i_max = 20.0; //Strom Integrale Reglung Max % |
HMFK03LST1 | 3:af6a6f498276 | 47 | float bz_c_i_min = -10.0; //Strom Integrale Reglung Min % |
HMFK03LST1 | 2:bdd944abaf86 | 48 | |
HMFK03LST1 | 2:bdd944abaf86 | 49 | // SuperCap Parameter |
HMFK03LST1 | 2:bdd944abaf86 | 50 | float cap_max = 25.0; //CAP Spannung max. (Abschaltung) |
HMFK03LST1 | 3:af6a6f498276 | 51 | float cap_p_max = 90.0; //CAP Prozent Load bei 0V |
HMFK03LST1 | 2:bdd944abaf86 | 52 | float cap_min = 20.0; //CAP Spannung min. (Zelle an) |
HMFK03LST1 | 3:af6a6f498276 | 53 | float cap_p_min = 5.0; //CAP Prozent Load bei 0V |
HMFK03LST1 | 2:bdd944abaf86 | 54 | float cap_delta = 1.5; //Absenkung der Spannung mit Din |
HMFK03LST1 | 0:4f562ff70d13 | 55 | |
HMFK03LST1 | 2:bdd944abaf86 | 56 | // Pump & Purge Parameter |
HMFK03LST1 | 2:bdd944abaf86 | 57 | float purge_start = 3.0; //s before starting purch |
HMFK03LST1 | 2:bdd944abaf86 | 58 | float purge_end = 3.2; //s after finishing purch |
HMFK03LST1 | 2:bdd944abaf86 | 59 | float boost_time = 0.2; //s Pump runup with 100% Duty Cycle |
HMFK03LST1 | 2:bdd944abaf86 | 60 | int pwm_cycle = 20; //ms für PWM Period |
HMFK03LST1 | 2:bdd944abaf86 | 61 | int pwm_on = 12; //ms für PWM high |
HMFK03LST1 | 2:bdd944abaf86 | 62 | |
HMFK03LST1 | 2:bdd944abaf86 | 63 | // Monitoring Parameter |
HMFK03LST1 | 2:bdd944abaf86 | 64 | int debug = 1; //Serial Output on (1) |
HMFK03LST1 | 2:bdd944abaf86 | 65 | float sample = 5; //Serial Output Samples per Second |
HMFK03LST1 | 0:4f562ff70d13 | 66 | |
HMFK03LST1 | 2:bdd944abaf86 | 67 | // Temp Variable |
HMFK03LST1 | 2:bdd944abaf86 | 68 | bool Load = false; //Laderegler aktiv |
HMFK03LST1 | 2:bdd944abaf86 | 69 | bool pump_on = false; //Pumpenzustand |
HMFK03LST1 | 2:bdd944abaf86 | 70 | int boost = 0; //Number of PWM-Cycles for Pump runup boost calc in load_cfg |
HMFK03LST1 | 3:af6a6f498276 | 71 | int Cel_Level = 0; //% Load aus Bz Spannung |
HMFK03LST1 | 2:bdd944abaf86 | 72 | int Cap_Level = 0; //% Load aus Cap Spannung |
HMFK03LST1 | 2:bdd944abaf86 | 73 | int Cur_Level = 0; |
HMFK03LST1 | 2:bdd944abaf86 | 74 | int Load_Level = 0; //% Load aus Bz und Cap |
HMFK03LST1 | 2:bdd944abaf86 | 75 | float bz = 0; //Spannung Brennstoffzelle |
HMFK03LST1 | 2:bdd944abaf86 | 76 | float cap = 0; //Spannung SuperCap |
HMFK03LST1 | 2:bdd944abaf86 | 77 | float current = 0; //Strom in den Mosfet |
HMFK03LST1 | 2:bdd944abaf86 | 78 | unsigned int counter_cycle = 0; //Counter PWM-Cycles for Pump-Purge |
HMFK03LST1 | 2:bdd944abaf86 | 79 | unsigned int counter_ms = 0; //Counter for PWM Pump |
HMFK03LST1 | 0:4f562ff70d13 | 80 | |
HMFK03LST1 | 2:bdd944abaf86 | 81 | |
HMFK03LST1 | 0:4f562ff70d13 | 82 | void load_cfg() |
HMFK03LST1 | 0:4f562ff70d13 | 83 | { |
HMFK03LST1 | 3:af6a6f498276 | 84 | char read[24][5]; |
HMFK03LST1 | 0:4f562ff70d13 | 85 | |
HMFK03LST1 | 0:4f562ff70d13 | 86 | char i = 0; |
HMFK03LST1 | 0:4f562ff70d13 | 87 | char j = 0; |
HMFK03LST1 | 0:4f562ff70d13 | 88 | int c = 0; |
HMFK03LST1 | 0:4f562ff70d13 | 89 | float temp; |
HMFK03LST1 | 0:4f562ff70d13 | 90 | |
HMFK03LST1 | 3:af6a6f498276 | 91 | for (j = 0; j<24; j++) |
HMFK03LST1 | 0:4f562ff70d13 | 92 | { |
HMFK03LST1 | 2:bdd944abaf86 | 93 | for (i = 0; i<8; i++) |
HMFK03LST1 | 0:4f562ff70d13 | 94 | { |
HMFK03LST1 | 0:4f562ff70d13 | 95 | read[j][i] = '\0'; |
HMFK03LST1 | 0:4f562ff70d13 | 96 | } |
HMFK03LST1 | 0:4f562ff70d13 | 97 | } |
HMFK03LST1 | 0:4f562ff70d13 | 98 | |
HMFK03LST1 | 0:4f562ff70d13 | 99 | i=0; |
HMFK03LST1 | 0:4f562ff70d13 | 100 | j=0; |
HMFK03LST1 | 0:4f562ff70d13 | 101 | |
HMFK03LST1 | 0:4f562ff70d13 | 102 | fp = fopen("/local/power.cfg", "r"); |
HMFK03LST1 | 0:4f562ff70d13 | 103 | if ( fp != NULL ) |
HMFK03LST1 | 0:4f562ff70d13 | 104 | { |
HMFK03LST1 | 0:4f562ff70d13 | 105 | while((c != EOF) && (c !=10)) |
HMFK03LST1 | 0:4f562ff70d13 | 106 | { |
HMFK03LST1 | 0:4f562ff70d13 | 107 | c = fgetc(fp); |
HMFK03LST1 | 0:4f562ff70d13 | 108 | if (c == ';'){read[j][0] = i; i = 0; j++;} |
HMFK03LST1 | 0:4f562ff70d13 | 109 | else {i++; read[j][i] = c;} |
HMFK03LST1 | 0:4f562ff70d13 | 110 | } |
HMFK03LST1 | 0:4f562ff70d13 | 111 | fclose(fp); |
HMFK03LST1 | 0:4f562ff70d13 | 112 | |
HMFK03LST1 | 0:4f562ff70d13 | 113 | |
HMFK03LST1 | 2:bdd944abaf86 | 114 | sscanf(&read[ 0][1], "%f", &temp); bz_max = temp; |
HMFK03LST1 | 2:bdd944abaf86 | 115 | sscanf(&read[ 1][1], "%f", &temp); bz_p_oben = temp; |
HMFK03LST1 | 2:bdd944abaf86 | 116 | sscanf(&read[ 2][1], "%f", &temp); bz_on = temp; |
HMFK03LST1 | 2:bdd944abaf86 | 117 | sscanf(&read[ 3][1], "%f", &temp); bz_min = temp; |
HMFK03LST1 | 2:bdd944abaf86 | 118 | sscanf(&read[ 4][1], "%f", &temp); bz_p_unten = temp; |
HMFK03LST1 | 3:af6a6f498276 | 119 | sscanf(&read[ 5][1], "%f", &temp); bz_current = temp; |
HMFK03LST1 | 3:af6a6f498276 | 120 | sscanf(&read[ 6][1], "%f", &temp); bz_cur_add = temp; |
HMFK03LST1 | 3:af6a6f498276 | 121 | sscanf(&read[ 7][1], "%f", &temp); bz_c_i_max = temp; |
HMFK03LST1 | 3:af6a6f498276 | 122 | sscanf(&read[ 8][1], "%f", &temp); bz_c_i_min = temp; |
HMFK03LST1 | 3:af6a6f498276 | 123 | |
HMFK03LST1 | 3:af6a6f498276 | 124 | sscanf(&read[ 9][1], "%f", &temp); cap_max = temp; |
HMFK03LST1 | 3:af6a6f498276 | 125 | sscanf(&read[10][1], "%f", &temp); cap_p_max = temp; |
HMFK03LST1 | 3:af6a6f498276 | 126 | sscanf(&read[11][1], "%f", &temp); cap_min = temp; |
HMFK03LST1 | 3:af6a6f498276 | 127 | sscanf(&read[12][1], "%f", &temp); cap_p_min = temp; |
HMFK03LST1 | 3:af6a6f498276 | 128 | sscanf(&read[13][1], "%f", &temp); cap_delta = temp; |
HMFK03LST1 | 3:af6a6f498276 | 129 | |
HMFK03LST1 | 3:af6a6f498276 | 130 | sscanf(&read[14][1], "%f", &temp); purge_start = temp; |
HMFK03LST1 | 3:af6a6f498276 | 131 | sscanf(&read[15][1], "%f", &temp); purge_end = temp; |
HMFK03LST1 | 3:af6a6f498276 | 132 | sscanf(&read[16][1], "%f", &temp); boost_time = temp; |
HMFK03LST1 | 3:af6a6f498276 | 133 | sscanf(&read[17][1], "%f", &temp); pwm_cycle = temp; |
HMFK03LST1 | 3:af6a6f498276 | 134 | sscanf(&read[18][1], "%f", &temp); pwm_on = temp; |
HMFK03LST1 | 3:af6a6f498276 | 135 | |
HMFK03LST1 | 3:af6a6f498276 | 136 | sscanf(&read[19][1], "%f", &temp); debug = temp; |
HMFK03LST1 | 3:af6a6f498276 | 137 | sscanf(&read[20][1], "%f", &temp); sample = temp; |
HMFK03LST1 | 0:4f562ff70d13 | 138 | |
HMFK03LST1 | 2:bdd944abaf86 | 139 | boost = (boost_time * 1000) / pwm_cycle; |
HMFK03LST1 | 2:bdd944abaf86 | 140 | } |
HMFK03LST1 | 0:4f562ff70d13 | 141 | |
HMFK03LST1 | 2:bdd944abaf86 | 142 | pc.printf("\n\r" ); |
HMFK03LST1 | 3:af6a6f498276 | 143 | pc.printf("******************************** \n\r" ); |
HMFK03LST1 | 2:bdd944abaf86 | 144 | pc.printf("* Brennstoffzellenregler V%03.1f * \n\r",version); |
HMFK03LST1 | 3:af6a6f498276 | 145 | pc.printf("******************************** \n\r" ); |
HMFK03LST1 | 3:af6a6f498276 | 146 | pc.printf("--------------BZ---------------- \n\r" ); |
HMFK03LST1 | 4:8c89e422bed7 | 147 | pc.printf(" BZ max [V] : %5.1f \n\r",bz_max ); |
HMFK03LST1 | 4:8c89e422bed7 | 148 | pc.printf(" BZ max [%c] : %5.1f \n\r",37,bz_p_oben ); |
HMFK03LST1 | 4:8c89e422bed7 | 149 | pc.printf(" BZ Laden on [V] : %5.1f \n\r",bz_on ); |
HMFK03LST1 | 4:8c89e422bed7 | 150 | pc.printf(" BZ Laden off [V] : %5.1f \n\r",bz_min ); |
HMFK03LST1 | 4:8c89e422bed7 | 151 | pc.printf(" BZ Laden off [%c] : %5.1f \n\r",37,bz_p_unten ); |
HMFK03LST1 | 4:8c89e422bed7 | 152 | pc.printf(" BZ Strom norm [A] : %5.1f \n\r",bz_current ); |
HMFK03LST1 | 4:8c89e422bed7 | 153 | pc.printf(" BZ Strom max. [A] : %5.1f \n\r",bz_cur_add ); |
HMFK03LST1 | 4:8c89e422bed7 | 154 | pc.printf(" BZ Strom I max.[%c] : %5.1f \n\r",37,bz_c_i_max ); |
HMFK03LST1 | 4:8c89e422bed7 | 155 | pc.printf(" BZ Strom I min.[%c] : %5.1f \n\r",37,bz_c_i_min ); |
HMFK03LST1 | 3:af6a6f498276 | 156 | pc.printf("-------------CAP---------------- \n\r" ); |
HMFK03LST1 | 4:8c89e422bed7 | 157 | pc.printf(" CAP max [V] : %5.1f \n\r",cap_max ); |
HMFK03LST1 | 4:8c89e422bed7 | 158 | pc.printf(" CAP max [%c] : %5.1f \n\r",37,cap_p_max ); |
HMFK03LST1 | 4:8c89e422bed7 | 159 | pc.printf(" CAP min [V] : %5.1f \n\r",cap_min ); |
HMFK03LST1 | 4:8c89e422bed7 | 160 | pc.printf(" CAP min [%c] : %5.1f \n\r",37,cap_p_min ); |
HMFK03LST1 | 4:8c89e422bed7 | 161 | pc.printf(" CAP lo on Din [-V]: %5.1f \n\r",cap_delta ); |
HMFK03LST1 | 3:af6a6f498276 | 162 | pc.printf("----------Pump & Purge---------- \n\r" ); |
HMFK03LST1 | 4:8c89e422bed7 | 163 | pc.printf(" Purge on [s] : %5.1f \n\r",purge_start ); |
HMFK03LST1 | 4:8c89e422bed7 | 164 | pc.printf(" Purge off [s] : %5.1f \n\r",purge_end ); |
HMFK03LST1 | 4:8c89e422bed7 | 165 | pc.printf(" Boost [s] : %5.1f \n\r",boost_time ); |
HMFK03LST1 | 4:8c89e422bed7 | 166 | pc.printf(" PWM cycle [ms]: %5d \n\r" ,pwm_cycle ); |
HMFK03LST1 | 4:8c89e422bed7 | 167 | pc.printf(" PWM on [ms]: %5d \n\r" ,pwm_on ); |
HMFK03LST1 | 3:af6a6f498276 | 168 | pc.printf("------------Monitor------------- \n\r" ); |
HMFK03LST1 | 4:8c89e422bed7 | 169 | pc.printf(" Serial output [bool]: %5d \n\r" ,debug ); |
HMFK03LST1 | 4:8c89e422bed7 | 170 | pc.printf(" Samplerate [Hz] : %5.0f \n\r",sample ); |
HMFK03LST1 | 3:af6a6f498276 | 171 | pc.printf("******************************** \n\r" ); |
HMFK03LST1 | 3:af6a6f498276 | 172 | pc.printf("\n\r" ); |
HMFK03LST1 | 0:4f562ff70d13 | 173 | } |
HMFK03LST1 | 0:4f562ff70d13 | 174 | |
HMFK03LST1 | 2:bdd944abaf86 | 175 | |
HMFK03LST1 | 1:19d350e383e6 | 176 | int semihost_powerdown() |
HMFK03LST1 | 1:19d350e383e6 | 177 | { |
HMFK03LST1 | 1:19d350e383e6 | 178 | uint32_t arg; |
HMFK03LST1 | 1:19d350e383e6 | 179 | return __semihost(USR_POWERDOWN, &arg); |
HMFK03LST1 | 1:19d350e383e6 | 180 | } |
HMFK03LST1 | 1:19d350e383e6 | 181 | |
HMFK03LST1 | 2:bdd944abaf86 | 182 | |
HMFK03LST1 | 1:19d350e383e6 | 183 | void SEND() |
HMFK03LST1 | 1:19d350e383e6 | 184 | { |
HMFK03LST1 | 3:af6a6f498276 | 185 | bool status= false; |
HMFK03LST1 | 3:af6a6f498276 | 186 | if (debug == 1) |
HMFK03LST1 | 2:bdd944abaf86 | 187 | { |
HMFK03LST1 | 4:8c89e422bed7 | 188 | if (mosfet1 == mosfet1_close) status = true; |
HMFK03LST1 | 4:8c89e422bed7 | 189 | if (Load == true) mosfet1 = mosfet1_open; |
HMFK03LST1 | 2:bdd944abaf86 | 190 | pc.printf("BZ: %4.1f/%4.1f-%4.1f+%4.1f CAP: %4.1f/%4.1f-%4.1f Purge: %4.1f/%4.1f-%4.1f Load: %03d Current: %4.2f \n\r" |
HMFK03LST1 | 2:bdd944abaf86 | 191 | ,bz,bz_min,bz_on,bz_max,cap,cap_min,cap_max,float(counter_cycle)/(1000/pwm_cycle),purge_start,purge_end,Load_Level, current); |
HMFK03LST1 | 3:af6a6f498276 | 192 | if (status == true) mosfet1 = mosfet1_close; |
HMFK03LST1 | 2:bdd944abaf86 | 193 | } |
HMFK03LST1 | 1:19d350e383e6 | 194 | } |
HMFK03LST1 | 1:19d350e383e6 | 195 | |
HMFK03LST1 | 1:19d350e383e6 | 196 | |
HMFK03LST1 | 1:19d350e383e6 | 197 | void LED() |
HMFK03LST1 | 1:19d350e383e6 | 198 | { |
HMFK03LST1 | 2:bdd944abaf86 | 199 | if (bz < bz_min ) myled = 1; else myled = 0; //LED = Spannung an der BZ IO |
HMFK03LST1 | 1:19d350e383e6 | 200 | if (cap > cap_min) myled1 = 1; else myled1 = 0; //LED = Spannung an den Cap´s IO |
HMFK03LST1 | 4:8c89e422bed7 | 201 | if ((mosfet1 == mosfet1_close) |
HMFK03LST1 | 4:8c89e422bed7 | 202 | &&(Load == true)) myled2 = 1; else myled2 = 0; //LED = Gate Zustand Mosfet 1 |
HMFK03LST1 | 3:af6a6f498276 | 203 | if (pump_on == 1) myled3 = 1; else myled3 = 0; //LED = Pumpe an |
HMFK03LST1 | 1:19d350e383e6 | 204 | } |
HMFK03LST1 | 0:4f562ff70d13 | 205 | |
HMFK03LST1 | 0:4f562ff70d13 | 206 | |
HMFK03LST1 | 1:19d350e383e6 | 207 | void PUMPE() |
HMFK03LST1 | 1:19d350e383e6 | 208 | { |
HMFK03LST1 | 2:bdd944abaf86 | 209 | counter_ms++; |
HMFK03LST1 | 3:af6a6f498276 | 210 | |
HMFK03LST1 | 3:af6a6f498276 | 211 | if ((bz > bz_max) && (cap > (cap_max - (In1 * cap_delta)))) |
HMFK03LST1 | 3:af6a6f498276 | 212 | { |
HMFK03LST1 | 3:af6a6f498276 | 213 | pump_on = false; |
HMFK03LST1 | 3:af6a6f498276 | 214 | } |
HMFK03LST1 | 3:af6a6f498276 | 215 | |
HMFK03LST1 | 3:af6a6f498276 | 216 | |
HMFK03LST1 | 3:af6a6f498276 | 217 | if ((cap <= cap_min) || (pump_on == true)) //Pumpe Einschaltbedingung |
HMFK03LST1 | 2:bdd944abaf86 | 218 | { |
HMFK03LST1 | 1:19d350e383e6 | 219 | pump_on = true; |
HMFK03LST1 | 2:bdd944abaf86 | 220 | if (counter_ms > (pwm_cycle - pwm_on)) pump = 1 ; //Set PWM from low to high |
HMFK03LST1 | 1:19d350e383e6 | 221 | |
HMFK03LST1 | 2:bdd944abaf86 | 222 | if (counter_ms >= pwm_cycle) //End PWM cycle |
HMFK03LST1 | 1:19d350e383e6 | 223 | { |
HMFK03LST1 | 2:bdd944abaf86 | 224 | counter_cycle++; |
HMFK03LST1 | 2:bdd944abaf86 | 225 | counter_ms = 0; |
HMFK03LST1 | 2:bdd944abaf86 | 226 | |
HMFK03LST1 | 1:19d350e383e6 | 227 | if (boost > 0) boost--; |
HMFK03LST1 | 1:19d350e383e6 | 228 | |
HMFK03LST1 | 2:bdd944abaf86 | 229 | if ((counter_cycle < (1000 / pwm_cycle) * purge_start) || (boost <= 0) || (In1 == 0)) |
HMFK03LST1 | 1:19d350e383e6 | 230 | { |
HMFK03LST1 | 2:bdd944abaf86 | 231 | pump = 0; //PWM Betrieb |
HMFK03LST1 | 1:19d350e383e6 | 232 | purge = 0; |
HMFK03LST1 | 1:19d350e383e6 | 233 | } |
HMFK03LST1 | 1:19d350e383e6 | 234 | else |
HMFK03LST1 | 1:19d350e383e6 | 235 | { |
HMFK03LST1 | 2:bdd944abaf86 | 236 | if (pump == 1) purge = 1; //Purge Betrieb |
HMFK03LST1 | 1:19d350e383e6 | 237 | } |
HMFK03LST1 | 1:19d350e383e6 | 238 | |
HMFK03LST1 | 2:bdd944abaf86 | 239 | if (counter_cycle > (1000 / pwm_cycle) * purge_end) //Purge Ende |
HMFK03LST1 | 1:19d350e383e6 | 240 | { |
HMFK03LST1 | 2:bdd944abaf86 | 241 | counter_cycle = 0; |
HMFK03LST1 | 1:19d350e383e6 | 242 | purge = 0; |
HMFK03LST1 | 1:19d350e383e6 | 243 | pump = 0; |
HMFK03LST1 | 1:19d350e383e6 | 244 | } |
HMFK03LST1 | 1:19d350e383e6 | 245 | } |
HMFK03LST1 | 1:19d350e383e6 | 246 | } |
HMFK03LST1 | 1:19d350e383e6 | 247 | else |
HMFK03LST1 | 1:19d350e383e6 | 248 | { |
HMFK03LST1 | 1:19d350e383e6 | 249 | pump_on = 0; pump = 0; purge = 0; //Pumpe aus |
HMFK03LST1 | 1:19d350e383e6 | 250 | boost = (boost_time * 1000) / pwm_cycle; // Boost für nächsten Start setzen |
HMFK03LST1 | 1:19d350e383e6 | 251 | } |
HMFK03LST1 | 0:4f562ff70d13 | 252 | |
HMFK03LST1 | 1:19d350e383e6 | 253 | } |
HMFK03LST1 | 1:19d350e383e6 | 254 | |
HMFK03LST1 | 1:19d350e383e6 | 255 | int main() |
HMFK03LST1 | 2:bdd944abaf86 | 256 | { |
HMFK03LST1 | 0:4f562ff70d13 | 257 | pc.baud(115200); //config Serial Port |
HMFK03LST1 | 0:4f562ff70d13 | 258 | load_cfg(); //init config File |
HMFK03LST1 | 0:4f562ff70d13 | 259 | semihost_powerdown(); //Mbed Interface powerdown |
HMFK03LST1 | 1:19d350e383e6 | 260 | PC_OUT_timer.attach(&SEND , (1/sample)); //Serial output Timer |
HMFK03LST1 | 1:19d350e383e6 | 261 | LED_timer.attach (&LED , 0.200 ); //LED Status Timer |
HMFK03LST1 | 0:4f562ff70d13 | 262 | t.start(); //Timer für PWM starten |
HMFK03LST1 | 2:bdd944abaf86 | 263 | float bz_faktor; //Temp Variable |
HMFK03LST1 | 2:bdd944abaf86 | 264 | |
HMFK03LST1 | 2:bdd944abaf86 | 265 | bz_faktor = ((bz_p_oben - bz_p_unten)/(bz_max - bz_min)); //Prozent Umrechnung BZ |
HMFK03LST1 | 2:bdd944abaf86 | 266 | |
HMFK03LST1 | 2:bdd944abaf86 | 267 | |
HMFK03LST1 | 0:4f562ff70d13 | 268 | |
HMFK03LST1 | 0:4f562ff70d13 | 269 | while(1) |
HMFK03LST1 | 0:4f562ff70d13 | 270 | { |
HMFK03LST1 | 2:bdd944abaf86 | 271 | bz = ((bz_in * 92.0) + bz )/3; //BZ RAW in Spannung umrechnen (2*neu zu 1*alt Glättung) |
HMFK03LST1 | 2:bdd944abaf86 | 272 | cap = ((cap_in * 92.0) + cap)/3; //CAP RAW in Spannung umrechnen (2*neu zu 1*alt Glättung) |
HMFK03LST1 | 3:af6a6f498276 | 273 | current = (cur_in * 23.75) - 4.12; |
HMFK03LST1 | 3:af6a6f498276 | 274 | t.reset(); // Timer für 1 kHz starten |
HMFK03LST1 | 2:bdd944abaf86 | 275 | PUMPE(); //Pumpen PWM aufrufen |
HMFK03LST1 | 3:af6a6f498276 | 276 | |
HMFK03LST1 | 3:af6a6f498276 | 277 | //***Regulate Cell Level*** |
HMFK03LST1 | 3:af6a6f498276 | 278 | Cel_Level = (bz_faktor * (bz - bz_min) + bz_p_unten) * 10; //%Load aus Zellenspannung berechnen |
HMFK03LST1 | 3:af6a6f498276 | 279 | |
HMFK03LST1 | 3:af6a6f498276 | 280 | //***Regulate Cap´s Level*** |
HMFK03LST1 | 4:8c89e422bed7 | 281 | Cap_Level = (((cap / cap_max) * (cap_p_max - cap_p_min)) + cap_p_min) * 10; //%Load aus Cap Level |
HMFK03LST1 | 3:af6a6f498276 | 282 | |
HMFK03LST1 | 3:af6a6f498276 | 283 | //***Regulate Current Level*** |
HMFK03LST1 | 3:af6a6f498276 | 284 | if ((current-(bz_current + (In2 * bz_cur_add))) > 0) |
HMFK03LST1 | 3:af6a6f498276 | 285 | {if (Cur_Level > (bz_c_i_min*10)) Cur_Level--;} //to much Load |
HMFK03LST1 | 3:af6a6f498276 | 286 | else |
HMFK03LST1 | 3:af6a6f498276 | 287 | {if (Cur_Level < (bz_c_i_max*10)) Cur_Level++;} //less Load |
HMFK03LST1 | 3:af6a6f498276 | 288 | |
HMFK03LST1 | 3:af6a6f498276 | 289 | //*** Sum all Regulators |
HMFK03LST1 | 3:af6a6f498276 | 290 | |
HMFK03LST1 | 4:8c89e422bed7 | 291 | Load_Level = Cur_Level; |
HMFK03LST1 | 4:8c89e422bed7 | 292 | Load_Level = Load_Level + Cap_Level; |
HMFK03LST1 | 4:8c89e422bed7 | 293 | Load_Level = Load_Level + Cel_Level; |
HMFK03LST1 | 3:af6a6f498276 | 294 | |
HMFK03LST1 | 2:bdd944abaf86 | 295 | |
HMFK03LST1 | 2:bdd944abaf86 | 296 | if (Load == true) // Laden aktiv |
HMFK03LST1 | 2:bdd944abaf86 | 297 | { |
HMFK03LST1 | 3:af6a6f498276 | 298 | |
HMFK03LST1 | 3:af6a6f498276 | 299 | if (bz > bz_min || bz > bz_max) // Zelle über min. Spannung oder über max Spannung zum Entladen |
HMFK03LST1 | 2:bdd944abaf86 | 300 | { |
HMFK03LST1 | 3:af6a6f498276 | 301 | while (t.read_us() <= 920) // während der PWM (1khz Periode) |
HMFK03LST1 | 2:bdd944abaf86 | 302 | { |
HMFK03LST1 | 2:bdd944abaf86 | 303 | if (t.read_us() < Load_Level) // %Load PWM zu Timer vergleich |
HMFK03LST1 | 2:bdd944abaf86 | 304 | {mosfet1 = mosfet1_close;} // %Load PWM nicht erreicht Mosfet an |
HMFK03LST1 | 2:bdd944abaf86 | 305 | else |
HMFK03LST1 | 2:bdd944abaf86 | 306 | {mosfet1 = mosfet1_open;} // %Load PWM erreicht Mosfet aus |
HMFK03LST1 | 2:bdd944abaf86 | 307 | } |
HMFK03LST1 | 2:bdd944abaf86 | 308 | } |
HMFK03LST1 | 2:bdd944abaf86 | 309 | else |
HMFK03LST1 | 2:bdd944abaf86 | 310 | { |
HMFK03LST1 | 2:bdd944abaf86 | 311 | mosfet1 = mosfet1_open ; // Mosfet wegen Unterspannung BZ auskoppeln |
HMFK03LST1 | 2:bdd944abaf86 | 312 | Load = false; // Laden beenden bis BZ > BZ on (Sicherungsschaltung) |
HMFK03LST1 | 2:bdd944abaf86 | 313 | } |
HMFK03LST1 | 2:bdd944abaf86 | 314 | } |
HMFK03LST1 | 2:bdd944abaf86 | 315 | else |
HMFK03LST1 | 2:bdd944abaf86 | 316 | { |
HMFK03LST1 | 2:bdd944abaf86 | 317 | if (bz >= cap){mosfet1 = mosfet1_open ;} // Mosfet im nicht Ladebetrieb auskoppeln |
HMFK03LST1 | 2:bdd944abaf86 | 318 | else {mosfet1 = mosfet1_close;} // Mosfet im nicht Ladebetrieb einkoppeln (Treiber stromfrei = Stromsparen) |
HMFK03LST1 | 3:af6a6f498276 | 319 | while (t.read_us() <= 920){}; |
HMFK03LST1 | 0:4f562ff70d13 | 320 | } |
HMFK03LST1 | 2:bdd944abaf86 | 321 | |
HMFK03LST1 | 0:4f562ff70d13 | 322 | |
HMFK03LST1 | 3:af6a6f498276 | 323 | if (( cap < cap_min) && (bz > bz_on)) Load = true; // Cap unter Minimum oder BZ über Maximum = Laden beginnen |
HMFK03LST1 | 3:af6a6f498276 | 324 | if ( cap >= cap_max ) Load = false; // |
HMFK03LST1 | 3:af6a6f498276 | 325 | if ( bz > bz_max ) Load = true; // Überladung abführen |
HMFK03LST1 | 0:4f562ff70d13 | 326 | } |
HMFK03LST1 | 0:4f562ff70d13 | 327 | |
HMFK03LST1 | 0:4f562ff70d13 | 328 | } |