Mercurial > public > ostc4

comparison Small_CPU/Src/baseCPU2.c @ 38:5f11787b4f42

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
include in ostc4 repository
author heinrichsweikamp
date Sat, 28 Apr 2018 11:52:34 +0200
parents
children 46530453eb01
comparison
equal deleted inserted replaced
37:ccc45c0e1ea2 38:5f11787b4f42
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 ==============================================================================
18 ##### What about hardware without 8 MHz oscilator #####
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 ==============================================================================
36 [..] All realtime stuff und all what has to be done during sleep
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
51 by I2C for example by setting global.dataSendToSlaveStopEval to 0.
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 ==============================================================================
67 [..] Wehe sie zickt statt tickt!
68 The RTC is a seperate part of hardware inside the CPU and is not affected
69 by reset. Only power-on reset does change something.
70 This is fine but the RTC is vital for the Sleep mode as Wakeuptimer.
71 This is the only date/time system in the OSTC. The main CPU is passive.
72 Data transfer is done with localtime_rtc_tr und localtime_rtc_dr
73 in HAL_RTC format to the main CPU and as HAL_RTC structs the way back for
74 setting the actual time and date.
75 The RTC unit has 20 Byte of V_bat powered SRAM. It could be used
76 for something usefull in both CPUs.
77
78 ==============================================================================
79 ##### File system #####
80 ==============================================================================
81 [..] some files are used for both CPUs, like decom.c/.h, data_central.h, ...
82
83
84 ==============================================================================
85 ##### Unique device ID register (96 bits) #####
86 ==============================================================================
87 [..] some files are used for both CPUs, like decom.c/.h, data_central.h, ...
88
89
90 ==============================================================================
91 ##### I2C #####
92 ==============================================================================
93 [..] used for pressure, compass, (accelerator) and battery gauge
94 main cpu and pic (button) is spi
95
96
97 ==============================================================================
98 ##### Firmware Update Info #####
99 ==============================================================================
100 V0.85 160531 scheduleCheck_pressure_reached_dive_mode_level() changes
101 160606 global.no_fly_time_minutes ist at least 24h after the dive
102 160613 ambient light fixed
103 160720 compass calib to Flash (8000 writes max. as erase has problems)
104 160829 do not reset main CPU on power on!
105 V0.91 161018 pressure_calculation_AN520_004_mod_MS5803_30BA__09_2015();
106 V0.92+ 161020 global.sensorError[MAX_SENSORS]
107 fix missing init_pressure(); at powerUp of RTE
108 added HAL_StatusTypeDef for many functions in pressure.c
109 161024 no_fly_time_minutes Backup FIX
110 seconds_since_last_dive now related to RTC clock
111 161121 close to surface starts at 1 meter below last known surface pressure
112 161121 in surface mode dive mode starts @1 mtr difference if surface 880 mbar instead of 700 mbar before
113 V0.97+ 170213 added global.dataSendToSlave.diveModeInfo for DIVEMODE_Apnea
114 added global.dataSendToSlave.setEndDive
115 DIVEMODE_Apnea special in scheduler.c (ticksdiff >= 1000) -> no tissue, cns, otu, no change in noFly Time etc.
116 V0.99 170320 new HAL Driver Repository
117 V1.01 170509 old HAL Driver Repository
118
119 @endverbatim
120 ******************************************************************************
121 * @attention
122 *
123 * <h2><center>&copy; COPYRIGHT(c) 2017 heinrichs weikamp</center></h2>
124 *
125 ******************************************************************************
126 */
127
128 //#define DEBUG_PIN_ACTIVE
129 /* Includes ------------------------------------------------------------------*/
130
131 #include "baseCPU2.h"
132
133 // From Small_CPU/Inc:
134 #include "dma.h"
135 #include "i2c.h"
136 #include "spi.h"
137 #include "rtc.h"
138 #include "adc.h"
139 #include "compass.h"
140 #include "pressure.h"
141 #include "batteryGasGauge.h"
142 #include "batteryCharger.h"
143 #include "scheduler.h"
144 #include "wireless.h"
145 #include "tm_stm32f4_otp.h"
146
147 // From Common/Inc:
148 #include "calc_crush.h"
149 #include "decom.h"
150 #include "FirmwareData.h"
151
152 // From Common/Drivers/
153 #include "stm32f4xx_hal.h"
154 #include <stdio.h>
155
156 uint8_t hasExternalClock(void)
157 {
158 if( (TM_OTP_Read( 0, 0 ) > 0) && (TM_OTP_Read( 0, 0 ) < 0xFF) )
159 return 1;
160 else
161 return 0;
162 }
163
164 // SHALL LOAD AT 0x08000000 + 0x00005000 = 0x08005000.
165 // See CPU2-RTE.ld
166 const SFirmwareData cpu2_FirmwareData __attribute__(( section(".firmware_data") ))
167 =
168 {
169 .versionFirst = 1,
170 .versionSecond = 4,
171 .versionThird = 0,
172 .versionBeta = 1,
173
174 /* 4 bytes with trailing 0 */
175 .signature = "cw",
176
177 .release_year = 17,
178 .release_month = 9,
179 .release_day = 13,
180 .release_sub = 0,
181
182 /* max 48 with trailing 0 */
183 //release_info ="12345678901234567890123456789012345678901"
184 .release_info = "compass stuff",
185
186 /* for safety reasons and coming functions */
187 .magic[0] = FIRMWARE_MAGIC_FIRST,
188 .magic[1] = FIRMWARE_MAGIC_SECOND,
189 .magic[2] = FIRMWARE_MAGIC_CPU2_RTE, /* the magic byte for RTE */
190 .magic[3] = FIRMWARE_MAGIC_END
191 };
192
193 uint8_t firmwareVersionHigh(void)
194 {
195 return cpu2_FirmwareData.versionFirst;
196 }
197
198 uint8_t firmwareVersionLow(void)
199 {
200 return cpu2_FirmwareData.versionSecond;
201 }
202
203 /** @addtogroup OSTC4
204 * @{
205 */
206
207 /** @addtogroup CPU2
208 * @{
209 */
210
211 /* Private typedef -----------------------------------------------------------*/
212 /* Private define ------------------------------------------------------------*/
213 #define BUTTON_OSTC_GPIO_PIN GPIO_PIN_0
214 #define BUTTON_OSTC_GPIO_PORT GPIOA
215 #define BUTTON_OSTC_HAL_RCC_GPIO_CLK_ENABLE() __HAL_RCC_GPIOA_CLK_ENABLE()
216 #define BUTTON_OSTC_IRQn EXTI0_IRQn
217
218 #define BUTTON_TEST_GPIO_PIN GPIO_PIN_3
219 #define BUTTON_TEST_GPIO_PORT GPIOA
220 #define BUTTON_TEST_GPIO_CLK_ENABLE() __GPIOA_CLK_ENABLE()
221 #define BUTTON_TEST_IRQn EXTI3_IRQn
222
223 #define WIRELSS_RISING_GPIO_PIN GPIO_PIN_1
224 #define WIRELSS_RISING_GPIO_PORT GPIOA
225 #define WIRELSS_RISING_HAL_RCC_GPIO_CLK_ENABLE() __HAL_RCC_GPIOA_CLK_ENABLE()
226 #define WIRELSS_RISING_IRQn EXTI1_IRQn
227
228 #define WIRELSS_FALLING_GPIO_PIN GPIO_PIN_2
229 #define WIRELSS_FALLING_GPIO_PORT GPIOA
230 #define WIRELSS_FALLING_HAL_RCC_GPIO_CLK_ENABLE() __HAL_RCC_GPIOA_CLK_ENABLE()
231 #define WIRELSS_FALLING_IRQn EXTI2_IRQn
232
233 #define WIRELSS_POWER_GPIO_PIN GPIO_PIN_12
234 #define WIRELSS_POWER_GPIO_PORT GPIOB
235 #define WIRELSS_POWER_HAL_RCC_GPIO_CLK_ENABLE() __HAL_RCC_GPIOB_CLK_ENABLE()
236
237 /* Private macro -------------------------------------------------------------*/
238
239 /* Private variables ---------------------------------------------------------*/
240 uint32_t global_test_time_counter = 0;
241 SBackup backup;
242
243 /* Private function prototypes -----------------------------------------------*/
244 static void EXTI_Wakeup_Button_Init(void);
245 static void EXTI_Wakeup_Button_DeInit(void);
246
247 static void EXTI_Test_Button_Init(void);
248 static void EXTI_Test_Button_DeInit(void);
249
250 static void MX_EXTI_wireless_Init(void);
251 static void MX_EXTI_wireless_DeInit(void);
252
253 //static void EXTILine01_Button_DeInit(void);
254 static void GPIO_LED_Init(void);
255 static void GPIO_Power_MainCPU_Init(void);
256 static void GPIO_Power_MainCPU_ON(void);
257 static void GPIO_Power_MainCPU_OFF(void);
258
259 void GPIO_test_I2C_lines(void);
260
261 //void sleep_test(void);
262 void sleep_prepare(void);
263
264 void SystemClock_Config(void);
265 void SystemClock_Config_HSI(void);
266 void SystemClock_Config_HSE(void);
267 void SYSCLKConfig_STOP_HSI(void);
268 void SYSCLKConfig_STOP_HSE(void);
269
270 void GPIO_new_DEBUG_Init(void);
271 void GPIO_new_DEBUG_LOW(void);
272 void GPIO_new_DEBUG_HIGH(void);
273
274 #define REGULAR_RUN
275
276 int __io_putchar(int ch)
277 {
278 ITM_SendChar( ch );
279 return ch;
280 }
281
282 /* Private functions ---------------------------------------------------------*/
283
284 /**
285 * @brief Main program
286 * @param None
287 * @retval None
288 */
289
290 int main(void)
291 {
292 HAL_Init();
293 SystemClock_Config();
294
295 HAL_SYSTICK_Config( HAL_RCC_GetHCLKFreq() / 1000 );
296 HAL_SYSTICK_CLKSourceConfig( SYSTICK_CLKSOURCE_HCLK );
297 HAL_NVIC_SetPriority( SysTick_IRQn, 0, 0 );
298
299 MX_RTC_init();
300 GPIO_LED_Init();
301 GPIO_new_DEBUG_Init(); // added 170322 hw
302 initGlobals();
303
304 printf("CPU2-RTE running...\n");
305
306 MX_I2C1_Init();
307 if( global.I2C_SystemStatus != HAL_OK )
308 {
309 if( MX_I2C1_TestAndClear() == GPIO_PIN_RESET )
310 {
311 MX_I2C1_TestAndClear(); // do it a second time
312 }
313 MX_I2C1_Init();
314 }
315
316 //dangerous: TM_OTP_Write(0,0, 0x01);
317 #ifdef REGULAR_RUN
318 global.sensorError[SENSOR_PRESSURE_ID] = init_pressure();
319 global.I2C_SystemStatus = global.sensorError[SENSOR_PRESSURE_ID];
320 if( global.I2C_SystemStatus != HAL_OK )
321 {
322 if( MX_I2C1_TestAndClear() == GPIO_PIN_RESET )
323 {
324 MX_I2C1_TestAndClear(); // do it a second time
325 }
326 MX_I2C1_Init();
327 global.sensorError[SENSOR_PRESSURE_ID] = init_pressure();
328 global.I2C_SystemStatus = global.sensorError[SENSOR_PRESSURE_ID];
329 }
330
331 global.dataSendToMaster.sensorErrors =
332 global.sensorError[SENSOR_PRESSURE_ID];
333 init_surface_ring();
334 init_battery_gas_gauge();
335 HAL_Delay( 10 );
336 battery_gas_gauge_get_data();
337 // battery_gas_gauge_set(0);
338
339 global.lifeData.battery_voltage = get_voltage();
340 global.lifeData.battery_charge = get_charge();
341 copyBatteryData();
342
343 MX_SPI3_Init();
344 if( !scheduleSetButtonResponsiveness() )
345 {
346 HAL_Delay( 1 );
347 scheduleSetButtonResponsiveness(); // init
348 HAL_Delay( 1 );
349 if( !scheduleSetButtonResponsiveness() ) // send again, if problem it's not my problem here.
350 {
351 HAL_Delay( 1 );
352 scheduleSetButtonResponsiveness(); // init
353 HAL_Delay( 1 );
354 }
355 }
356
357 ADCx_Init();
358 GPIO_Power_MainCPU_Init();
359 global.mode = MODE_POWERUP;
360 #else
361 init_pressure();
362 init_surface_ring();
363
364 ADCx_Init();
365 GPIO_Power_MainCPU_Init();
366 global.mode = MODE_TEST;
367 #endif
368 while( 1 )
369 {
370 printf("Global mode = %d\n", global.mode);
371
372 switch( global.mode )
373 {
374 case MODE_POWERUP:
375 case MODE_BOOT:
376 // ReInit_battery_charger_status_pins();
377 compass_init( 0, 7 );
378 accelerator_init();
379 wireless_init();
380 if( global.mode == MODE_BOOT )
381 {
382 GPIO_Power_MainCPU_OFF();
383 HAL_Delay( 100 ); // for GPIO_Power_MainCPU_ON();
384 GPIO_Power_MainCPU_ON();
385 }
386 SPI_synchronize_with_Master();
387 MX_DMA_Init();
388 MX_SPI1_Init();
389 MX_EXTI_wireless_Init();
390 SPI_Start_single_TxRx_with_Master();
391 EXTI_Test_Button_Init();
392
393 /*
394 uint8_t dataWireless[64];
395 while(1)
396 {
397 wireless_evaluate_and_debug(dataWireless,64);
398 }
399 */
400 global.mode = MODE_SURFACE;
401 break;
402
403 case MODE_CALIB:
404 scheduleCompassCalibrationMode();
405 break;
406
407 case MODE_SURFACE:
408 scheduleSurfaceMode();
409 break;
410
411 case MODE_TEST:
412 GPIO_Power_MainCPU_ON();
413 SPI_synchronize_with_Master();
414 MX_DMA_Init();
415 MX_SPI1_Init();
416 // MX_EXTI_wireless_Init();
417 SPI_Start_single_TxRx_with_Master();
418 // EXTI_Test_Button_Init();
419
420 scheduleTestMode();
421 break;
422
423 case MODE_DIVE:
424 backup.no_fly_time_minutes = global.no_fly_time_minutes;
425 backup.seconds_since_last_dive = global.seconds_since_last_dive;
426
427 vpm_init( &global.vpm, global.conservatism, global.repetitive_dive,
428 global.seconds_since_last_dive );
429 global.no_fly_time_minutes = 0;
430 global.lifeData.dive_time_seconds = 0;
431 global.lifeData.dive_time_seconds_without_surface_time = 0;
432 scheduleDiveMode();
433 // done now in scheduler prior to change mode: global.seconds_since_last_dive = 1;
434
435 if( global.lifeData.dive_time_seconds > 60 )
436 {
437 //No Fly time 60% of desaturationtime after dive
438 global.no_fly_time_minutes = decom_calc_desaturation_time(
439 global.lifeData.tissue_nitrogen_bar,
440 global.lifeData.tissue_helium_bar,
441 global.lifeData.pressure_surface_bar ) * 60 / 100;
442 if( global.no_fly_time_minutes < (24 * 60) )
443 global.no_fly_time_minutes = 24 * 60;
444 }
445 else
446 {
447 global.no_fly_time_minutes = backup.no_fly_time_minutes;
448 global.seconds_since_last_dive = backup.seconds_since_last_dive;
449 }
450
451 global.lifeData.dive_time_seconds = 0;
452 global.lifeData.dive_time_seconds_without_surface_time = 0;
453 global.lifeData.counterSecondsShallowDepth = 0;
454
455 backup.no_fly_time_minutes = 0;
456 backup.seconds_since_last_dive = 0;
457 break;
458
459 case MODE_SHUTDOWN:
460 HAL_Delay( 200 );
461 global.mode = MODE_SLEEP;
462 MX_SPI3_Init();
463 break;
464
465 case MODE_SLEEP:
466 /*
467 sleep_prepare();
468 scheduleSleepMode_test();
469 */
470 /*
471 GPIO_Power_MainCPU_OFF();
472 EXTI_Test_Button_DeInit();
473 EXTI_Wakeup_Button_Init();
474 NOT_USED_AT_THE_MOMENT_scheduleSleepMode();
475 */
476 EXTI_Test_Button_DeInit();
477 MX_EXTI_wireless_DeInit();
478 if( hasExternalClock() )
479 SystemClock_Config_HSI();
480 sleep_prepare();
481
482 GPIO_LED_Init();
483
484 scheduleSleepMode();
485 if( hasExternalClock() )
486 SystemClock_Config_HSE();
487 GPIO_LED_Init();
488 EXTI_Wakeup_Button_DeInit();
489 ADCx_Init();
490 GPIO_Power_MainCPU_Init();
491 GPIO_Power_MainCPU_ON();
492 compass_init( 0, 7 );
493 accelerator_init();
494 wireless_init();
495 SPI_synchronize_with_Master();
496 MX_DMA_Init();
497 MX_SPI1_Init();
498 MX_EXTI_wireless_Init();
499 SPI_Start_single_TxRx_with_Master();
500
501 // EXTILine0_Button_DeInit(); not now, later after testing
502 break;
503 }
504 }
505 }
506
507 /** @brief Button feedback - EXTI line detection callbacks
508 * @param GPIO_Pin: Specifies the pins connected EXTI line
509 * @retval None
510 */
511 void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin)
512 {
513
514 if( GPIO_Pin == WIRELSS_RISING_GPIO_PIN )
515 {
516 wireless_trigger_RisingEdgeSilence();
517 }
518
519 else
520
521 if( GPIO_Pin == WIRELSS_FALLING_GPIO_PIN )
522 {
523 wireless_trigger_FallingEdgeSignalHigh();
524 }
525
526 else
527
528 if( GPIO_Pin == BUTTON_OSTC_GPIO_PIN )
529 {
530 if( global.mode == MODE_SLEEP )
531 {
532 global.mode = MODE_BOOT;
533 }
534 }
535
536 else
537
538 if( GPIO_Pin == BUTTON_TEST_GPIO_PIN )
539 {
540 if( !global.demo_mode && (global.mode == MODE_SURFACE) )
541 {
542 global.demo_mode = 1;
543 global.mode = MODE_DIVE;
544 }
545 else if( global.demo_mode && (global.mode == MODE_DIVE)
546 && (global.lifeData.dive_time_seconds > 10) )
547 {
548 global.demo_mode = 0;
549 global.dataSendToMaster.mode = MODE_ENDDIVE;
550 global.deviceDataSendToMaster.mode = MODE_ENDDIVE;
551 }
552 }
553 }
554
555 /**
556 * @brief System Clock Configuration
557 * The system Clock is configured as follow :
558 * System Clock source = PLL (HSI)
559 * SYSCLK(Hz) = 100 MHz
560 * HCLK(Hz) = 100 MHz
561 * AHB Prescaler = 1
562 * APB1 Prescaler = 2
563 * APB2 Prescaler = 1
564 * HSI Frequency(Hz) = 16 MHz
565 * PLL_M = 16
566 * PLL_N = 400
567 * PLL_P = 4
568 * PLL_Q = 7 // no USB
569 * VDD(V) = 3.3
570 * Main regulator output voltage = Scale1 mode
571 * Flash Latency(WS) = 3
572 * @param None
573 * @retval None
574 */
575
576 void SystemClock_Config(void)
577 {
578 if( hasExternalClock() )
579 SystemClock_Config_HSE();
580 else
581 SystemClock_Config_HSI();
582 }
583
584 void SYSCLKConfig_STOP(void)
585 {
586 SYSCLKConfig_STOP_HSI();
587 }
588
589 void SystemClock_Config_HSE(void)
590 {
591 RCC_OscInitTypeDef RCC_OscInitStruct;
592 RCC_ClkInitTypeDef RCC_ClkInitStruct;
593 // RCC_PeriphCLKInitTypeDef PeriphClkInitStruct;
594
595 __PWR_CLK_ENABLE(); // is identical to __HAL_RCC_PWR_CLK_ENABLE();
596
597 __HAL_PWR_VOLTAGESCALING_CONFIG( PWR_REGULATOR_VOLTAGE_SCALE2 );
598
599 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE; //|RCC_OSCILLATORTYPE_LSE;
600 RCC_OscInitStruct.HSEState = RCC_HSE_ON;
601 //RCC_OscInitStruct.LSEState = RCC_LSE_ON;
602 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
603 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
604 RCC_OscInitStruct.PLL.PLLM = 8;
605 RCC_OscInitStruct.PLL.PLLN = 320;
606 RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV4;
607 RCC_OscInitStruct.PLL.PLLQ = 4;
608 HAL_RCC_OscConfig( &RCC_OscInitStruct );
609
610 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_SYSCLK
611 | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2;
612 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
613 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
614 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
615 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
616 HAL_RCC_ClockConfig( &RCC_ClkInitStruct, FLASH_LATENCY_2 );
617
618 // PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_RTC;
619 // PeriphClkInitStruct.RTCClockSelection = RCC_RTCCLKSOURCE_LSE;
620 // HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct);
621
622 // HAL_SYSTICK_Config(HAL_RCC_GetHCLKFreq()/1000);
623
624 // HAL_SYSTICK_CLKSourceConfig(SYSTICK_CLKSOURCE_HCLK);
625
626 /* SysTick_IRQn interrupt configuration */
627 // HAL_NVIC_SetPriority(SysTick_IRQn, 0, 0);
628 }
629
630 void SystemClock_Config_HSI(void)
631 {
632 RCC_ClkInitTypeDef RCC_ClkInitStruct;
633 RCC_OscInitTypeDef RCC_OscInitStruct;
634
635 /* Enable Power Control clock */
636 __HAL_RCC_PWR_CLK_ENABLE();
637
638 /* The voltage scaling allows optimizing the power consumption when the device is
639 clocked below the maximum system frequency, to update the voltage scaling value
640 regarding system frequency refer to product datasheet. */
641 __HAL_PWR_VOLTAGESCALING_CONFIG( PWR_REGULATOR_VOLTAGE_SCALE2 );
642
643 /* Enable HSI Oscillator and activate PLL with HSI as source */
644 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
645 RCC_OscInitStruct.HSIState = RCC_HSI_ON;
646 RCC_OscInitStruct.HSICalibrationValue = 0x10;
647 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
648 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI;
649 RCC_OscInitStruct.PLL.PLLM = 16;
650 RCC_OscInitStruct.PLL.PLLN = 320;
651 RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV4;
652 RCC_OscInitStruct.PLL.PLLQ = 4;
653 HAL_RCC_OscConfig( &RCC_OscInitStruct );
654
655 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2
656 clocks dividers */
657 RCC_ClkInitStruct.ClockType = (RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK
658 | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2);
659 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
660 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
661 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
662 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
663 HAL_RCC_ClockConfig( &RCC_ClkInitStruct, FLASH_LATENCY_2 );
664 }
665 /*
666 RCC_OscInitTypeDef RCC_OscInitStruct;
667 RCC_ClkInitTypeDef RCC_ClkInitStruct;
668
669 __HAL_RCC_PWR_CLK_ENABLE();
670
671 //__PWR_CLK_ENABLE();
672
673 __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE2);
674
675 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI|RCC_OSCILLATORTYPE_LSE;
676 RCC_OscInitStruct.LSEState = RCC_LSE_ON;
677 RCC_OscInitStruct.HSIState = RCC_HSI_ON;
678 RCC_OscInitStruct.HSICalibrationValue = 16;
679 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
680 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI;
681 RCC_OscInitStruct.PLL.PLLM = 16;
682 RCC_OscInitStruct.PLL.PLLN = 320;
683 RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV4;
684 RCC_OscInitStruct.PLL.PLLQ = 4;
685 HAL_RCC_OscConfig(&RCC_OscInitStruct);
686
687 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK|RCC_CLOCKTYPE_PCLK1;
688 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
689 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
690 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
691 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
692 HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2);
693 }
694
695 static void RtcClock_Config(void)
696 {
697 RCC_PeriphCLKInitTypeDef PeriphClkInitStruct;
698 PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_RTC;
699 PeriphClkInitStruct.RTCClockSelection = RCC_RTCCLKSOURCE_LSE;
700 HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct);
701 }
702 */
703
704 /**
705 * @brief Configures system clock after wake-up from STOP: enable HSI, PLL
706 * and select PLL as system clock source.
707 * @param None
708 * @retval None
709 */
710 void SYSCLKConfig_STOP_HSE(void)
711 {
712 RCC_ClkInitTypeDef RCC_ClkInitStruct;
713 RCC_OscInitTypeDef RCC_OscInitStruct;
714 uint32_t pFLatency = 0;
715
716 /* Get the Oscillators configuration according to the internal RCC registers */
717 HAL_RCC_GetOscConfig( &RCC_OscInitStruct );
718
719 /* After wake-up from STOP reconfigure the system clock: Enable HSI and PLL */
720 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
721 RCC_OscInitStruct.HSIState = RCC_HSE_ON;
722 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
723 HAL_RCC_OscConfig( &RCC_OscInitStruct );
724
725 /* Get the Clocks configuration according to the internal RCC registers */
726 HAL_RCC_GetClockConfig( &RCC_ClkInitStruct, &pFLatency );
727
728 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2
729 clocks dividers */
730 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK;
731 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
732 HAL_RCC_ClockConfig( &RCC_ClkInitStruct, pFLatency );
733 }
734
735 void SYSCLKConfig_STOP_HSI(void)
736 {
737 RCC_ClkInitTypeDef RCC_ClkInitStruct;
738 RCC_OscInitTypeDef RCC_OscInitStruct;
739 uint32_t pFLatency = 0;
740
741 /* Get the Oscillators configuration according to the internal RCC registers */
742 HAL_RCC_GetOscConfig( &RCC_OscInitStruct );
743
744 /* After wake-up from STOP reconfigure the system clock: Enable HSI and PLL */
745 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
746 RCC_OscInitStruct.HSIState = RCC_HSI_ON;
747 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
748 RCC_OscInitStruct.HSICalibrationValue = 0x10;
749 HAL_RCC_OscConfig( &RCC_OscInitStruct );
750
751 /* Get the Clocks configuration according to the internal RCC registers */
752 HAL_RCC_GetClockConfig( &RCC_ClkInitStruct, &pFLatency );
753
754 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2
755 clocks dividers */
756 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK;
757 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
758 HAL_RCC_ClockConfig( &RCC_ClkInitStruct, pFLatency );
759 }
760
761 /**
762 * @brief SYSTICK callback
763 * @param None
764 * @retval None
765 */
766 void HAL_SYSTICK_Callback(void)
767 {
768 HAL_IncTick();
769 }
770
771 /**
772 * @brief Configures GPIO for LED
773 * Might move with STM32Cube usage
774 * @param None
775 * @retval None
776 */
777 /*
778 void GPIO_test_I2C_lines(void)
779 {
780 GPIO_InitTypeDef GPIO_InitStructure;
781 __GPIOB_CLK_ENABLE();
782 GPIO_InitStructure.Pin = GPIO_PIN_8;
783 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
784 GPIO_InitStructure.Pull = GPIO_PULLUP;
785 GPIO_InitStructure.Speed = GPIO_SPEED_LOW;
786 HAL_GPIO_Init(GPIOB, &GPIO_InitStructure);
787 GPIO_InitStructure.Pin = GPIO_PIN_9;
788 HAL_GPIO_Init(GPIOB, &GPIO_InitStructure);
789
790 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_8,GPIO_PIN_SET);
791 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_9,GPIO_PIN_RESET);
792 HAL_Delay(10);
793 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_9,GPIO_PIN_SET);
794 HAL_GPIO_WritePin(GPIOB,GPIO_PIN_8,GPIO_PIN_RESET);
795 HAL_Delay(10);
796 }
797 */
798
799 static void GPIO_LED_Init(void)
800 {
801 GPIO_InitTypeDef GPIO_InitStructure;
802
803 __GPIOC_CLK_ENABLE();
804 GPIO_InitStructure.Pin = GPIO_PIN_3;
805 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
806 GPIO_InitStructure.Pull = GPIO_PULLUP;
807 GPIO_InitStructure.Speed = GPIO_SPEED_FAST;
808 HAL_GPIO_Init( GPIOC, &GPIO_InitStructure );
809 }
810
811 void GPIO_new_DEBUG_Init(void)
812 {
813 #ifdef DEBUG_PIN_ACTIVE
814 GPIO_InitTypeDef GPIO_InitStructure;
815
816 __GPIOC_CLK_ENABLE();
817 GPIO_InitStructure.Pin = GPIO_PIN_3;
818 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
819 GPIO_InitStructure.Pull = GPIO_PULLUP;
820 GPIO_InitStructure.Speed = GPIO_SPEED_FAST;
821 HAL_GPIO_Init(GPIOA, &GPIO_InitStructure);
822 #endif
823 }
824
825 void GPIO_new_DEBUG_LOW(void)
826 {
827 #ifdef DEBUG_PIN_ACTIVE
828 HAL_GPIO_WritePin(GPIOC,GPIO_PIN_3,GPIO_PIN_RESET);
829 #endif
830 }
831
832 void GPIO_new_DEBUG_HIGH(void)
833 {
834 #ifdef DEBUG_PIN_ACTIVE
835 HAL_GPIO_WritePin(GPIOC,GPIO_PIN_3,GPIO_PIN_SET);
836 #endif
837 }
838
839 static void GPIO_Power_MainCPU_Init(void)
840 {
841 GPIO_InitTypeDef GPIO_InitStructure;
842 __GPIOC_CLK_ENABLE();
843 GPIO_InitStructure.Pin = GPIO_PIN_0;
844 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
845 GPIO_InitStructure.Pull = GPIO_PULLUP;
846 GPIO_InitStructure.Speed = GPIO_SPEED_LOW;
847 HAL_GPIO_Init( GPIOC, &GPIO_InitStructure );
848 HAL_GPIO_WritePin( GPIOC, GPIO_PIN_0, GPIO_PIN_RESET );
849 }
850
851 static void GPIO_Power_MainCPU_ON(void)
852 {
853 HAL_GPIO_WritePin( GPIOC, GPIO_PIN_0, GPIO_PIN_RESET );
854 }
855
856 static void GPIO_Power_MainCPU_OFF(void)
857 {
858 HAL_GPIO_WritePin( GPIOC, GPIO_PIN_0, GPIO_PIN_SET );
859 }
860
861 /**
862 * @brief Configures EXTI Line0 (connected to PA0 + PA1 pin) in interrupt mode
863 * @param None
864 * @retval None
865 */
866
867 static void EXTI_Wakeup_Button_Init(void)
868 {
869 GPIO_InitTypeDef GPIO_InitStructure;
870
871 __HAL_RCC_GPIOA_CLK_ENABLE();
872 BUTTON_OSTC_HAL_RCC_GPIO_CLK_ENABLE();
873 GPIO_InitStructure.Pin = BUTTON_OSTC_GPIO_PIN;
874 GPIO_InitStructure.Mode = GPIO_MODE_IT_FALLING;
875 GPIO_InitStructure.Pull = GPIO_NOPULL;
876 HAL_GPIO_Init( BUTTON_OSTC_GPIO_PORT, &GPIO_InitStructure );
877
878 HAL_NVIC_SetPriority( BUTTON_OSTC_IRQn, 0x0F, 0 );
879 HAL_NVIC_EnableIRQ( BUTTON_OSTC_IRQn );
880 }
881
882 static void EXTI_Wakeup_Button_DeInit(void)
883 {
884 GPIO_InitTypeDef GPIO_InitStructure;
885
886 GPIO_InitStructure.Mode = GPIO_MODE_ANALOG;
887 GPIO_InitStructure.Speed = GPIO_SPEED_LOW;
888 GPIO_InitStructure.Pull = GPIO_NOPULL;
889
890 GPIO_InitStructure.Pin = BUTTON_OSTC_GPIO_PIN;
891 HAL_GPIO_Init( BUTTON_OSTC_GPIO_PORT, &GPIO_InitStructure );
892 HAL_NVIC_DisableIRQ( BUTTON_OSTC_IRQn );
893 }
894
895 static void EXTI_Test_Button_Init(void)
896 {
897 GPIO_InitTypeDef GPIO_InitStructure;
898
899 BUTTON_TEST_GPIO_CLK_ENABLE();
900 GPIO_InitStructure.Pin = BUTTON_TEST_GPIO_PIN;
901 GPIO_InitStructure.Mode = GPIO_MODE_IT_FALLING;
902 GPIO_InitStructure.Pull = GPIO_PULLUP;
903 HAL_GPIO_Init( BUTTON_TEST_GPIO_PORT, &GPIO_InitStructure );
904 HAL_NVIC_SetPriority( BUTTON_TEST_IRQn, 0x0F, 0 );
905 HAL_NVIC_EnableIRQ( BUTTON_TEST_IRQn );
906 }
907
908 static void EXTI_Test_Button_DeInit(void)
909 {
910 GPIO_InitTypeDef GPIO_InitStructure;
911
912 GPIO_InitStructure.Mode = GPIO_MODE_ANALOG;
913 GPIO_InitStructure.Speed = GPIO_SPEED_LOW;
914 GPIO_InitStructure.Pull = GPIO_NOPULL;
915
916 GPIO_InitStructure.Pin = BUTTON_TEST_GPIO_PIN;
917 HAL_GPIO_Init( BUTTON_TEST_GPIO_PORT, &GPIO_InitStructure );
918 HAL_NVIC_DisableIRQ( BUTTON_TEST_IRQn );
919 }
920
921 static void MX_EXTI_wireless_Init(void)
922 {
923 GPIO_InitTypeDef GPIO_InitStructure;
924
925 WIRELSS_POWER_HAL_RCC_GPIO_CLK_ENABLE();
926 GPIO_InitStructure.Pin = WIRELSS_POWER_GPIO_PIN;
927 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
928 GPIO_InitStructure.Pull = GPIO_NOPULL;
929 HAL_GPIO_Init( WIRELSS_POWER_GPIO_PORT, &GPIO_InitStructure );
930 HAL_GPIO_WritePin( WIRELSS_POWER_GPIO_PORT, WIRELSS_POWER_GPIO_PIN,
931 GPIO_PIN_SET );
932
933 WIRELSS_RISING_HAL_RCC_GPIO_CLK_ENABLE();
934 GPIO_InitStructure.Pin = WIRELSS_RISING_GPIO_PIN;
935 GPIO_InitStructure.Mode = GPIO_MODE_IT_RISING;
936 GPIO_InitStructure.Pull = GPIO_NOPULL;
937 HAL_GPIO_Init( WIRELSS_RISING_GPIO_PORT, &GPIO_InitStructure );
938
939 HAL_NVIC_SetPriority( WIRELSS_RISING_IRQn, 0x02, 0 );
940 HAL_NVIC_EnableIRQ( WIRELSS_RISING_IRQn );
941
942 WIRELSS_FALLING_HAL_RCC_GPIO_CLK_ENABLE();
943 GPIO_InitStructure.Pin = WIRELSS_FALLING_GPIO_PIN;
944 GPIO_InitStructure.Mode = GPIO_MODE_IT_FALLING;
945 GPIO_InitStructure.Pull = GPIO_NOPULL;
946 HAL_GPIO_Init( WIRELSS_FALLING_GPIO_PORT, &GPIO_InitStructure );
947
948 HAL_NVIC_SetPriority( WIRELSS_FALLING_IRQn, 0x02, 0 );
949 HAL_NVIC_EnableIRQ( WIRELSS_FALLING_IRQn );
950
951 }
952
953 static void MX_EXTI_wireless_DeInit(void)
954 {
955 GPIO_InitTypeDef GPIO_InitStructure;
956
957 GPIO_InitStructure.Mode = GPIO_MODE_ANALOG;
958 GPIO_InitStructure.Speed = GPIO_SPEED_LOW;
959 GPIO_InitStructure.Pull = GPIO_NOPULL;
960
961 GPIO_InitStructure.Pin = WIRELSS_RISING_GPIO_PIN;
962 HAL_GPIO_Init( WIRELSS_RISING_GPIO_PORT, &GPIO_InitStructure );
963
964 GPIO_InitStructure.Pin = WIRELSS_FALLING_GPIO_PIN;
965 HAL_GPIO_Init( WIRELSS_FALLING_GPIO_PORT, &GPIO_InitStructure );
966
967 GPIO_InitStructure.Pin = WIRELSS_POWER_GPIO_PIN;
968 HAL_GPIO_Init( WIRELSS_POWER_GPIO_PORT, &GPIO_InitStructure );
969
970 HAL_NVIC_DisableIRQ( WIRELSS_RISING_IRQn );
971 HAL_NVIC_DisableIRQ( WIRELSS_FALLING_IRQn );
972 }
973
974 /* NUCLEO C 13
975 KEY_BUTTON_GPIO_CLK_ENABLE();
976 GPIO_InitStructure.Mode = GPIO_MODE_IT_FALLING;
977 GPIO_InitStructure.Pull = GPIO_NOPULL;
978 GPIO_InitStructure.Pin = KEY_BUTTON_PIN;
979 HAL_GPIO_Init(KEY_BUTTON_GPIO_PORT, &GPIO_InitStructure);
980 HAL_NVIC_SetPriority(KEY_BUTTON_EXTI_IRQn, 2, 0);
981 HAL_NVIC_EnableIRQ(KEY_BUTTON_EXTI_IRQn);
982 */
983
984 /**
985 * @brief Wake Up Timer callback
986 * @param hrtc: RTC handle
987 * @retval None
988 */
989
990 /*
991 void HAL_RTCEx_WakeUpTimerEventCallback(RTC_HandleTypeDef *hrtc)
992 {
993 static uint8_t uwCounter = 0;
994 uwCounter = 1;
995 }
996 */
997
998 void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *I2cHandle)
999 {
1000
1001 }
1002
1003 void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *I2cHandle)
1004 {
1005
1006 }
1007
1008 void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *I2cHandle)
1009 {
1010
1011 }
1012
1013 void sleep_prepare(void)
1014 {
1015 EXTI_Wakeup_Button_Init();
1016 /*
1017 GPIO_InitStruct.Pull = GPIO_PULLUP;
1018 GPIO_InitStruct.Pin = GPIO_PIN_0;
1019 HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
1020 */
1021 compass_sleep();
1022 HAL_Delay( 100 );
1023 accelerator_sleep();
1024 HAL_Delay( 100 );
1025
1026 I2C_DeInit();
1027 MX_SPI_DeInit();
1028 MX_SPI3_DeInit();
1029 ADCx_DeInit();
1030
1031 GPIO_InitTypeDef GPIO_InitStruct;
1032
1033 __HAL_RCC_GPIOA_CLK_ENABLE();
1034 __HAL_RCC_GPIOB_CLK_ENABLE();
1035 __HAL_RCC_GPIOC_CLK_ENABLE();
1036 __HAL_RCC_GPIOH_CLK_ENABLE();
1037
1038 GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
1039 GPIO_InitStruct.Speed = GPIO_SPEED_HIGH;
1040 GPIO_InitStruct.Pull = GPIO_NOPULL;
1041 GPIO_InitStruct.Pin = GPIO_PIN_All;
1042 HAL_GPIO_Init( GPIOH, &GPIO_InitStruct );
1043 #ifdef DEBUGMODE
1044 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_3 | GPIO_PIN_8 | GPIO_PIN_9); /* debug */
1045 #endif
1046 HAL_GPIO_Init( GPIOB, &GPIO_InitStruct );
1047
1048 GPIO_InitStruct.Pin = GPIO_PIN_All
1049 ^ ( GPIO_PIN_0 | GPIO_PIN_1 | GPIO_PIN_2 | GPIO_PIN_14 | GPIO_PIN_15); /* power off & charger in & charge out & OSC32*/
1050 HAL_GPIO_Init( GPIOC, &GPIO_InitStruct );
1051
1052 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0);
1053 #ifdef DEBUGMODE
1054 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0 | GPIO_PIN_13 | GPIO_PIN_14); /* wake up button & debug */
1055 #endif
1056 HAL_GPIO_Init( GPIOA, &GPIO_InitStruct );
1057
1058 GPIO_InitStruct.Pin = GPIO_PIN_All;
1059 HAL_GPIO_Init( GPIOH, &GPIO_InitStruct );
1060
1061 GPIO_Power_MainCPU_OFF();
1062
1063 #ifndef DEBUGMODE
1064 __HAL_RCC_GPIOB_CLK_DISABLE();
1065 #endif
1066 __HAL_RCC_GPIOH_CLK_DISABLE();
1067
1068 HAL_Delay( 1000 );
1069 }
1070
1071 /*
1072 void sleep_test(void)
1073 {
1074 GPIO_InitTypeDef GPIO_InitStruct;
1075
1076 __HAL_RCC_GPIOA_CLK_ENABLE();
1077 __HAL_RCC_GPIOB_CLK_ENABLE();
1078 __HAL_RCC_GPIOC_CLK_ENABLE();
1079 __HAL_RCC_GPIOH_CLK_ENABLE();
1080
1081 GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
1082 GPIO_InitStruct.Speed = GPIO_SPEED_HIGH;
1083 GPIO_InitStruct.Pull = GPIO_NOPULL;
1084 GPIO_InitStruct.Pin = GPIO_PIN_All;
1085 HAL_GPIO_Init(GPIOH, &GPIO_InitStruct);
1086 HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
1087
1088 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0 | GPIO_PIN_15 | GPIO_PIN_14);
1089 HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
1090
1091 GPIO_InitStruct.Pin = GPIO_PIN_All ^ ( GPIO_PIN_0);
1092 HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
1093
1094 GPIO_Power_MainCPU_OFF();
1095
1096 GPIO_InitStruct.Pull = GPIO_PULLUP;
1097 GPIO_InitStruct.Pin = GPIO_PIN_0;
1098 HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
1099
1100 // __HAL_RCC_GPIOA_CLK_DISABLE();
1101 __HAL_RCC_GPIOB_CLK_DISABLE();
1102 // __HAL_RCC_GPIOC_CLK_DISABLE();
1103 __HAL_RCC_GPIOH_CLK_DISABLE();
1104
1105
1106 HAL_Delay(5000);
1107 while(1)
1108 {
1109 RTC_StopMode_2seconds();
1110 HAL_Delay(200);
1111 }
1112 }
1113 */
1114
1115 #ifdef USE_FULL_ASSERT
1116
1117 /**
1118 * @brief Reports the name of the source file and the source line number
1119 * where the assert_param error has occurred.
1120 * @param file: pointer to the source file name
1121 * @param line: assert_param error line source number
1122 * @retval None
1123 */
1124 void assert_failed(uint8_t* file, uint32_t line)
1125 {
1126 /* User can add his own implementation to report the file name and line number,
1127 ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
1128
1129 /* Infinite loop */
1130 while (1)
1131 {
1132 }
1133 }
1134 #endif
1135
1136 /**
1137 * @}
1138 */
1139
1140 /**
1141 * @}
1142 */
1143
1144 /************************ (C) COPYRIGHT heinrichs weikamp *****END OF FILE****/