Mercurial > public > ostc4
annotate Small_CPU/Src/baseCPU2.c @ 899:2225c467f1e9 Evo_2_23
Added data path and visualization for position data:
The GNSS data exchange is now initialized and triggered on a cyclic basis (once a second). RTE verion has been increased because of interface change. For now only the position data is shown in a T7 surface views. The functionality may be switched on/off using the compile switch ENABLE_GNSS.
| author | Ideenmodellierer |
|---|---|
| date | Mon, 30 Sep 2024 21:56:05 +0200 |
| parents | 651d21777b61 |
| children | 6a7701f66b16 |
| rev | line source |
|---|---|
| 38 | 1 /** |
| 2 ****************************************************************************** | |
| 3 * @copyright heinrichs weikamp | |
| 4 * @file base.c including main() | |
| 5 * @author heinrichs weikamp gmbh | |
| 6 * @date 15-Aug-2014 | |
| 7 * @version V1.0.3 | |
| 8 * @since 21-Nov-2014 | |
| 9 * @brief The beginning of it all. main() is part of this. | |
| 10 * + Do the inits for hardware | |
| 11 * + Do the inits for sub-systems like menu, dive screen etc. | |
| 12 * + Start IRQs | |
| 13 * + Start MainTasks not in IRQs | |
| 14 * @bug | |
| 15 * @warning | |
| 16 @verbatim | |
| 17 ============================================================================== | |
|
286
733877ab87d9
Minor: Some Texts fixed, allign RTErequired* values with RTE firmware
heinrichsweikamp
parents:
280
diff
changeset
|
18 ##### What about hardware without 8 MHz oscillator ##### |
| 38 | 19 ============================================================================== |
| 20 [..] modify OTP Byte 1 at 0x1FFF7800 with ST-Link utility | |
| 21 | |
| 22 ============================================================================== | |
| 23 ##### Where is the RTE Firmware version ##### | |
| 24 ============================================================================== | |
| 25 [..] in baseCPU2.c <just here below :-> | |
| 26 | |
| 27 ============================================================================== | |
| 28 ##### What to do with the RTE Firmware version ##### | |
| 29 ============================================================================== | |
| 30 [..] change the values RTErequiredHigh and RTErequiredLow in settings.c | |
| 31 to start warning via the firmware if not updated | |
| 32 | |
| 33 ============================================================================== | |
| 34 ##### What it does ##### | |
| 35 ============================================================================== | |
|
286
733877ab87d9
Minor: Some Texts fixed, allign RTErequired* values with RTE firmware
heinrichsweikamp
parents:
280
diff
changeset
|
36 [..] All realtime stuff and all what has to be done during sleep |
| 38 | 37 |
| 38 [..] RealTimeClock. The entire time and date handling (including divetime) | |
| 39 [..] Hardware control for pressure sensor, compass, battery monitor | |
| 40 [..] Calculations of tissue load, critical radius, otu, cns | |
| 41 [..] Switching off the power of the main CPU after request from it. | |
| 42 | |
| 43 ============================================================================== | |
| 44 ##### IRQs ##### | |
| 45 ============================================================================== | |
| 46 [..] The IRQs are are only used for SystemTick and SPI TransferComplete after | |
| 47 DMA data reception. | |
| 48 | |
| 49 [..] HAL_SPI_TxRxCpltCallback() restarts DMA and will call | |
| 50 scheduleSpecial_Evaluate_DataSendToSlave() only if it is not blocked | |
|
239
e4207f0aaa4b
cleanup: factor out dataSendToSlaveStopEval
Jan Mulder <jlmulder@xs4all.nl>
parents:
207
diff
changeset
|
51 by I2C. |
| 38 | 52 If the evaluation is blocked it has to be tested and executed afterwards. |
| 53 I2C is executed _without_ the usage of interrupts. | |
| 54 | |
| 55 ============================================================================== | |
| 56 ##### Main loop ##### | |
| 57 ============================================================================== | |
| 58 [..] is a combination of the while loop below in main.c and code in scheduler.c | |
| 59 It is similar to the DR5 code / logic - in contrast to the main CPU | |
| 60 Switching the state is done via global.mode | |
| 61 The loops in scheduler all run in the main execution thread without | |
| 62 any job stacks (like it was in the DR5). | |
| 63 | |
| 64 ============================================================================== | |
| 65 ##### Real Time Clock ##### | |
| 66 ============================================================================== | |
|
286
733877ab87d9
Minor: Some Texts fixed, allign RTErequired* values with RTE firmware
heinrichsweikamp
parents:
280
diff
changeset
|
67 The RTC is a separate part of hardware inside the CPU and is not affected |
| 38 | 68 by reset. Only power-on reset does change something. |
| 69 This is fine but the RTC is vital for the Sleep mode as Wakeuptimer. | |
| 70 This is the only date/time system in the OSTC. The main CPU is passive. | |
|
286
733877ab87d9
Minor: Some Texts fixed, allign RTErequired* values with RTE firmware
heinrichsweikamp
parents:
280
diff
changeset
|
71 Data transfer is done with localtime_rtc_tr and localtime_rtc_dr |
| 38 | 72 in HAL_RTC format to the main CPU and as HAL_RTC structs the way back for |
| 73 setting the actual time and date. | |
| 74 The RTC unit has 20 Byte of V_bat powered SRAM. It could be used | |
|
286
733877ab87d9
Minor: Some Texts fixed, allign RTErequired* values with RTE firmware
heinrichsweikamp
parents:
280
diff
changeset
|
75 for something useful in both CPUs. |
| 38 | 76 |
| 77 ============================================================================== | |
| 78 ##### File system ##### | |
| 79 ============================================================================== | |
| 80 [..] some files are used for both CPUs, like decom.c/.h, data_central.h, ... | |
| 81 | |
| 82 | |
| 83 ============================================================================== | |
| 84 ##### Unique device ID register (96 bits) ##### | |
| 85 ============================================================================== | |
| 86 [..] some files are used for both CPUs, like decom.c/.h, data_central.h, ... | |
| 87 | |
| 88 | |
| 89 ============================================================================== | |
| 90 ##### I2C ##### | |
| 91 ============================================================================== | |
| 92 [..] used for pressure, compass, (accelerator) and battery gauge | |
| 93 main cpu and pic (button) is spi | |
| 94 | |
| 95 | |
| 96 ============================================================================== | |
| 97 ##### Firmware Update Info ##### | |
| 98 ============================================================================== | |
| 99 V0.85 160531 scheduleCheck_pressure_reached_dive_mode_level() changes | |
|
286
733877ab87d9
Minor: Some Texts fixed, allign RTErequired* values with RTE firmware
heinrichsweikamp
parents:
280
diff
changeset
|
100 160606 global.no_fly_time_minutes is at least 24h after the dive |
| 38 | 101 160613 ambient light fixed |
| 102 160720 compass calib to Flash (8000 writes max. as erase has problems) | |
| 103 160829 do not reset main CPU on power on! | |
| 104 V0.91 161018 pressure_calculation_AN520_004_mod_MS5803_30BA__09_2015(); | |
| 105 V0.92+ 161020 global.sensorError[MAX_SENSORS] | |
| 106 fix missing init_pressure(); at powerUp of RTE | |
| 107 added HAL_StatusTypeDef for many functions in pressure.c | |
| 108 161024 no_fly_time_minutes Backup FIX | |
| 109 seconds_since_last_dive now related to RTC clock | |
| 110 161121 close to surface starts at 1 meter below last known surface pressure | |
|
286
733877ab87d9
Minor: Some Texts fixed, allign RTErequired* values with RTE firmware
heinrichsweikamp
parents:
280
diff
changeset
|
111 161121 in surface mode dive mode starts @1 mtr difference if surface 880 hPa instead of 700 hPa before |
| 38 | 112 V0.97+ 170213 added global.dataSendToSlave.diveModeInfo for DIVEMODE_Apnea |
| 113 added global.dataSendToSlave.setEndDive | |
| 114 DIVEMODE_Apnea special in scheduler.c (ticksdiff >= 1000) -> no tissue, cns, otu, no change in noFly Time etc. | |
| 115 V0.99 170320 new HAL Driver Repository | |
| 116 V1.01 170509 old HAL Driver Repository | |
| 117 | |
| 118 @endverbatim | |
| 119 ****************************************************************************** | |
| 120 * @attention | |
| 121 * | |
| 122 * <h2><center>© COPYRIGHT(c) 2017 heinrichs weikamp</center></h2> | |
| 123 * | |
| 124 ****************************************************************************** | |
| 125 */ | |
| 126 | |
| 127 //#define DEBUG_PIN_ACTIVE | |
| 128 /* Includes ------------------------------------------------------------------*/ | |
| 129 | |
| 130 #include "baseCPU2.h" | |
| 131 | |
| 132 // From Small_CPU/Inc: | |
| 133 #include "dma.h" | |
| 134 #include "i2c.h" | |
| 135 #include "spi.h" | |
| 136 #include "rtc.h" | |
| 137 #include "adc.h" | |
| 138 #include "compass.h" | |
| 139 #include "pressure.h" | |
| 140 #include "batteryGasGauge.h" | |
| 141 #include "batteryCharger.h" | |
| 142 #include "scheduler.h" | |
| 143 #include "tm_stm32f4_otp.h" | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
533
diff
changeset
|
144 #include "externalInterface.h" |
| 662 | 145 #include "uart.h" |
| 889 | 146 #include "GNSS.h" |
| 147 | |
| 38 | 148 |
| 149 // From Common/Inc: | |
| 150 #include "calc_crush.h" | |
| 151 #include "decom.h" | |
| 152 #include "FirmwareData.h" | |
| 153 | |
| 154 // From Common/Drivers/ | |
| 155 #include <stdio.h> | |
| 156 | |
| 889 | 157 |
| 433 | 158 uint8_t coldstart __attribute__((section (".noinit"))); |
| 159 | |
| 89 | 160 uint8_t hasExternalClock(void) { |
| 161 if ((TM_OTP_Read(0, 0) > 0) && (TM_OTP_Read(0, 0) < 0xFF)) | |
| 162 return 1; | |
| 163 else | |
| 164 return 0; | |
| 38 | 165 } |
| 166 | |
| 167 // SHALL LOAD AT 0x08000000 + 0x00005000 = 0x08005000. | |
| 168 // See CPU2-RTE.ld | |
| 100 | 169 const SFirmwareData cpu2_FirmwareData __attribute__(( section(".firmware_data") ))= { |
|
728
5143e927219f
Added sensor map to Firmware <=> RTE inferface:
Ideenmodellierer
parents:
713
diff
changeset
|
170 .versionFirst = 3, |
|
899
2225c467f1e9
Added data path and visualization for position data:
Ideenmodellierer
parents:
890
diff
changeset
|
171 .versionSecond = 4, |
| 762 | 172 .versionThird = 0, |
| 843 | 173 .versionBeta = 1, |
| 38 | 174 |
| 89 | 175 /* 4 bytes with trailing 0 */ |
| 100 | 176 .signature = "mh", |
| 38 | 177 |
| 762 | 178 .release_year = 23, |
| 818 | 179 .release_month = 9, |
| 180 .release_day = 14, | |
| 100 | 181 .release_sub = 0, |
| 38 | 182 |
| 89 | 183 /* max 48 with trailing 0 */ |
| 184 //release_info ="12345678901234567890123456789012345678901" | |
| 768 | 185 .release_info = "stable April 2023", |
| 38 | 186 |
| 89 | 187 /* for safety reasons and coming functions */ |
| 188 .magic[0] = FIRMWARE_MAGIC_FIRST, .magic[1] = FIRMWARE_MAGIC_SECOND, | |
| 189 .magic[2] = FIRMWARE_MAGIC_CPU2_RTE, /* the magic byte for RTE */ | |
| 433 | 190 .magic[3] = FIRMWARE_MAGIC_END |
| 191 }; | |
| 192 | |
| 38 | 193 |
| 89 | 194 uint8_t firmwareVersionHigh(void) { |
| 195 return cpu2_FirmwareData.versionFirst; | |
| 38 | 196 } |
| 197 | |
| 89 | 198 uint8_t firmwareVersionLow(void) { |
| 199 return cpu2_FirmwareData.versionSecond; | |
| 38 | 200 } |
| 201 | |
| 202 /** @addtogroup OSTC4 | |
| 203 * @{ | |
| 204 */ | |
| 205 | |
| 206 /** @addtogroup CPU2 | |
| 207 * @{ | |
| 208 */ | |
| 209 | |
| 210 /* Private typedef -----------------------------------------------------------*/ | |
| 211 /* Private define ------------------------------------------------------------*/ | |
| 212 #define BUTTON_OSTC_GPIO_PIN GPIO_PIN_0 | |
| 213 #define BUTTON_OSTC_GPIO_PORT GPIOA | |
| 214 #define BUTTON_OSTC_HAL_RCC_GPIO_CLK_ENABLE() __HAL_RCC_GPIOA_CLK_ENABLE() | |
| 215 #define BUTTON_OSTC_IRQn EXTI0_IRQn | |
| 216 | |
| 880 | 217 #define VIBRATION_CONTROL_PIN GPIO_PIN_3 /* PortA */ |
| 218 #define LED_CONTROL_PIN_RED GPIO_PIN_2 /* PortA */ | |
| 219 #define LED_CONTROL_PIN_GREEN GPIO_PIN_1 /* PortA */ | |
| 662 | 220 #define MAINCPU_CONTROL_PIN GPIO_PIN_0 /* PortC */ |
| 887 | 221 #define GPS_POWER_CONTROL_PIN GPIO_PIN_15 /* PortB */ |
| 222 #define GPS_BCKP_CONTROL_PIN GPIO_PIN_14 /* PortB */ | |
| 662 | 223 |
| 38 | 224 /* Private macro -------------------------------------------------------------*/ |
| 225 | |
| 226 /* Private variables ---------------------------------------------------------*/ | |
| 227 uint32_t global_test_time_counter = 0; | |
| 228 SBackup backup; | |
| 229 | |
| 230 /* Private function prototypes -----------------------------------------------*/ | |
| 231 static void EXTI_Wakeup_Button_Init(void); | |
| 232 static void EXTI_Wakeup_Button_DeInit(void); | |
| 233 | |
| 880 | 234 static void GPIO_LEDs_VIBRATION_Init(void); |
| 38 | 235 static void GPIO_Power_MainCPU_Init(void); |
| 236 static void GPIO_Power_MainCPU_ON(void); | |
| 237 static void GPIO_Power_MainCPU_OFF(void); | |
| 880 | 238 static void GPIO_LED_RED_OFF(void); |
| 239 static void GPIO_LED_RED_ON(void); | |
| 240 static void GPIO_LED_GREEN_OFF(void); | |
| 241 static void GPIO_LED_GREEN_ON(void); | |
| 242 static void GPIO_VIBRATION_OFF(void); | |
| 243 static void GPIO_VIBRATION_ON(void); | |
| 887 | 244 static void GPIO_GPS_OFF(void); |
| 245 static void GPIO_GPS_ON(void); | |
| 246 static void GPIO_GPS_BCKP_OFF(void); | |
| 247 static void GPIO_GPS_BCKP_ON(void); | |
| 38 | 248 |
| 183 | 249 #ifdef DEBUG_I2C_LINES |
| 38 | 250 void GPIO_test_I2C_lines(void); |
| 183 | 251 #endif |
| 38 | 252 |
| 253 void sleep_prepare(void); | |
| 254 | |
| 255 void SystemClock_Config(void); | |
| 256 void SystemClock_Config_HSI(void); | |
| 257 void SystemClock_Config_HSE(void); | |
| 258 void SYSCLKConfig_STOP_HSI(void); | |
| 259 void SYSCLKConfig_STOP_HSE(void); | |
| 260 | |
| 261 void GPIO_new_DEBUG_Init(void); | |
| 262 void GPIO_new_DEBUG_LOW(void); | |
| 263 void GPIO_new_DEBUG_HIGH(void); | |
| 264 | |
| 265 #define REGULAR_RUN | |
| 266 | |
| 89 | 267 int __io_putchar(int ch) { |
| 268 ITM_SendChar(ch); | |
| 269 return ch; | |
| 38 | 270 } |
| 271 | |
| 272 /* Private functions ---------------------------------------------------------*/ | |
| 273 | |
| 274 /** | |
| 275 * @brief Main program | |
| 276 * @param None | |
| 277 * @retval None | |
| 278 */ | |
| 120 | 279 /* #define DEBUG_RUNTIME TRUE */ |
| 280 #ifdef DEBUG_RUNTIME | |
| 281 #define MEASURECNT 60 /* number of measuremets to be stored */ | |
| 282 static uint32_t loopcnt[MEASURECNT]; | |
| 283 extern RTC_HandleTypeDef RTCHandle; | |
| 284 #endif | |
| 38 | 285 |
| 89 | 286 int main(void) { |
| 120 | 287 |
| 288 #ifdef DEBUG_RUNTIME | |
| 289 RTC_TimeTypeDef Stime; | |
| 290 uint8_t measurementindex = 0; | |
| 291 uint8_t lastsecond = 0xFF; | |
| 292 #endif | |
| 293 | |
| 89 | 294 HAL_Init(); |
| 295 SystemClock_Config(); | |
| 38 | 296 |
| 89 | 297 HAL_SYSTICK_Config(HAL_RCC_GetHCLKFreq() / 1000); |
| 298 HAL_SYSTICK_CLKSourceConfig( SYSTICK_CLKSOURCE_HCLK); | |
| 299 HAL_NVIC_SetPriority(SysTick_IRQn, 0, 0); | |
| 38 | 300 |
| 89 | 301 MX_RTC_init(); |
| 880 | 302 GPIO_LEDs_VIBRATION_Init(); |
| 89 | 303 GPIO_new_DEBUG_Init(); // added 170322 hw |
| 304 initGlobals(); | |
| 38 | 305 |
| 120 | 306 /* printf("CPU2-RTE running...\n"); */ |
| 38 | 307 |
| 329 | 308 HAL_Delay(100); |
| 309 | |
| 89 | 310 MX_I2C1_Init(); |
| 329 | 311 if (global.I2C_SystemStatus != HAL_OK) |
| 312 { | |
| 89 | 313 if (MX_I2C1_TestAndClear() == GPIO_PIN_RESET) { |
| 314 MX_I2C1_TestAndClear(); // do it a second time | |
| 315 } | |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
316 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
317 I2C_DeInit(); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
318 HAL_Delay(100); |
| 89 | 319 MX_I2C1_Init(); |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
320 HAL_Delay(100); |
| 89 | 321 } |
| 38 | 322 |
| 329 | 323 |
| 324 | |
| 89 | 325 //dangerous: TM_OTP_Write(0,0, 0x01); |
| 38 | 326 #ifdef REGULAR_RUN |
| 89 | 327 global.sensorError[SENSOR_PRESSURE_ID] = init_pressure(); |
| 328 global.I2C_SystemStatus = global.sensorError[SENSOR_PRESSURE_ID]; | |
| 329 | 329 if (global.I2C_SystemStatus != HAL_OK) |
| 330 { | |
| 89 | 331 if (MX_I2C1_TestAndClear() == GPIO_PIN_RESET) { |
| 332 MX_I2C1_TestAndClear(); // do it a second time | |
| 333 } | |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
334 HAL_Delay(100); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
335 I2C_DeInit(); |
|
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
336 HAL_Delay(100); |
| 89 | 337 MX_I2C1_Init(); |
|
488
9eeab3fead8f
Added "I2C_DeInit();" in hardware detection routines. It's the recommended way
heinrichsweikamp
parents:
473
diff
changeset
|
338 HAL_Delay(100); |
| 89 | 339 global.sensorError[SENSOR_PRESSURE_ID] = init_pressure(); |
| 340 global.I2C_SystemStatus = global.sensorError[SENSOR_PRESSURE_ID]; | |
| 341 } | |
| 38 | 342 |
| 89 | 343 global.dataSendToMaster.sensorErrors = |
| 344 global.sensorError[SENSOR_PRESSURE_ID]; | |
| 329 | 345 |
| 346 if(is_init_pressure_done()) | |
| 347 { | |
|
339
37f45300bc2e
Apply averaging to pressure measurement: In pre versions calculated pressure value jittered +/-10hPa. Since we measure the pressure several time a second but only use one value a second, calc average including not used values
ideenmodellierer
parents:
334
diff
changeset
|
348 init_surface_ring(0); |
| 329 | 349 } |
| 89 | 350 init_battery_gas_gauge(); |
| 351 HAL_Delay(10); | |
| 352 battery_gas_gauge_get_data(); | |
|
473
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
353 |
| 662 | 354 global.lifeData.battery_voltage = get_voltage(); |
| 355 global.lifeData.battery_charge = get_charge(); | |
| 356 copyBatteryData(); | |
| 357 | |
|
473
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
358 MX_SPI3_Init(); |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
359 |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
360 if(coldstart != 0xA5) /* Not reading a 0xA5 means the memory cells has not been initialized before => cold start */ |
| 433 | 361 { |
| 362 coldstart = 0xA5; | |
| 662 | 363 |
| 364 set_charge_state(Charger_ColdStart); | |
| 365 | |
|
473
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
366 global.dataSendToMaster.power_on_reset = 1; |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
367 global.deviceDataSendToMaster.power_on_reset = 1; |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
368 |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
369 if (!scheduleSetButtonResponsiveness()) |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
370 { |
|
763
aa6006975e76
increase HAL_Delay to 10ms for cold-start-button reset
heinrichsweikamp
parents:
762
diff
changeset
|
371 HAL_Delay(10); |
|
473
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
372 if (!scheduleSetButtonResponsiveness()) // send again, if problem it's not my problem here. |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
373 { |
|
763
aa6006975e76
increase HAL_Delay to 10ms for cold-start-button reset
heinrichsweikamp
parents:
762
diff
changeset
|
374 HAL_Delay(10); |
|
473
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
375 scheduleSetButtonResponsiveness(); // init |
|
763
aa6006975e76
increase HAL_Delay to 10ms for cold-start-button reset
heinrichsweikamp
parents:
762
diff
changeset
|
376 HAL_Delay(10); |
|
473
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
377 } |
|
edfc1a464b42
Do not signal power on reset in case of a "warm" reset:
ideenmodellierer
parents:
439
diff
changeset
|
378 } |
| 433 | 379 } |
| 662 | 380 else |
| 381 { | |
| 382 set_charge_state(Charger_NotConnected); | |
| 383 } | |
| 38 | 384 |
| 89 | 385 ADCx_Init(); |
| 386 GPIO_Power_MainCPU_Init(); | |
| 662 | 387 |
| 388 externalInterface_InitPower33(); | |
| 389 | |
| 89 | 390 global.mode = MODE_POWERUP; |
| 38 | 391 #else |
| 89 | 392 init_pressure(); |
|
339
37f45300bc2e
Apply averaging to pressure measurement: In pre versions calculated pressure value jittered +/-10hPa. Since we measure the pressure several time a second but only use one value a second, calc average including not used values
ideenmodellierer
parents:
334
diff
changeset
|
393 init_surface_ring(0); |
| 38 | 394 |
| 89 | 395 ADCx_Init(); |
| 396 GPIO_Power_MainCPU_Init(); | |
| 397 global.mode = MODE_TEST; | |
| 38 | 398 #endif |
| 89 | 399 while (1) { |
| 120 | 400 /* printf("Global mode = %d\n", global.mode); */ |
| 38 | 401 |
| 89 | 402 switch (global.mode) { |
| 403 case MODE_POWERUP: | |
| 404 case MODE_BOOT: | |
| 405 // ReInit_battery_charger_status_pins(); | |
| 406 compass_init(0, 7); | |
| 407 accelerator_init(); | |
|
554
3328189786e7
Added external ADC interface functionality (MCP3424):
Ideenmodellierer
parents:
533
diff
changeset
|
408 externalInterface_Init(); |
| 181 | 409 |
| 89 | 410 if (global.mode == MODE_BOOT) { |
| 411 GPIO_Power_MainCPU_OFF(); | |
| 880 | 412 |
| 413 GPIO_LED_GREEN_ON(); | |
| 89 | 414 HAL_Delay(100); // for GPIO_Power_MainCPU_ON(); |
| 415 GPIO_Power_MainCPU_ON(); | |
| 880 | 416 |
| 417 GPIO_LED_GREEN_OFF(); | |
| 418 | |
| 419 GPIO_LED_RED_ON(); | |
| 889 | 420 //GPIO_VIBRATION_ON(); |
| 880 | 421 HAL_Delay(100); |
| 422 GPIO_LED_RED_OFF(); | |
| 423 GPIO_VIBRATION_OFF(); | |
| 887 | 424 GPIO_GPS_ON(); |
| 425 GPIO_GPS_BCKP_ON(); | |
| 89 | 426 } |
| 427 SPI_synchronize_with_Master(); | |
| 428 MX_DMA_Init(); | |
| 429 MX_SPI1_Init(); | |
|
134
0586ae83a243
Removed cyclic (by timer) send on slave side
Ideenmodellierer
parents:
120
diff
changeset
|
430 SPI_Start_single_TxRx_with_Master(); /* be prepared for the first data exchange */ |
| 207 | 431 Scheduler_Request_sync_with_SPI(SPI_SYNC_METHOD_HARD); |
| 889 | 432 |
| 433 // GNSS tests | |
| 434 GNSS_IO_init(); | |
| 435 MX_USART6_UART_Init(); | |
| 436 GNSS_Init(&GNSS_Handle, &huart6); | |
|
899
2225c467f1e9
Added data path and visualization for position data:
Ideenmodellierer
parents:
890
diff
changeset
|
437 |
|
2225c467f1e9
Added data path and visualization for position data:
Ideenmodellierer
parents:
890
diff
changeset
|
438 #if 0 |
| 889 | 439 HAL_Delay(1000); |
| 440 GNSS_LoadConfig(&GNSS_Handle); | |
|
890
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
441 HAL_Delay(250); |
| 889 | 442 GNSS_GetUniqID(&GNSS_Handle); |
| 443 GNSS_ParseBuffer(&GNSS_Handle); | |
|
890
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
444 HAL_Delay(250); |
| 889 | 445 GNSS_GetPVTData(&GNSS_Handle); |
| 446 GNSS_ParseBuffer(&GNSS_Handle); | |
|
899
2225c467f1e9
Added data path and visualization for position data:
Ideenmodellierer
parents:
890
diff
changeset
|
447 #endif |
|
890
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
448 /* |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
449 * Demo code from SimpleMethod |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
450 * called 1/second |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
451 while (1) { |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
452 |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
453 if ((HAL_GetTick() - Timer) > 1000) { |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
454 GNSS_GetUniqID(&GNSS_Handle); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
455 GNSS_ParseBuffer(&GNSS_Handle); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
456 HAL_Delay(250); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
457 GNSS_GetPVTData(&GNSS_Handle); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
458 GNSS_ParseBuffer(&GNSS_Handle); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
459 printf("Day: %d-%d-%d \r\n", GNSS_Handle.day, GNSS_Handle.month,GNSS_Handle.year); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
460 printf("Time: %d:%d:%d \r\n", GNSS_Handle.hour, GNSS_Handle.min,GNSS_Handle.sec); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
461 printf("Status of fix: %d \r\n", GNSS_Handle.fixType); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
462 printf("Latitude: %f \r\n", GNSS_Handle.fLat); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
463 printf("Longitude: %f \r\n",(float) GNSS_Handle.lon / 10000000.0); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
464 printf("Height above ellipsoid: %d \r\n", GNSS_Handle.height); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
465 printf("Height above mean sea level: %d \r\n", GNSS_Handle.hMSL); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
466 printf("Ground Speed (2-D): %d \r\n", GNSS_Handle.gSpeed); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
467 printf("Unique ID: %04X %04X %04X %04X %04X \n\r", |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
468 GNSS_Handle.uniqueID[0], GNSS_Handle.uniqueID[1], |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
469 GNSS_Handle.uniqueID[2], GNSS_Handle.uniqueID[3], |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
470 GNSS_Handle.uniqueID[4], GNSS_Handle.uniqueID[5]); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
471 Timer = HAL_GetTick(); |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
472 } |
|
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
473 */ |
| 889 | 474 |
| 89 | 475 global.mode = MODE_SURFACE; |
| 476 break; | |
| 38 | 477 |
| 89 | 478 case MODE_CALIB: |
| 90 | 479 scheduleCompassCalibrationMode(); |
| 89 | 480 break; |
| 481 | |
| 482 case MODE_SURFACE: | |
| 483 scheduleSurfaceMode(); | |
| 484 break; | |
| 38 | 485 |
| 89 | 486 case MODE_TEST: |
| 487 break; | |
| 38 | 488 |
| 89 | 489 case MODE_DIVE: |
| 90 | 490 backup.no_fly_time_minutes = global.no_fly_time_minutes; |
| 491 backup.seconds_since_last_dive = global.seconds_since_last_dive; | |
| 492 | |
| 493 vpm_init( &global.vpm, global.conservatism, global.repetitive_dive, | |
| 494 global.seconds_since_last_dive ); | |
| 495 global.no_fly_time_minutes = 0; | |
| 496 global.lifeData.dive_time_seconds = 0; | |
| 497 global.lifeData.dive_time_seconds_without_surface_time = 0; | |
| 498 scheduleDiveMode(); | |
| 499 // done now in scheduler prior to change mode: global.seconds_since_last_dive = 1; | |
| 500 | |
| 501 if( global.lifeData.dive_time_seconds > 60 ) | |
| 502 { | |
| 503 //No Fly time 60% of desaturationtime after dive | |
| 504 global.no_fly_time_minutes = decom_calc_desaturation_time( | |
| 505 global.lifeData.tissue_nitrogen_bar, | |
| 506 global.lifeData.tissue_helium_bar, | |
| 507 global.lifeData.pressure_surface_bar ) * 60 / 100; | |
| 508 if( global.no_fly_time_minutes < (24 * 60) ) | |
| 509 global.no_fly_time_minutes = 24 * 60; | |
| 510 } | |
| 511 else | |
| 512 { | |
| 513 global.no_fly_time_minutes = backup.no_fly_time_minutes; | |
| 514 global.seconds_since_last_dive = backup.seconds_since_last_dive; | |
| 515 } | |
| 516 | |
| 517 global.lifeData.dive_time_seconds = 0; | |
| 518 global.lifeData.dive_time_seconds_without_surface_time = 0; | |
| 519 global.lifeData.counterSecondsShallowDepth = 0; | |
| 520 | |
| 521 backup.no_fly_time_minutes = 0; | |
| 522 backup.seconds_since_last_dive = 0; | |
| 89 | 523 break; |
| 38 | 524 |
| 89 | 525 case MODE_SHUTDOWN: |
| 526 HAL_Delay(200); | |
| 527 global.mode = MODE_SLEEP; | |
| 528 MX_SPI3_Init(); | |
| 529 break; | |
| 530 | |
| 531 case MODE_SLEEP: | |
| 839 | 532 externalInterface_SwitchUART(EXT_INTERFACE_UART_OFF); |
| 662 | 533 externalInterface_SwitchPower33(false); |
| 89 | 534 if (hasExternalClock()) |
| 535 SystemClock_Config_HSI(); | |
| 887 | 536 GPIO_LEDs_VIBRATION_Init(); |
| 89 | 537 sleep_prepare(); |
| 38 | 538 |
| 89 | 539 scheduleSleepMode(); |
| 540 if (hasExternalClock()) | |
| 541 SystemClock_Config_HSE(); | |
| 542 EXTI_Wakeup_Button_DeInit(); | |
| 543 ADCx_Init(); | |
| 544 GPIO_Power_MainCPU_Init(); | |
| 545 GPIO_Power_MainCPU_ON(); | |
| 546 compass_init(0, 7); | |
| 547 accelerator_init(); | |
|
148
ee744c7160ce
Use SPI TX callback to synchronize to main CPU
Ideenmodellierer
parents:
134
diff
changeset
|
548 SPI_synchronize_with_Master(); |
| 89 | 549 MX_DMA_Init(); |
| 550 MX_SPI1_Init(); | |
|
148
ee744c7160ce
Use SPI TX callback to synchronize to main CPU
Ideenmodellierer
parents:
134
diff
changeset
|
551 SPI_Start_single_TxRx_with_Master(); |
| 89 | 552 |
| 662 | 553 if(externalInterface_isEnabledPower33()) |
| 554 { | |
| 555 externalInterface_SwitchPower33(true); | |
| 556 } | |
|
738
30717de00f3a
Added data init function for external interface:
Ideenmodellierer
parents:
728
diff
changeset
|
557 externalInterface_InitDatastruct(); |
| 89 | 558 // EXTILine0_Button_DeInit(); not now, later after testing |
| 559 break; | |
| 560 } | |
| 120 | 561 |
| 562 #ifdef DEBUG_RUNTIME | |
| 563 HAL_RTC_GetTime(&RTCHandle, &Stime, RTC_FORMAT_BCD); | |
| 564 | |
| 565 if(lastsecond == 0xFF) | |
| 566 { | |
| 567 measurementindex = 0; | |
| 568 loopcnt[measurementindex] = 0; | |
| 569 lastsecond = Stime.Seconds; | |
| 570 } | |
| 571 loopcnt[measurementindex]++; | |
| 572 | |
| 573 if(lastsecond != Stime.Seconds) | |
| 574 { | |
| 575 measurementindex++; | |
| 576 if (measurementindex == MEASURECNT) measurementindex = 0; | |
| 577 loopcnt[measurementindex] = 0; | |
| 578 lastsecond = Stime.Seconds; | |
| 579 if(measurementindex +1 < MEASURECNT) loopcnt[measurementindex +1] = 0xffff; /* helps to identify the latest value */ | |
| 580 } | |
| 581 #endif | |
| 89 | 582 } |
| 38 | 583 } |
| 584 | |
| 585 /** @brief Button feedback - EXTI line detection callbacks | |
| 586 * @param GPIO_Pin: Specifies the pins connected EXTI line | |
| 587 * @retval None | |
| 588 */ | |
| 89 | 589 void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin) { |
| 38 | 590 |
| 89 | 591 if (GPIO_Pin == BUTTON_OSTC_GPIO_PIN) { |
| 592 if (global.mode == MODE_SLEEP) { | |
| 593 global.mode = MODE_BOOT; | |
| 594 } | |
| 595 } | |
| 596 else | |
| 880 | 597 { |
| 598 | |
| 89 | 599 } |
| 38 | 600 } |
| 601 | |
| 602 /** | |
| 603 * @brief System Clock Configuration | |
| 604 * The system Clock is configured as follow : | |
| 605 * System Clock source = PLL (HSI) | |
| 606 * SYSCLK(Hz) = 100 MHz | |
| 607 * HCLK(Hz) = 100 MHz | |
| 608 * AHB Prescaler = 1 | |
| 609 * APB1 Prescaler = 2 | |
| 610 * APB2 Prescaler = 1 | |
| 611 * HSI Frequency(Hz) = 16 MHz | |
| 612 * PLL_M = 16 | |
| 613 * PLL_N = 400 | |
| 614 * PLL_P = 4 | |
| 615 * PLL_Q = 7 // no USB | |
| 616 * VDD(V) = 3.3 | |
| 617 * Main regulator output voltage = Scale1 mode | |
| 618 * Flash Latency(WS) = 3 | |
| 619 * @param None | |
| 620 * @retval None | |
| 621 */ | |
| 622 | |
| 89 | 623 void SystemClock_Config(void) { |
| 624 if (hasExternalClock()) | |
| 625 SystemClock_Config_HSE(); | |
| 626 else | |
| 627 SystemClock_Config_HSI(); | |
| 38 | 628 } |
| 629 | |
| 89 | 630 void SYSCLKConfig_STOP(void) { |
| 631 SYSCLKConfig_STOP_HSI(); | |
| 38 | 632 } |
| 633 | |
| 89 | 634 void SystemClock_Config_HSE(void) { |
| 635 RCC_OscInitTypeDef RCC_OscInitStruct; | |
| 636 RCC_ClkInitTypeDef RCC_ClkInitStruct; | |
| 38 | 637 // RCC_PeriphCLKInitTypeDef PeriphClkInitStruct; |
| 638 | |
| 89 | 639 __PWR_CLK_ENABLE(); // is identical to __HAL_RCC_PWR_CLK_ENABLE(); |
| 38 | 640 |
| 887 | 641 __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1); |
| 38 | 642 |
| 89 | 643 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE; //|RCC_OSCILLATORTYPE_LSE; |
| 644 RCC_OscInitStruct.HSEState = RCC_HSE_ON; | |
| 645 //RCC_OscInitStruct.LSEState = RCC_LSE_ON; | |
| 646 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON; | |
| 647 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE; | |
| 648 RCC_OscInitStruct.PLL.PLLM = 8; | |
| 649 RCC_OscInitStruct.PLL.PLLN = 320; | |
| 650 RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV4; | |
| 651 RCC_OscInitStruct.PLL.PLLQ = 4; | |
| 652 HAL_RCC_OscConfig(&RCC_OscInitStruct); | |
| 38 | 653 |
| 89 | 654 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_SYSCLK |
| 655 | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2; | |
| 656 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK; | |
| 657 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1; | |
| 658 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2; | |
| 659 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1; | |
| 660 HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2); | |
| 38 | 661 |
| 662 // PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_RTC; | |
| 663 // PeriphClkInitStruct.RTCClockSelection = RCC_RTCCLKSOURCE_LSE; | |
| 664 // HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct); | |
| 665 | |
| 666 // HAL_SYSTICK_Config(HAL_RCC_GetHCLKFreq()/1000); | |
| 667 | |
| 668 // HAL_SYSTICK_CLKSourceConfig(SYSTICK_CLKSOURCE_HCLK); | |
| 669 | |
| 89 | 670 /* SysTick_IRQn interrupt configuration */ |
| 38 | 671 // HAL_NVIC_SetPriority(SysTick_IRQn, 0, 0); |
| 672 } | |
| 673 | |
| 89 | 674 void SystemClock_Config_HSI(void) { |
| 675 RCC_ClkInitTypeDef RCC_ClkInitStruct; | |
| 676 RCC_OscInitTypeDef RCC_OscInitStruct; | |
| 38 | 677 |
| 89 | 678 /* Enable Power Control clock */ |
| 679 __HAL_RCC_PWR_CLK_ENABLE(); | |
| 38 | 680 |
| 89 | 681 /* The voltage scaling allows optimizing the power consumption when the device is |
| 682 clocked below the maximum system frequency, to update the voltage scaling value | |
| 683 regarding system frequency refer to product datasheet. */ | |
| 887 | 684 __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1); |
| 38 | 685 |
| 89 | 686 /* Enable HSI Oscillator and activate PLL with HSI as source */ |
| 687 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI; | |
| 688 RCC_OscInitStruct.HSIState = RCC_HSI_ON; | |
| 689 RCC_OscInitStruct.HSICalibrationValue = 0x10; | |
| 690 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON; | |
| 691 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI; | |
| 692 RCC_OscInitStruct.PLL.PLLM = 16; | |
| 693 RCC_OscInitStruct.PLL.PLLN = 320; | |
| 694 RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV4; | |
| 695 RCC_OscInitStruct.PLL.PLLQ = 4; | |
| 696 HAL_RCC_OscConfig(&RCC_OscInitStruct); | |
| 38 | 697 |
| 89 | 698 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2 |
| 699 clocks dividers */ | |
| 700 RCC_ClkInitStruct.ClockType = (RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK | |
| 701 | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2); | |
| 702 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK; | |
| 703 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1; | |
| 704 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2; | |
| 705 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1; | |
| 706 HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2); | |
| 38 | 707 } |
| 708 | |
| 709 | |
| 710 /** | |
| 711 * @brief Configures system clock after wake-up from STOP: enable HSI, PLL | |
| 712 * and select PLL as system clock source. | |
| 713 * @param None | |
| 714 * @retval None | |
| 715 */ | |
| 89 | 716 void SYSCLKConfig_STOP_HSE(void) { |
| 717 RCC_ClkInitTypeDef RCC_ClkInitStruct; | |
| 718 RCC_OscInitTypeDef RCC_OscInitStruct; | |
| 719 uint32_t pFLatency = 0; | |
| 38 | 720 |
| 89 | 721 /* Get the Oscillators configuration according to the internal RCC registers */ |
| 722 HAL_RCC_GetOscConfig(&RCC_OscInitStruct); | |
| 38 | 723 |
| 89 | 724 /* After wake-up from STOP reconfigure the system clock: Enable HSI and PLL */ |
| 725 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE; | |
| 726 RCC_OscInitStruct.HSIState = RCC_HSE_ON; | |
| 727 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON; | |
| 728 HAL_RCC_OscConfig(&RCC_OscInitStruct); | |
| 38 | 729 |
| 89 | 730 /* Get the Clocks configuration according to the internal RCC registers */ |
| 731 HAL_RCC_GetClockConfig(&RCC_ClkInitStruct, &pFLatency); | |
| 38 | 732 |
| 89 | 733 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2 |
| 734 clocks dividers */ | |
| 735 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK; | |
| 736 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK; | |
| 737 HAL_RCC_ClockConfig(&RCC_ClkInitStruct, pFLatency); | |
| 38 | 738 } |
| 739 | |
| 89 | 740 void SYSCLKConfig_STOP_HSI(void) { |
| 741 RCC_ClkInitTypeDef RCC_ClkInitStruct; | |
| 742 RCC_OscInitTypeDef RCC_OscInitStruct; | |
| 743 uint32_t pFLatency = 0; | |
| 38 | 744 |
| 89 | 745 /* Get the Oscillators configuration according to the internal RCC registers */ |
| 746 HAL_RCC_GetOscConfig(&RCC_OscInitStruct); | |
| 38 | 747 |
| 89 | 748 /* After wake-up from STOP reconfigure the system clock: Enable HSI and PLL */ |
| 749 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI; | |
| 750 RCC_OscInitStruct.HSIState = RCC_HSI_ON; | |
| 751 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON; | |
| 752 RCC_OscInitStruct.HSICalibrationValue = 0x10; | |
| 753 HAL_RCC_OscConfig(&RCC_OscInitStruct); | |
| 38 | 754 |
| 89 | 755 /* Get the Clocks configuration according to the internal RCC registers */ |
| 756 HAL_RCC_GetClockConfig(&RCC_ClkInitStruct, &pFLatency); | |
| 38 | 757 |
| 89 | 758 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2 |
| 759 clocks dividers */ | |
| 760 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK; | |
| 761 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK; | |
| 762 HAL_RCC_ClockConfig(&RCC_ClkInitStruct, pFLatency); | |
| 38 | 763 } |
| 764 | |
| 765 /** | |
| 766 * @brief SYSTICK callback | |
| 767 * @param None | |
| 768 * @retval None | |
| 769 */ | |
| 89 | 770 void HAL_SYSTICK_Callback(void) { |
| 771 HAL_IncTick(); | |
| 38 | 772 } |
| 773 | |
| 774 /** | |
| 775 * @brief Configures GPIO for LED | |
| 776 * Might move with STM32Cube usage | |
| 777 * @param None | |
| 778 * @retval None | |
| 779 */ | |
| 780 /* | |
| 781 void GPIO_test_I2C_lines(void) | |
| 782 { | |
| 783 GPIO_InitTypeDef GPIO_InitStructure; | |
| 784 __GPIOB_CLK_ENABLE(); | |
| 785 GPIO_InitStructure.Pin = GPIO_PIN_8; | |
| 786 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; | |
| 787 GPIO_InitStructure.Pull = GPIO_PULLUP; | |
| 788 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 789 HAL_GPIO_Init(GPIOB, &GPIO_InitStructure); | |
| 790 GPIO_InitStructure.Pin = GPIO_PIN_9; | |
| 791 HAL_GPIO_Init(GPIOB, &GPIO_InitStructure); | |
| 792 | |
| 793 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_8,GPIO_PIN_SET); | |
| 794 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_9,GPIO_PIN_RESET); | |
| 795 HAL_Delay(10); | |
| 796 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_9,GPIO_PIN_SET); | |
| 797 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_8,GPIO_PIN_RESET); | |
| 798 HAL_Delay(10); | |
| 799 } | |
| 800 */ | |
| 801 | |
| 880 | 802 static void GPIO_LEDs_VIBRATION_Init(void) { |
| 89 | 803 GPIO_InitTypeDef GPIO_InitStructure; |
| 38 | 804 |
| 880 | 805 __GPIOA_CLK_ENABLE(); |
| 806 GPIO_InitStructure.Pin = LED_CONTROL_PIN_RED; | |
| 89 | 807 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; |
| 808 GPIO_InitStructure.Pull = GPIO_PULLUP; | |
| 880 | 809 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; |
| 810 HAL_GPIO_Init( GPIOA, &GPIO_InitStructure); | |
| 811 | |
| 812 GPIO_InitStructure.Pin = LED_CONTROL_PIN_GREEN; | |
| 813 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; | |
| 814 GPIO_InitStructure.Pull = GPIO_PULLUP; | |
| 815 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 816 HAL_GPIO_Init( GPIOA, &GPIO_InitStructure); | |
| 817 | |
| 818 GPIO_InitStructure.Pin = VIBRATION_CONTROL_PIN; | |
| 819 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; | |
| 820 GPIO_InitStructure.Pull = GPIO_PULLDOWN; | |
| 821 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 822 HAL_GPIO_Init( GPIOA, &GPIO_InitStructure); | |
| 887 | 823 |
| 824 __GPIOB_CLK_ENABLE(); | |
| 825 GPIO_InitStructure.Pin = GPS_POWER_CONTROL_PIN; | |
| 826 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; | |
| 827 GPIO_InitStructure.Pull = GPIO_PULLUP; | |
| 828 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 829 HAL_GPIO_Init( GPIOB, &GPIO_InitStructure); | |
| 830 | |
| 831 GPIO_InitStructure.Pin = GPS_BCKP_CONTROL_PIN; | |
| 832 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; | |
| 833 GPIO_InitStructure.Pull = GPIO_PULLDOWN; | |
| 834 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 835 HAL_GPIO_Init( GPIOB, &GPIO_InitStructure); | |
| 836 | |
| 38 | 837 } |
| 838 | |
| 89 | 839 void GPIO_new_DEBUG_Init(void) { |
| 38 | 840 #ifdef DEBUG_PIN_ACTIVE |
| 89 | 841 GPIO_InitTypeDef GPIO_InitStructure; |
| 38 | 842 |
| 89 | 843 __GPIOC_CLK_ENABLE(); |
| 662 | 844 GPIO_InitStructure.Pin = LED_CONTROL_PIN; |
| 89 | 845 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; |
| 846 GPIO_InitStructure.Pull = GPIO_PULLUP; | |
| 847 GPIO_InitStructure.Speed = GPIO_SPEED_FAST; | |
| 848 HAL_GPIO_Init(GPIOA, &GPIO_InitStructure); | |
| 38 | 849 #endif |
| 850 } | |
| 851 | |
| 89 | 852 void GPIO_new_DEBUG_LOW(void) { |
| 38 | 853 #ifdef DEBUG_PIN_ACTIVE |
| 662 | 854 HAL_GPIO_WritePin(GPIOC,LED_CONTROL_PIN,GPIO_PIN_RESET); |
| 38 | 855 #endif |
| 856 } | |
| 857 | |
| 89 | 858 void GPIO_new_DEBUG_HIGH(void) { |
| 38 | 859 #ifdef DEBUG_PIN_ACTIVE |
| 662 | 860 HAL_GPIO_WritePin(GPIOC,LED_CONTROL_PIN,GPIO_PIN_SET); |
| 38 | 861 #endif |
| 862 } | |
| 863 | |
| 89 | 864 static void GPIO_Power_MainCPU_Init(void) { |
| 865 GPIO_InitTypeDef GPIO_InitStructure; | |
| 866 __GPIOC_CLK_ENABLE(); | |
| 662 | 867 GPIO_InitStructure.Pin = MAINCPU_CONTROL_PIN; |
| 89 | 868 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP; |
| 869 GPIO_InitStructure.Pull = GPIO_PULLUP; | |
| 870 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 871 HAL_GPIO_Init( GPIOC, &GPIO_InitStructure); | |
| 662 | 872 HAL_GPIO_WritePin( GPIOC, MAINCPU_CONTROL_PIN, GPIO_PIN_RESET); |
| 38 | 873 } |
| 874 | |
| 89 | 875 static void GPIO_Power_MainCPU_ON(void) { |
| 662 | 876 HAL_GPIO_WritePin( GPIOC, MAINCPU_CONTROL_PIN, GPIO_PIN_RESET); |
| 38 | 877 } |
| 878 | |
| 89 | 879 static void GPIO_Power_MainCPU_OFF(void) { |
| 662 | 880 HAL_GPIO_WritePin( GPIOC, MAINCPU_CONTROL_PIN, GPIO_PIN_SET); |
| 38 | 881 } |
| 882 | |
| 880 | 883 static void GPIO_LED_GREEN_ON(void) { |
| 884 HAL_GPIO_WritePin( GPIOA, LED_CONTROL_PIN_GREEN, GPIO_PIN_RESET); | |
| 885 } | |
| 886 | |
| 887 static void GPIO_LED_GREEN_OFF(void) { | |
| 888 HAL_GPIO_WritePin( GPIOA, LED_CONTROL_PIN_GREEN, GPIO_PIN_SET); | |
| 889 } | |
| 890 | |
| 891 static void GPIO_LED_RED_ON(void) { | |
| 892 HAL_GPIO_WritePin( GPIOA, LED_CONTROL_PIN_RED, GPIO_PIN_RESET); | |
| 893 } | |
| 894 | |
| 895 static void GPIO_LED_RED_OFF(void) { | |
| 896 HAL_GPIO_WritePin( GPIOA, LED_CONTROL_PIN_RED, GPIO_PIN_SET); | |
| 897 } | |
| 898 | |
| 899 static void GPIO_VIBRATION_ON(void) { | |
| 900 HAL_GPIO_WritePin( GPIOA, VIBRATION_CONTROL_PIN, GPIO_PIN_SET); | |
| 901 } | |
| 902 | |
| 903 static void GPIO_VIBRATION_OFF(void) { | |
| 904 HAL_GPIO_WritePin( GPIOA, VIBRATION_CONTROL_PIN, GPIO_PIN_RESET); | |
| 905 } | |
| 906 | |
| 887 | 907 static void GPIO_GPS_ON(void) { |
| 908 HAL_GPIO_WritePin( GPIOB, GPS_POWER_CONTROL_PIN, GPIO_PIN_RESET); | |
| 909 } | |
| 910 | |
| 911 static void GPIO_GPS_OFF(void) { | |
| 912 HAL_GPIO_WritePin( GPIOB, GPS_POWER_CONTROL_PIN, GPIO_PIN_SET); | |
| 913 } | |
| 914 | |
| 915 static void GPIO_GPS_BCKP_ON(void) { | |
| 916 HAL_GPIO_WritePin( GPIOB, GPS_BCKP_CONTROL_PIN, GPIO_PIN_SET); | |
| 917 } | |
| 918 | |
| 919 static void GPIO_GPS_BCKP_OFF(void) { | |
| 920 HAL_GPIO_WritePin( GPIOB, GPS_BCKP_CONTROL_PIN, GPIO_PIN_RESET); | |
| 921 } | |
| 922 | |
| 880 | 923 |
| 38 | 924 /** |
| 925 * @brief Configures EXTI Line0 (connected to PA0 + PA1 pin) in interrupt mode | |
| 926 * @param None | |
| 927 * @retval None | |
| 928 */ | |
| 929 | |
| 89 | 930 static void EXTI_Wakeup_Button_Init(void) { |
| 931 GPIO_InitTypeDef GPIO_InitStructure; | |
| 38 | 932 |
| 89 | 933 __HAL_RCC_GPIOA_CLK_ENABLE(); |
| 934 BUTTON_OSTC_HAL_RCC_GPIO_CLK_ENABLE(); | |
| 935 GPIO_InitStructure.Pin = BUTTON_OSTC_GPIO_PIN; | |
| 936 GPIO_InitStructure.Mode = GPIO_MODE_IT_FALLING; | |
| 937 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
| 938 HAL_GPIO_Init( BUTTON_OSTC_GPIO_PORT, &GPIO_InitStructure); | |
| 38 | 939 |
| 89 | 940 HAL_NVIC_SetPriority( BUTTON_OSTC_IRQn, 0x0F, 0); |
| 941 HAL_NVIC_EnableIRQ( BUTTON_OSTC_IRQn); | |
| 38 | 942 } |
| 943 | |
| 89 | 944 static void EXTI_Wakeup_Button_DeInit(void) { |
| 945 GPIO_InitTypeDef GPIO_InitStructure; | |
| 38 | 946 |
| 89 | 947 GPIO_InitStructure.Mode = GPIO_MODE_ANALOG; |
| 948 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
| 949 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
| 38 | 950 |
| 89 | 951 GPIO_InitStructure.Pin = BUTTON_OSTC_GPIO_PIN; |
| 952 HAL_GPIO_Init( BUTTON_OSTC_GPIO_PORT, &GPIO_InitStructure); | |
| 953 HAL_NVIC_DisableIRQ( BUTTON_OSTC_IRQn); | |
| 38 | 954 } |
| 955 | |
| 956 /** | |
| 957 * @brief Wake Up Timer callback | |
| 958 * @param hrtc: RTC handle | |
| 959 * @retval None | |
| 960 */ | |
| 961 | |
| 962 /* | |
| 963 void HAL_RTCEx_WakeUpTimerEventCallback(RTC_HandleTypeDef *hrtc) | |
| 964 { | |
| 965 static uint8_t uwCounter = 0; | |
| 966 uwCounter = 1; | |
| 967 } | |
| 968 */ | |
| 969 | |
| 89 | 970 void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *I2cHandle) { |
| 38 | 971 |
| 972 } | |
| 973 | |
| 89 | 974 void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *I2cHandle) { |
| 38 | 975 |
| 976 } | |
| 977 | |
| 89 | 978 void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *I2cHandle) { |
| 38 | 979 |
| 980 } | |
| 981 | |
| 89 | 982 void sleep_prepare(void) { |
| 983 EXTI_Wakeup_Button_Init(); | |
| 662 | 984 |
| 89 | 985 compass_sleep(); |
| 986 HAL_Delay(100); | |
| 987 accelerator_sleep(); | |
| 988 HAL_Delay(100); | |
| 38 | 989 |
| 89 | 990 I2C_DeInit(); |
| 991 MX_SPI_DeInit(); | |
| 992 MX_SPI3_DeInit(); | |
| 993 ADCx_DeInit(); | |
| 38 | 994 |
| 89 | 995 GPIO_InitTypeDef GPIO_InitStruct; |
| 38 | 996 |
| 89 | 997 __HAL_RCC_GPIOA_CLK_ENABLE(); |
| 998 __HAL_RCC_GPIOB_CLK_ENABLE(); | |
| 999 __HAL_RCC_GPIOC_CLK_ENABLE(); | |
| 1000 __HAL_RCC_GPIOH_CLK_ENABLE(); | |
| 38 | 1001 |
| 89 | 1002 GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; |
| 887 | 1003 GPIO_InitStruct.Speed = GPIO_SPEED_LOW; |
| 89 | 1004 GPIO_InitStruct.Pull = GPIO_NOPULL; |
| 1005 GPIO_InitStruct.Pin = GPIO_PIN_All; | |
| 1006 HAL_GPIO_Init( GPIOH, &GPIO_InitStruct); | |
| 38 | 1007 #ifdef DEBUGMODE |
| 89 | 1008 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_3 | GPIO_PIN_8 | GPIO_PIN_9); /* debug */ |
| 38 | 1009 #endif |
| 887 | 1010 |
| 1011 GPIO_InitStruct.Pin = GPIO_PIN_All ^ (GPS_POWER_CONTROL_PIN | GPS_BCKP_CONTROL_PIN); | |
| 89 | 1012 HAL_GPIO_Init( GPIOB, &GPIO_InitStruct); |
| 38 | 1013 |
| 887 | 1014 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( MAINCPU_CONTROL_PIN | CHARGE_OUT_PIN | EXT33V_CONTROL_PIN); /* power off & charger in & charge out & OSC32 & ext33Volt */ |
| 662 | 1015 |
| 89 | 1016 HAL_GPIO_Init( GPIOC, &GPIO_InitStruct); |
| 38 | 1017 |
| 887 | 1018 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0 | VIBRATION_CONTROL_PIN | LED_CONTROL_PIN_RED | LED_CONTROL_PIN_GREEN); |
| 38 | 1019 #ifdef DEBUGMODE |
| 89 | 1020 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0 | GPIO_PIN_13 | GPIO_PIN_14); /* wake up button & debug */ |
| 38 | 1021 #endif |
| 89 | 1022 HAL_GPIO_Init( GPIOA, &GPIO_InitStruct); |
| 38 | 1023 |
| 89 | 1024 GPIO_InitStruct.Pin = GPIO_PIN_All; |
| 1025 HAL_GPIO_Init( GPIOH, &GPIO_InitStruct); | |
| 38 | 1026 |
| 89 | 1027 GPIO_Power_MainCPU_OFF(); |
| 880 | 1028 GPIO_LED_GREEN_OFF(); |
| 1029 GPIO_LED_RED_OFF(); | |
| 887 | 1030 GPIO_VIBRATION_OFF(); |
| 1031 GPIO_GPS_BCKP_ON(); // mH : costs 100µA in sleep - beware | |
| 1032 GPIO_GPS_OFF(); | |
| 880 | 1033 |
|
890
651d21777b61
cleanup and disable function for GNSS uart and DMA
heinrichsweikamp
parents:
889
diff
changeset
|
1034 MX_USART6_UART_DeInit(); |
| 38 | 1035 |
| 1036 #ifndef DEBUGMODE | |
| 89 | 1037 __HAL_RCC_GPIOB_CLK_DISABLE(); |
| 38 | 1038 #endif |
| 89 | 1039 __HAL_RCC_GPIOH_CLK_DISABLE(); |
| 38 | 1040 |
| 89 | 1041 HAL_Delay(1000); |
| 38 | 1042 } |
| 1043 | |
| 1044 /* | |
| 1045 void sleep_test(void) | |
| 1046 { | |
| 1047 GPIO_InitTypeDef GPIO_InitStruct; | |
| 1048 | |
| 1049 __HAL_RCC_GPIOA_CLK_ENABLE(); | |
| 1050 __HAL_RCC_GPIOB_CLK_ENABLE(); | |
| 1051 __HAL_RCC_GPIOC_CLK_ENABLE(); | |
| 1052 __HAL_RCC_GPIOH_CLK_ENABLE(); | |
| 1053 | |
| 1054 GPIO_InitStruct.Mode = GPIO_MODE_ANALOG; | |
| 1055 GPIO_InitStruct.Speed = GPIO_SPEED_HIGH; | |
| 1056 GPIO_InitStruct.Pull = GPIO_NOPULL; | |
| 1057 GPIO_InitStruct.Pin = GPIO_PIN_All; | |
| 1058 HAL_GPIO_Init(GPIOH, &GPIO_InitStruct); | |
| 1059 HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); | |
| 1060 | |
| 1061 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0 | GPIO_PIN_15 | GPIO_PIN_14); | |
| 1062 HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); | |
| 1063 | |
| 1064 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0); | |
| 1065 HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); | |
| 1066 | |
| 1067 GPIO_Power_MainCPU_OFF(); | |
| 1068 | |
| 1069 GPIO_InitStruct.Pull = GPIO_PULLUP; | |
| 1070 GPIO_InitStruct.Pin = GPIO_PIN_0; | |
| 1071 HAL_GPIO_Init(GPIOA, &GPIO_InitStruct); | |
| 1072 | |
| 1073 // __HAL_RCC_GPIOA_CLK_DISABLE(); | |
| 1074 __HAL_RCC_GPIOB_CLK_DISABLE(); | |
| 1075 // __HAL_RCC_GPIOC_CLK_DISABLE(); | |
| 1076 __HAL_RCC_GPIOH_CLK_DISABLE(); | |
| 1077 | |
| 1078 | |
| 1079 HAL_Delay(5000); | |
| 1080 while(1) | |
| 1081 { | |
| 1082 RTC_StopMode_2seconds(); | |
| 1083 HAL_Delay(200); | |
| 1084 } | |
| 1085 } | |
| 1086 */ | |
| 1087 | |
| 1088 #ifdef USE_FULL_ASSERT | |
| 1089 | |
| 1090 /** | |
| 1091 * @brief Reports the name of the source file and the source line number | |
| 1092 * where the assert_param error has occurred. | |
| 1093 * @param file: pointer to the source file name | |
| 1094 * @param line: assert_param error line source number | |
| 1095 * @retval None | |
| 1096 */ | |
| 1097 void assert_failed(uint8_t* file, uint32_t line) | |
| 1098 { | |
| 89 | 1099 /* User can add his own implementation to report the file name and line number, |
| 1100 ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */ | |
| 38 | 1101 |
| 89 | 1102 /* Infinite loop */ |
| 1103 while (1) | |
| 1104 { | |
| 1105 } | |
| 38 | 1106 } |
| 1107 #endif | |
| 1108 | |
| 1109 /** | |
| 1110 * @} | |
| 1111 */ | |
| 104 | 1112 /** |
| 1113 * @brief This function handles SysTick Handler. | |
| 1114 * @param None | |
| 1115 * @retval None | |
| 1116 */ | |
| 38 | 1117 |
| 104 | 1118 /*TxRx only here. Every 100 ms.*/ |
| 1119 uint8_t ticks100ms=0; | |
| 1120 void SysTick_Handler(void) | |
| 1121 { | |
| 1122 HAL_IncTick(); | |
| 1123 if(ticks100ms<100){ | |
| 1124 ticks100ms++; | |
| 1125 }else | |
| 1126 { | |
| 1127 ticks100ms=0; | |
| 1128 } | |
| 1129 } | |
| 38 | 1130 /** |
| 1131 * @} | |
| 1132 */ | |
| 1133 | |
| 1134 /************************ (C) COPYRIGHT heinrichs weikamp *****END OF FILE****/ |