Mercurial > public > ostc4
annotate Small_CPU/Src/batteryGasGauge.c @ 735:39f48356049b
Fixed invalid setpoint (0.0) used after switch from CCR to extra (OC) gas
Bugfix from mikeller
author | heinrichsweikamp |
---|---|
date | Tue, 14 Feb 2023 10:21:56 +0100 |
parents | 079bb5b22c06 |
children |
rev | line source |
---|---|
38 | 1 /** |
2 ****************************************************************************** | |
3 * @file batteryGasGauge.c | |
4 * @author heinrichs weikamp gmbh | |
5 * @version V0.0.1 | |
6 * @date 09-Dec-2014 | |
7 * @brief LTC2942 Battery Gas Gauge | |
8 * | |
9 @verbatim | |
10 ============================================================================== | |
11 ##### stm32f4xx_hal_i2c.c modification ##### | |
12 ============================================================================== | |
13 The LTC2942 requires an repeated start condition without stop condition | |
14 for data reception. | |
15 | |
16 @endverbatim | |
17 ****************************************************************************** | |
18 * @attention | |
19 * | |
20 * <h2><center>© COPYRIGHT(c) 2014 heinrichs weikamp</center></h2> | |
21 * | |
22 ****************************************************************************** | |
23 */ | |
24 /* Includes ------------------------------------------------------------------*/ | |
330 | 25 #include <string.h> /* memset */ |
38 | 26 #include "batteryGasGauge.h" |
27 #include "baseCPU2.h" | |
28 #include "stm32f4xx_hal.h" | |
29 #include "i2c.h" | |
30 | |
662 | 31 static float battery_f_voltage = BATTERY_DEFAULT_VOLTAGE; /* max assumed voltage */ |
228
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
32 static float battery_f_charge_percent = 0; |
668 | 33 static uint8_t chargeValueKnown = 0; /* indicator if the charge of the battery is known (for example after a full charge cycle) */ |
34 | |
38 | 35 |
36 #define BGG_BATTERY_OFFSET (26123) //; 65536-(3,35Ah/0,085mAh) | |
228
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
37 #define BGG_BATTERY_DIVIDER (394) //; 3,35Ah/0,085mAh/100 [%] |
38 | 38 |
39 float get_voltage(void) | |
40 { | |
41 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
42 return 3.0f; | |
43 #endif | |
44 | |
45 return battery_f_voltage; | |
46 } | |
47 | |
48 | |
49 float get_charge(void) | |
50 { | |
51 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
52 return 100.0f; | |
53 #endif | |
54 | |
55 return battery_f_charge_percent; | |
56 } | |
57 | |
58 | |
59 void init_battery_gas_gauge(void) | |
60 { | |
61 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
62 return; | |
63 #endif | |
64 | |
65 uint8_t buffer[2]; | |
66 buffer[0] = 0x01; | |
228
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
67 |
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
68 // F8 = 11111000: |
433 | 69 // ADC auto mode (11) |
228
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
70 // Prescale M = 128 (111) |
668 | 71 // AL/CC pin disable (00) |
228
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
72 // Shutdown (0) |
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
73 buffer[1] = 0xF8; |
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
74 I2C_Master_Transmit(DEVICE_BATTERYGAUGE, buffer, 2); |
38 | 75 } |
76 | |
330 | 77 uint8_t battery_gas_gauge_CheckConfigOK(void) |
78 { | |
79 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
80 return; | |
81 #endif | |
82 | |
83 uint8_t retval = 0; | |
84 uint8_t bufferReceive[10]; | |
85 | |
86 memset(bufferReceive,0,sizeof(bufferReceive)); | |
87 | |
88 I2C_Master_Receive(DEVICE_BATTERYGAUGE, bufferReceive, 10); | |
89 if(bufferReceive[1] == 0xf8) | |
90 { | |
91 retval = 1; | |
92 } | |
93 return retval; | |
94 } | |
95 | |
242
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
96 static void disable_adc(void) |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
97 { |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
98 uint8_t buffer[2]; |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
99 buffer[0] = 0x01; |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
100 |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
101 // according to the datasheet of the LTC2942, the adc shall |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
102 // be disabled when writing to the gauge registers |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
103 |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
104 // 0xF9 = 11111001: |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
105 // see init_battery_gas_gauge() |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
106 // Shutdown (1) |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
107 buffer[1] = 0xF9; |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
108 I2C_Master_Transmit(DEVICE_BATTERYGAUGE, buffer, 2); |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
109 } |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
110 |
38 | 111 |
112 void battery_gas_gauge_get_data(void) | |
113 { | |
114 #ifdef OSTC_ON_DISCOVERY_HARDWARE | |
115 return; | |
116 #endif | |
117 | |
118 float battery_f_voltage_local; | |
119 float battery_f_charge_percent_local; | |
120 | |
121 uint8_t bufferReceive[10]; | |
408
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
122 |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
123 if(I2C_Master_Receive(DEVICE_BATTERYGAUGE, bufferReceive, 10) == HAL_OK) |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
124 { |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
125 battery_f_voltage_local = (float)(bufferReceive[8] * 256); |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
126 battery_f_voltage_local += (float)(bufferReceive[9]); |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
127 battery_f_voltage_local *= (float)6 / (float)0xFFFF; |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
128 |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
129 // max/full: 0.085 mAh * 1 * 65535 = 5570 mAh |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
130 battery_f_charge_percent_local = (float)(bufferReceive[2] * 256); |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
131 battery_f_charge_percent_local += (float)(bufferReceive[3]); |
433 | 132 battery_f_charge_percent_local -= BGG_BATTERY_OFFSET; /* Because of the prescalar 128 the counter assumes a max value of 5570mAh => normalize to 3350mAh*/ |
133 battery_f_charge_percent_local /= BGG_BATTERY_DIVIDER; /* transform to percentage */ | |
38 | 134 |
408
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
135 if(battery_f_charge_percent_local < 0) |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
136 battery_f_charge_percent_local = 0; |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
137 |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
138 battery_f_voltage = battery_f_voltage_local; |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
139 battery_f_charge_percent = battery_f_charge_percent_local; |
2fc08a0d1ec3
Bugfix invalid voltage / temperatur after coldstart:
ideenmodellierer
parents:
330
diff
changeset
|
140 } |
38 | 141 } |
142 | |
143 | |
144 void battery_gas_gauge_set_charge_full(void) | |
145 { | |
242
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
146 disable_adc(); |
38 | 147 #ifdef OSTC_ON_DISCOVERY_HARDWARE |
148 return; | |
149 #endif | |
150 | |
151 uint8_t bufferSend[3]; | |
152 bufferSend[0] = 0x02; | |
153 bufferSend[1] = 0xFF; | |
154 bufferSend[2] = 0xFF; | |
155 I2C_Master_Transmit( DEVICE_BATTERYGAUGE, bufferSend, 3); | |
242
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
156 init_battery_gas_gauge(); |
668 | 157 chargeValueKnown = 1; |
38 | 158 } |
159 | |
160 | |
161 void battery_gas_gauge_set(float percentage) | |
162 { | |
242
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
163 |
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
164 disable_adc(); |
38 | 165 #ifdef OSTC_ON_DISCOVERY_HARDWARE |
166 return; | |
167 #endif | |
168 | |
169 uint16_t mAhSend; | |
170 | |
171 if(percentage >= 100) | |
172 mAhSend = 0xFFFF; | |
228
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
173 else { |
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
174 mAhSend = (percentage * BGG_BATTERY_DIVIDER) + BGG_BATTERY_OFFSET; |
f9ba924d188e
Bugfix: set battery percentage correctly after RTE update
Jan Mulder <jlmulder@xs4all.nl>
parents:
38
diff
changeset
|
175 } |
38 | 176 |
177 uint8_t bufferSend[3]; | |
178 bufferSend[0] = 0x02; | |
179 bufferSend[1] = (uint8_t)(mAhSend / 256); | |
180 bufferSend[2] = (uint8_t)(mAhSend & 0xFF); | |
181 I2C_Master_Transmit( DEVICE_BATTERYGAUGE, bufferSend, 3); | |
242
b23de15e2861
Comply to datasheet when resetting battery gauge registers
Jan Mulder <jlmulder@xs4all.nl>
parents:
228
diff
changeset
|
182 init_battery_gas_gauge(); |
668 | 183 chargeValueKnown = 1; |
38 | 184 } |
185 | |
668 | 186 uint8_t battery_gas_gauge_isChargeValueValid(void) |
187 { | |
188 return chargeValueKnown; | |
189 } | |
190 | |
191 void battery_gas_gauge_setChargeValueValid(void) | |
192 { | |
193 chargeValueKnown = 1; | |
194 } | |
38 | 195 |
196 /************************ (C) COPYRIGHT heinrichs weikamp *****END OF FILE****/ |