Mercurial > public > ostc4
annotate Small_CPU/Src/batteryCharger.c @ 901:e4e9acfde839 Evo_2_23
Bugfix simulator/planer:
For deco calculation two structures are used. The calculation structure and the input structure. During simulation fast forward (+5min) the input structure is manipulated. Especially for vpm calculation it could happen that the input structure was manipulated and then overwritten by the calculation structure => deco and tts may have wrong values. To avoid this thedeco calculation status is now checked before doing the FF manupulation. Based an calculation state deco or input structures are manipulated.
Surface time stamp in planer view:
The planer used its own (buggy) implementation for calculation of tts. The timestamp for the surface arrival did not match the bottom time + TTS. The new implementation uses the tts calculated by the deco loop for generation of surface time stamp.
| author | Ideenmodellierer |
|---|---|
| date | Wed, 02 Oct 2024 22:07:13 +0200 |
| parents | d32901746950 |
| children |
| rev | line source |
|---|---|
| 38 | 1 /** |
| 2 ****************************************************************************** | |
| 3 * @file batteryCharger.c | |
| 4 * @author heinrichs weikamp gmbh | |
| 5 * @date 09-Dec-2014 | |
| 6 * @version V0.0.1 | |
| 7 * @since 09-Dec-2014 | |
| 8 * @brief LTC4054 Battery Charger | |
| 9 * | |
| 10 @verbatim | |
| 11 ============================================================================== | |
| 12 ##### How to use ##### | |
| 13 ============================================================================== | |
| 14 | |
| 15 The bq5105x provides one status output, CHG. This output is an open-drain NMOS device that is rated to 20 V. | |
| 16 The open-drain FET connected to the CHG pin will be turned on whenever the output (BAT) of the charger is | |
| 17 enabled. As a note, the output of the charger supply will not be enabled if the VRECT-REG does not converge to the | |
| 18 no-load target voltage. | |
| 19 | |
| 644 | 20 CHG F4 7 O Open-drain output � active when BAT is enabled. Float if not used. |
| 38 | 21 |
| 22 @endverbatim | |
| 23 ****************************************************************************** | |
| 24 * @attention | |
| 25 * | |
| 26 * <h2><center>© COPYRIGHT(c) 2015 heinrichs weikamp</center></h2> | |
| 27 * | |
| 28 ****************************************************************************** | |
| 29 */ | |
| 30 /* Includes ------------------------------------------------------------------*/ | |
| 31 #include "batteryCharger.h" | |
| 32 #include "batteryGasGauge.h" | |
| 33 #include "stm32f4xx_hal.h" | |
| 34 #include "scheduler.h" | |
| 35 | |
| 36 | |
| 662 | 37 #define CHARGER_DEBOUNCE_SECONDS (6u) /* 6 seconds used to avoid problems with charger interrupts / disconnections */ |
| 38 | 38 |
| 668 | 39 static uint16_t battery_charger_counter = 0; |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
40 static chargerState_t batteryChargerState = Charger_NotConnected; |
| 38 | 41 |
| 662 | 42 void set_charge_state(uint8_t newState) |
| 43 { | |
| 44 if(newState < Charger_END) | |
| 45 { | |
| 46 batteryChargerState = newState; | |
| 47 } | |
| 48 } | |
| 49 | |
| 50 uint8_t get_charge_state(void) | |
| 51 { | |
| 52 return batteryChargerState; | |
| 53 } | |
| 54 | |
| 38 | 55 void init_battery_charger_status(void) |
| 56 { | |
| 57 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
| 58 return; | |
| 59 #endif | |
| 60 | |
| 61 CHARGE_IN_GPIO_ENABLE(); | |
| 62 CHARGE_OUT_GPIO_ENABLE(); | |
| 63 | |
| 64 ReInit_battery_charger_status_pins(); | |
| 65 } | |
| 66 | |
| 67 void ReInit_battery_charger_status_pins(void) | |
| 68 { | |
| 69 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
| 70 return; | |
| 71 #endif | |
| 72 | |
| 73 GPIO_InitTypeDef GPIO_InitStructure; | |
| 74 | |
| 75 GPIO_InitStructure.Pin = CHARGE_IN_PIN; | |
| 76 GPIO_InitStructure.Mode = GPIO_MODE_INPUT; | |
| 77 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
| 78 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 79 HAL_GPIO_Init(CHARGE_IN_GPIO_PORT, &GPIO_InitStructure); | |
| 80 | |
| 81 GPIO_InitStructure.Pin = CHARGE_OUT_PIN; | |
| 82 GPIO_InitStructure.Mode = GPIO_MODE_ANALOG; | |
| 83 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
| 84 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 85 HAL_GPIO_Init(CHARGE_OUT_GPIO_PORT, &GPIO_InitStructure); | |
| 86 } | |
| 87 | |
| 88 | |
| 89 void DeInit_battery_charger_status_pins(void) | |
| 90 { | |
| 91 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
| 92 return; | |
| 93 #endif | |
| 94 GPIO_InitTypeDef GPIO_InitStructure; | |
| 95 | |
| 96 | |
| 97 GPIO_InitStructure.Mode = GPIO_MODE_ANALOG; | |
| 98 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 99 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
| 100 | |
| 101 GPIO_InitStructure.Pin = CHARGE_IN_PIN; | |
| 102 HAL_GPIO_Init(CHARGE_IN_GPIO_PORT, &GPIO_InitStructure); | |
| 103 | |
| 104 GPIO_InitStructure.Pin = CHARGE_OUT_PIN; | |
| 105 HAL_GPIO_Init(CHARGE_OUT_GPIO_PORT, &GPIO_InitStructure); | |
| 106 } | |
| 107 | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
108 void battery_charger_get_status_and_contral_battery_gas_gauge(uint8_t cycleTimeBase) |
| 38 | 109 { |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
110 static uint8_t notifyChargeComplete = 0; |
|
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
111 |
| 38 | 112 #ifdef OSTC_ON_DISCOVERY_HARDWARE |
| 113 return; | |
| 114 #endif | |
| 115 | |
| 662 | 116 if(batteryChargerState == Charger_ColdStart) /* wait for the first valid voltage meassurement */ |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
117 { |
| 859 | 118 if(global.lifeData.battery_voltage != BATTERY_DEFAULT_VOLTAGE) /* wait for first valid voltage value */ |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
119 { |
| 859 | 120 if((global.lifeData.battery_voltage < BATTERY_CHARGER_CONNECTED_VOLTAGE) |
| 121 && (global.lifeData.battery_voltage > BATTERY_ENDOF_CHARGE_VOLTAGE)) /* Voltage close to full state => maybe new battery inserted */ | |
| 662 | 122 { |
| 123 battery_gas_gauge_set_charge_full(); | |
| 124 } | |
| 125 batteryChargerState = Charger_NotConnected; | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
126 } |
|
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
127 } |
|
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
128 else |
| 662 | 129 { /* on disconnection or while disconnected */ |
| 130 if(HAL_GPIO_ReadPin(CHARGE_IN_GPIO_PORT,CHARGE_IN_PIN)) | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
131 { |
| 662 | 132 switch(batteryChargerState) |
| 133 { | |
| 686 | 134 case Charger_WarmUp: |
| 662 | 135 case Charger_Active: global.dataSendToMaster.chargeStatus = CHARGER_lostConnection; |
| 136 global.deviceDataSendToMaster.chargeStatus = CHARGER_lostConnection; | |
| 137 batteryChargerState = Charger_LostConnection; | |
| 686 | 138 if(cycleTimeBase > CHARGER_DEBOUNCE_SECONDS) /* adapt connection lost detection to sleep mode */ |
| 139 { | |
| 140 battery_charger_counter = cycleTimeBase + 1; | |
| 141 } | |
| 142 else | |
| 143 { | |
| 144 battery_charger_counter = CHARGER_DEBOUNCE_SECONDS; | |
| 145 } | |
| 662 | 146 break; |
| 859 | 147 case Charger_Finished: if((get_voltage() >= BATTERY_ENDOF_CHARGE_VOLTAGE) && (get_voltage() < BATTERY_CHARGER_CONNECTED_VOLTAGE)) /* stopping does not necessarily mean battery is full */ |
| 148 { | |
| 149 global.dataSendToMaster.chargeStatus = CHARGER_complete; | |
| 150 global.deviceDataSendToMaster.chargeStatus = CHARGER_complete; | |
| 151 notifyChargeComplete = 1; | |
| 152 } | |
| 153 battery_charger_counter = 10; | |
| 686 | 154 batteryChargerState = Charger_LostConnection; |
| 155 /* no break */ | |
| 668 | 156 case Charger_LostConnection: /* the charger stops charging when charge current is 1/10 */ |
| 157 /* Basically it is OK to rate a charging as complete if a defined voltage is reached */ | |
| 686 | 158 if(((battery_gas_gauge_isChargeValueValid() == 0) || (global.lifeData.battery_charge < 90)) && (get_voltage() >= BATTERY_ENDOF_CHARGE_VOLTAGE) && (get_voltage() < BATTERY_CHARGER_CONNECTED_VOLTAGE)) |
| 662 | 159 { |
| 160 notifyChargeComplete = 1; | |
| 161 } | |
| 686 | 162 if(battery_charger_counter >= cycleTimeBase) |
| 662 | 163 { |
| 164 battery_charger_counter -= cycleTimeBase; | |
| 165 } | |
| 166 else | |
| 167 { | |
| 168 battery_charger_counter = 0; | |
| 859 | 169 |
| 662 | 170 global.dataSendToMaster.chargeStatus = CHARGER_off; |
| 171 global.deviceDataSendToMaster.chargeStatus = CHARGER_off; | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
172 |
| 662 | 173 if(notifyChargeComplete) |
| 174 { | |
| 175 battery_gas_gauge_set_charge_full(); | |
| 176 scheduleUpdateDeviceDataChargerFull(); | |
| 177 } | |
| 859 | 178 notifyChargeComplete = 0; |
| 662 | 179 batteryChargerState = Charger_NotConnected; |
| 180 } | |
| 181 break; | |
| 859 | 182 default: batteryChargerState = Charger_NotConnected; /* unexpected state => reinitialize state machine */ |
| 183 break; | |
| 662 | 184 } |
| 185 } | |
| 186 else | |
| 187 { | |
| 188 /* connected */ | |
| 189 /* wait for disconnection to write and reset */ | |
| 190 switch(batteryChargerState) | |
| 191 { | |
| 859 | 192 case Charger_NotConnected: battery_charger_counter = 0; |
| 662 | 193 batteryChargerState = Charger_WarmUp; |
| 194 break; | |
| 195 case Charger_LostConnection: batteryChargerState = Charger_Active; | |
| 196 break; | |
| 197 case Charger_WarmUp: battery_charger_counter += cycleTimeBase; | |
| 198 if(battery_charger_counter >= CHARGER_DEBOUNCE_SECONDS ) | |
| 199 { | |
| 200 scheduleUpdateDeviceDataChargerCharging(); | |
| 201 batteryChargerState = Charger_Active; | |
| 202 } | |
| 203 /* no break */ | |
| 204 case Charger_Finished: | |
| 205 case Charger_Active: global.dataSendToMaster.chargeStatus = CHARGER_running; | |
| 206 global.deviceDataSendToMaster.chargeStatus = CHARGER_running; | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
207 |
| 662 | 208 /* drive the output pin high to determine the state of the charger */ |
| 209 GPIO_InitTypeDef GPIO_InitStructure; | |
| 210 GPIO_InitStructure.Pin = CHARGE_OUT_PIN; | |
| 211 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; | |
| 212 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
| 213 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 214 HAL_GPIO_Init(CHARGE_OUT_GPIO_PORT, &GPIO_InitStructure); | |
| 215 HAL_GPIO_WritePin(CHARGE_OUT_GPIO_PORT, CHARGE_OUT_PIN,GPIO_PIN_SET); | |
| 216 HAL_Delay(1); | |
| 217 | |
| 218 if(HAL_GPIO_ReadPin(CHARGE_IN_GPIO_PORT,CHARGE_IN_PIN)) /* high => charger stopped charging */ | |
| 219 { | |
| 859 | 220 battery_charger_counter = 30; |
| 662 | 221 batteryChargerState = Charger_Finished; |
| 222 } | |
| 223 else | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
224 { |
| 668 | 225 if(global.lifeData.battery_charge > 100.0) /* still charging but indicator is set to full => decrease to 99% to keep count increasing */ |
| 226 { | |
| 227 battery_gas_gauge_set(99.0); | |
| 228 } | |
| 662 | 229 if(batteryChargerState == Charger_Finished) /* voltage dropped below the hysteresis again => charging restarted */ |
| 230 { | |
| 231 batteryChargerState = Charger_Active; | |
| 232 notifyChargeComplete = 0; | |
| 233 } | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
234 } |
|
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
235 |
| 662 | 236 /* restore high impedance to be able to detect disconnection */ |
| 237 GPIO_InitStructure.Pin = CHARGE_OUT_PIN; | |
| 238 GPIO_InitStructure.Mode = GPIO_MODE_ANALOG; | |
| 239 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
| 240 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 241 HAL_GPIO_Init(CHARGE_OUT_GPIO_PORT, &GPIO_InitStructure); | |
| 242 HAL_Delay(1); | |
| 243 break; | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
244 |
| 859 | 245 default: batteryChargerState = Charger_NotConnected; /* unexpected state => reinitialize state machine */ |
| 662 | 246 break; |
| 247 } | |
|
643
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
248 } |
|
5149cd644fbc
Reimplemented charger status generation (deactivated):
Ideenmodellierer
parents:
38
diff
changeset
|
249 } |
| 38 | 250 } |
| 251 | |
| 252 /************************ (C) COPYRIGHT heinrichs weikamp *****END OF FILE****/ |