Mercurial > public > ostc4
annotate Discovery/Src/base.c @ 94:c6d284ea265b kittz
reduce i2c speed and dutycycle for compass stability
author | Dmitry Romanov <kitt@bk.ru> |
---|---|
date | Mon, 26 Nov 2018 12:20:31 +0300 |
parents | 8b0fadd413c6 |
children | 2a74647d28d1 |
rev | line source |
---|---|
38 | 1 /////////////////////////////////////////////////////////////////////////////// |
2 /// -*- coding: UTF-8 -*- | |
3 /// | |
4 /// \file Discovery/Src/base.c | |
5 /// \brief main(): init hardware, IRQs and start sub-systems | |
6 /// \author heinrichs weikamp gmbh | |
7 /// \date 26-February-2014 | |
8 /// | |
9 /// $Id$ | |
10 /////////////////////////////////////////////////////////////////////////////// | |
11 /// \par Copyright (c) 2014-2018 Heinrichs Weikamp gmbh | |
12 /// | |
13 /// This program is free software: you can redistribute it and/or modify | |
14 /// it under the terms of the GNU General Public License as published by | |
15 /// the Free Software Foundation, either version 3 of the License, or | |
16 /// (at your option) any later version. | |
17 /// | |
18 /// This program is distributed in the hope that it will be useful, | |
19 /// but WITHOUT ANY WARRANTY; without even the implied warranty of | |
20 /// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
21 /// GNU General Public License for more details. | |
22 /// | |
23 /// You should have received a copy of the GNU General Public License | |
24 /// along with this program. If not, see <http://www.gnu.org/licenses/>. | |
25 ////////////////////////////////////////////////////////////////////////////// | |
26 | |
27 /** | |
28 @verbatim | |
29 ============================================================================== | |
30 ##### Firmware Info ##### | |
31 ============================================================================== | |
32 [..] In settings.c including text and magic stuff | |
33 ============================================================================== | |
34 ##### IRQs ##### | |
35 ============================================================================== | |
36 [..] The IRQs are very important and most functions should only run there. | |
37 | |
38 PreemptPriority are as follows | |
39 (#) 2 (low) sprintf _only_ here. Don't use in maintask or anywhere else. | |
40 Called by Buttons und Timer3 | |
41 Timer3 is 1/10 second | |
42 (#) 1 (mid) anything that should work while in IRQ2 like HalDelay(), VSYNC | |
43 and DMA2D Transfer Complete for housekeepingFrame(); | |
44 (#) 0 (high) _very very short_ interrupts like The HAL hardware part for | |
45 spi, uart, i2c. | |
46 | |
47 SubPriority within PreemptPriority give the order to execute. | |
48 Introduced 30.Oct.14 as it used by several HAL examples. | |
49 Three levelAmbients are available (2 low,1 mid,0 high) | |
50 | |
51 The STM32F4 has 4bits for IRQ levelAmbients, divided 2/2 in this code | |
52 with the NVIC_PRIORITYGROUP_2 setting. | |
53 | |
54 ============================================================================== | |
55 ##### MainTask ##### | |
56 ============================================================================== | |
57 [..] For everthing slow without importance to be 'in time'. | |
58 Like VPM and Buehlmann. | |
59 No sprintf and probably no GFX_SetFramesTopBottom() stuff neither. | |
60 If sprintf is called while sprintf is executed it blows up everything. | |
61 | |
62 ============================================================================== | |
63 ##### Frames / the external SDRAM ##### | |
64 ============================================================================== | |
65 [..] The SDRAM is handled by getFrame() and releaseFrame(). | |
66 Each frame with 800*480*2 Bytes. | |
67 Be carefull to release every frame | |
68 otherwise there will be a memory leakage over time. | |
69 housekeepingFrame() in the MainTask takes care of cleaning the frames. | |
70 All frames are filled with 0x00. This will be transparent with color of | |
71 CLUT_Font020 (is CLUT 0) if the alpha is set for a 16bit pair. | |
72 housekeepingFrame() delays the cleaning of frames still used as screen | |
73 buffer to prevent flickering. | |
74 | |
75 [..] use global variable frameCounter[] in gfxengine.c to control memory | |
76 all but the last three are identical to caller_id | |
77 for example 0x05 are the menu frames | |
78 the last but one is a sum for higher numbers (shouldn't be any) | |
79 the last but one are those in status RELEASED | |
80 the last are those CLEAR (as of 151202 down to 4 in logbook mode) | |
81 | |
82 [..] 4 pages are used for two double memories for screenshots (since Nov. 15) | |
83 | |
84 ============================================================================== | |
85 ##### Display ##### | |
86 ============================================================================== | |
87 [..] There is a Top layer, Bottom layer and background color. | |
88 All are perfectly alpha-blended by hardware. | |
89 | |
90 (#) top layer has 800x480 option function calls only | |
91 as it is not used for cursors here | |
92 (#) bottom layer has free size and start option to be used | |
93 for cursors (or sprites in the future ;-) | |
94 (#) background only black in the moment. | |
95 ToDo: Could be anything else for warnings etc. | |
96 if needed | |
97 | |
98 [..] Frame updates, switching and cursors is done with | |
99 | |
100 (#) GFX_SetFramesTopBottom() and the subset | |
101 GFX_SetFrameTop() + GFX_SetFrameBottom() | |
102 Those do not change anything on the display but give commands to.. | |
103 (#) GFX_change_LTDC() The only place that changes the pointer. | |
104 This prevents erratic behaviour if several changes | |
105 are made within one refresh rate of the screen. | |
106 Is called in IRQ by PD4 and HAL_GPIO_EXTI_IRQHandler | |
107 from VSYNC signal. | |
108 | |
109 [..] Content | |
110 | |
111 (#) Colors by LookupTable only. This could be modified by | |
112 system settings in the future. (gfx_color.h/.c) | |
113 | |
114 (#) Text by text_multilinguage.h/.c with one char | |
115 necessary only starting from '\x80' | |
116 with automatic language switch by | |
117 selected_language in SSettings | |
118 see openEdit_Language() in tMenuEditSystem.c | |
119 Therefore there are differnent functions | |
120 for example: | |
121 write_label_fix() for single char multilanguage | |
122 write_label_var() for strings that could include | |
123 multilanguage as well | |
124 see GFX_write_string() to get an overview of the controls | |
125 as well as the command list in gfx_engine.h | |
126 There is no clear before writing, text overlay is always on. | |
127 Many options to have LargeFont.SmallFont for numbers etc. | |
128 | |
129 ============================================================================== | |
130 ##### Update, DualBoot and build-in FLASH memory usage ##### | |
131 ============================================================================== | |
132 [..] Boot0 pin, Boot1/PB2 pin and BFB2 software bit control the behaviour. | |
133 PB2 should be tied to GND. | |
134 Boot0 == VDD -> bootloader on start, otherwise boot from Bank1 or Bank2 | |
135 depending on BFB2. | |
136 Bank2 contains the Fonts and should contain a proper test code in future | |
137 Bank1 is the main code (Bank1 is 1 MB too, usage as of Oct. 14 is 200 KB) | |
138 [..] Bootloader should be either UART or USB (on FS pins _only_) | |
139 USB HS to FS like on the Eval board does not work. | |
140 [..] Bootloader for the smaller CPU2 is implemented via the SPI used for DMA copy. | |
141 | |
142 ============================================================================== | |
143 ##### Connection to CPU2 (STM32F411 as of Oct.14 ##### | |
144 ============================================================================== | |
145 [..] Connected via SPI and DMA for every purpose. | |
146 two entire arrays are transfered for data security reasons | |
147 with respect to master (STM32F429) might interrupt internal | |
148 data copy in CPU2 (like hi byte, low byte, etc.). | |
149 [..] The entire life data is calculated in CPU2. Like tissues, CNS,... | |
150 Therefore the main unit is _not_ necessarily a Real Time system. | |
151 Simulation on the main unit can be executed without disrupting life data. | |
152 [..] SPI is triggered and timed by calling DataEX_call() in data_exchange_main.c | |
153 DataEX_copy_to_LifeData() does the transfer from buffer to variables used. | |
154 | |
155 ============================================================================== | |
156 ##### Menu, MenuEdit, Info ##### | |
157 ============================================================================== | |
158 [..] tMenu.c, tMenuEdit.c and tInfo.c is the system used. | |
159 logbook is part of Info not Menu. | |
160 The Info Menu is accessed by button 'Back' | |
161 The regular Menu is accessed by button 'Enter' | |
162 [..] Menu content is kept in frame memory for fast access. | |
163 There is no need to build pages if the 'Enter' button is pressed. | |
164 This is in contrast to MenuEdit pages. | |
165 [..] Button control for new pages (and pages in general) have to implemented | |
166 in tMenu.c, tMenuEdit.c or tInfo.c | |
167 | |
168 [..] ToDo (Oct. 14) Timeout for menus via Timer3 / IRQ 2 | |
169 | |
170 ============================================================================== | |
171 ##### settings ##### | |
172 ============================================================================== | |
173 [..] files: settings.c, settings.h | |
174 1. adjust struct SSettings in settings.h | |
175 2. adjust const SSettings SettingsStandard in settings.c | |
176 3. adjust set_new_settings_missing_in_ext_flash() | |
177 4. adjust check_and_correct_settings() IMPORTANT as it changes values! | |
178 | |
179 ============================================================================== | |
180 ##### specials ##### | |
181 ============================================================================== | |
182 [..] There was code for vector graphics from great demos | |
183 (peridiummmm and jupiter) that can be fitted again | |
184 | |
185 ============================================================================== | |
186 ##### ppO2 sensors ##### | |
187 ============================================================================== | |
188 [..] in tCCR.c is function get_ppO2SensorWeightedResult_cbar(); | |
189 | |
190 @endverbatim | |
191 ****************************************************************************** | |
192 * @attention | |
193 * | |
194 * <h2><center>© COPYRIGHT(c) 2014 heinrichs weikamp</center></h2> | |
195 * | |
196 ****************************************************************************** | |
197 */ | |
198 | |
199 /* Includes ------------------------------------------------------------------*/ | |
200 #include "stdio.h" | |
201 #include <string.h> // for memcopy | |
202 | |
203 #include "stm32f4xx_hal.h" | |
204 #include "ostc.h" | |
205 #include "base.h" | |
206 #include "display.h" | |
207 #include "gfx_engine.h" | |
208 #include "show_logbook.h" | |
209 //#include "test_vpm.h" | |
210 #include "text_multilanguage.h" | |
211 #include "tHome.h" | |
212 #include "tInfo.h" | |
213 #include "tInfoLog.h" | |
214 #include "tMenu.h" | |
215 #include "tMenuEdit.h" | |
216 #include "tMenuEditGasOC.h" | |
217 #include "tStructure.h" | |
218 //#include "gfx_specialeffects.h" | |
219 #include "externLogbookFlash.h" | |
220 #include "tComm.h" | |
221 #include "tCCR.h" | |
222 #include "data_exchange.h" | |
223 #include "data_exchange_main.h" | |
224 #include "vpm.h" | |
225 #include "buehlmann.h" | |
226 #include "logbook.h" | |
227 #include "check_warning.h" | |
228 #include "simulation.h" | |
229 #include "decom.h" | |
230 #include "timer.h" | |
231 #include "logbook_miniLive.h" | |
232 #include "test_vpm.h" | |
233 //#include "bonexConnect.h" | |
234 #include "tDebug.h" | |
235 | |
236 #ifdef DEMOMODE | |
237 #include "demo.h" | |
238 static void TIM_DEMO_init(void); | |
239 #endif | |
240 | |
241 //#include "lodepng.h" | |
242 //#include <stdlib.h> // for malloc and free | |
243 | |
244 /** @addtogroup OSTC 4 | |
245 * @{ | |
246 */ | |
247 | |
248 /* Private typedef -----------------------------------------------------------*/ | |
249 | |
250 //#define NO_TIMEOUT | |
251 //#define QUICK_SLEEP | |
252 | |
253 /* Private define ------------------------------------------------------------*/ | |
254 //#define BUFFER_SIZE ((uint32_t)0x00177000) | |
255 //#define WRITE_READ_ADDR ((uint32_t)0x0000) | |
256 #define REFRESH_COUNT ((uint32_t)0x0569) /**< for SDRAM refresh counter (90Mhz SD clock) */ | |
257 | |
258 /* Private macro -------------------------------------------------------------*/ | |
259 /* Private variables ---------------------------------------------------------*/ | |
260 | |
261 RTC_HandleTypeDef RtcHandle; /* used to change time and date, no RTC is running on this MCU */ | |
262 TIM_HandleTypeDef TimHandle; /* used in stm32f4xx_it.c too */ | |
263 TIM_HandleTypeDef TimBacklightHandle; /* used in stm32f4xx_it.c too */ | |
264 TIM_HandleTypeDef TimDemoHandle; /* used in stm32f4xx_it.c too */ | |
265 | |
266 /* | |
267 uint32_t time_before; | |
268 uint32_t time_between; | |
269 uint32_t time_after; | |
270 */ | |
271 | |
272 /* SDRAM handler declaration */ | |
273 SDRAM_HandleTypeDef hsdram; | |
274 FMC_SDRAM_TimingTypeDef SDRAM_Timing; | |
275 FMC_SDRAM_CommandTypeDef command; | |
276 | |
277 /* This was used for Dual Boot */ | |
278 //FLASH_OBProgramInitTypeDef OBInit; | |
279 //FLASH_AdvOBProgramInitTypeDef AdvOBInit; | |
280 | |
281 /* Private variables with external access ------------------------------------*/ | |
282 | |
283 uint32_t globalStateID = 0; | |
284 uint8_t globalModeID = SURFMODE; | |
285 uint32_t time_without_button_pressed_deciseconds = 0; /**< langbeschreibung (eigenes Feld) warum diese variable verwendet wird um den sleepmode zu aktivieren */ | |
286 uint8_t bootToBootloader = 0; ///< set in tComm.c to install firmware updates, calls resetToFirmwareUpdate() | |
287 //uint8_t dataEx_VPM_call = 0; | |
288 uint8_t returnFromCommCleanUpRequest = 0; ///< use this to exit bluetooth mode and call tComm_exit() | |
289 uint32_t base_tempLightLevel = 0; | |
290 uint8_t updateButtonsToDefault = 0; | |
291 uint8_t wasFirmwareUpdateCheckBattery = 0; | |
292 | |
293 /* Private function prototypes -----------------------------------------------*/ | |
294 | |
295 static void SystemClock_Config(void); | |
296 static void Error_Handler(void); | |
297 static void SDRAM_Initialization_Sequence(SDRAM_HandleTypeDef *hsdram, FMC_SDRAM_CommandTypeDef *Command); | |
298 static void SDRAM_Config(void); | |
299 static void EXTILine_Buttons_Config(void); | |
300 static void TIM_init(void); | |
301 static void TIM_BACKLIGHT_init(void); | |
302 static uint32_t TIM_BACKLIGHT_adjust(void); | |
303 static void gotoSleep(void); | |
304 static void deco_loop(void); | |
305 static void resetToFirmwareUpdate(void); | |
306 | |
307 /* ITM Trace-------- ---------------------------------------------------------*/ | |
308 /* | |
309 #define ITM_Port8(n) (*((volatile unsigned char *)(0xE0000000+4*n))) | |
310 #define ITM_Port16(n) (*((volatile unsigned short*)(0xE0000000+4*n))) | |
311 #define ITM_Port32(n) (*((volatile unsigned long *)(0xE0000000+4*n))) | |
312 | |
313 #define DEMCR (*((volatile unsigned long *)(0xE000EDFC))) | |
314 #define TRCENA 0x01000000 | |
315 | |
316 struct __FILE { int handle; }; | |
317 FILE __stdout; | |
318 FILE __stdin; | |
319 | |
320 int fputc(int ch, FILE *f) { | |
321 if (DEMCR & TRCENA) { | |
322 while (ITM_Port32(0) == 0); | |
323 ITM_Port8(0) = ch; | |
324 } | |
325 return(ch); | |
326 } | |
327 */ | |
328 | |
329 // =============================================================================== | |
330 // main | |
331 /// @brief This function makes initializations and has the nonIRQ endless loop | |
332 /// for bluetooth and deco calculations | |
333 /// | |
334 // =============================================================================== | |
335 int main(void) | |
336 { | |
337 uint32_t pLayerInvisible; | |
338 uint16_t totalDiveCounterFound; | |
339 | |
340 set_globalState( StBoot0 ); | |
341 | |
342 HAL_Init(); | |
343 HAL_NVIC_SetPriorityGrouping( NVIC_PRIORITYGROUP_2 ); | |
344 | |
345 SystemClock_Config(); | |
346 | |
347 MX_GPIO_Init(); | |
348 // MX_SmallCPU_NO_Reset_Helper(); //161116 hw | |
349 MX_SPI_Init(); | |
350 MX_UART_Init(); | |
351 SDRAM_Config(); | |
352 HAL_Delay( 100 ); | |
353 GFX_init( &pLayerInvisible ); | |
354 | |
355 TIM_init(); | |
356 TIM_BACKLIGHT_init(); | |
357 | |
358 /* | |
359 GFX_helper_font_memory_list(&FontT24); | |
360 GFX_helper_font_memory_list(&FontT42); | |
361 GFX_helper_font_memory_list(&FontT48); | |
362 GFX_helper_font_memory_list(&FontT54); | |
363 GFX_helper_font_memory_list(&FontT84); | |
364 GFX_helper_font_memory_list(&FontT105); | |
365 GFX_helper_font_memory_list(&FontT144); | |
366 */ | |
367 | |
368 stateRealGetPointerWrite()->lastKnownBatteryPercentage = 0; // damit das nicht in settings kopiert wird. | |
369 set_settings_to_Standard(); | |
370 mod_settings_for_first_start_with_empty_ext_flash(); | |
371 ext_flash_read_settings(); | |
372 if( newFirmwareVersionCheckViaSettings() ) // test for old firmware version in loaded settings | |
373 { | |
374 wasFirmwareUpdateCheckBattery = 1; | |
375 set_settings_button_to_standard_with_individual_buttonBalance(); // will adapt individual values | |
376 } | |
377 //settingsGetPointer()->bluetoothActive = 0; /* MX_Bluetooth_PowerOff(); unnecessary as part of MX_GPIO_Init() */ | |
378 //settingsGetPointer()->compassBearing = 0; | |
379 set_new_settings_missing_in_ext_flash(); // inlcudes update of firmware version 161121 | |
380 | |
381 // new 170508: bluetooth on at start | |
382 settingsGetPointer()->bluetoothActive = 1; | |
383 MX_Bluetooth_PowerOn(); | |
384 | |
385 // Haase Geburtstag: | |
386 // settingsGetPointer()->serialHigh = (3012 / 256); | |
387 // settingsGetPointer()->serialLow = (3012 & 0xFF); | |
388 | |
389 // settingsGetPointer()->showDebugInfo = 1; | |
390 | |
391 /* | |
392 if(settingsGetPointer()->scooterControl) | |
393 { | |
394 settingsGetPointer()->bluetoothActive = 1; | |
395 MX_Bluetooth_PowerOn(); | |
396 if(settingsGetPointer()->scooterDeviceAddress[0] != 0) | |
397 bC_setConnectRequest(); | |
398 } | |
399 */ | |
400 /* | |
401 if( (hardwareDataGetPointer()->primarySerial == 20+18) | |
402 || (hardwareDataGetPointer()->primarySerial == 20+25) | |
403 || (hardwareDataGetPointer()->primarySerial == 20+27)) | |
404 { | |
405 MX_Bluetooth_PowerOn(); | |
406 tComm_Set_Bluetooth_Name(1); | |
407 } | |
408 */ | |
409 errorsInSettings = check_and_correct_settings(); | |
410 createDiveSettings(); | |
411 | |
412 #ifdef QUICK_SLEEP | |
413 settingsGetPointer()->timeoutSurfacemode = 20; | |
414 #else | |
415 settingsGetPointer()->timeoutSurfacemode = 120; | |
416 #endif | |
417 | |
418 #ifdef DEMOMODE | |
419 demoConfigureSettings(); | |
420 TIM_DEMO_init(); | |
421 #endif | |
422 | |
423 // ----------------------------- | |
424 | |
425 display_power_on__1_of_2__pre_RGB(); | |
426 GFX_LTDC_Init(); | |
427 GFX_LTDC_LayerDefaultInit( TOP_LAYER, pLayerInvisible ); | |
428 GFX_LTDC_LayerDefaultInit( BACKGRD_LAYER, pLayerInvisible ); | |
429 GFX_SetFramesTopBottom( pLayerInvisible, pLayerInvisible, 480 ); | |
430 HAL_Delay( 20 ); | |
431 display_power_on__2_of_2__post_RGB(); | |
432 GFX_use_colorscheme( settingsGetPointer()->tX_colorscheme ); | |
433 | |
434 // ----------------------------- | |
435 tHome_init(); | |
436 tI_init(); | |
437 tM_init(); | |
438 tMenuEdit_init(); | |
439 tInfoLog_init(); | |
440 tComm_init(); | |
441 DataEX_init(); | |
442 setButtonResponsiveness( settingsGetPointer()->ButtonResponsiveness ); | |
443 set_globalState_tHome(); | |
444 | |
445 GFX_start_VSYNC_IRQ(); | |
446 tCCR_init(); | |
447 | |
448 GFX_logoAutoOff(); | |
449 EXTILine_Buttons_Config(); | |
450 | |
451 ext_flash_repair_dive_log(); | |
452 //ext_flash_repair_SPECIAL_dive_numbers_starting_count_with(1); | |
453 | |
454 totalDiveCounterFound = logbook_lastDive_diveNumber(); | |
455 if( settingsGetPointer()->totalDiveCounter < totalDiveCounterFound ) | |
456 settingsGetPointer()->totalDiveCounter = totalDiveCounterFound; | |
457 | |
458 if( settingsGetPointer()->debugModeOnStart ) | |
459 { | |
460 settingsGetPointer()->debugModeOnStart = 0; | |
461 ext_flash_write_settings(); | |
462 setDebugMode(); | |
463 openInfo( StIDEBUG ); | |
464 } | |
465 | |
466 /* @brief main LOOP | |
467 * | |
468 * this is executed while no IRQ interrupts it | |
469 * - deco calculation | |
470 * - bluetooth | |
471 * and resetToFirmwareUpdate() | |
472 * because tComm_control() does not exit before disconnection | |
473 */ | |
474 while( 1 ) | |
475 { | |
476 if( bootToBootloader ) | |
477 resetToFirmwareUpdate(); | |
478 | |
479 // this will allways reset after RTE reset -> no good! | |
480 // if(DataEX_was_power_on()) // new to allow for update after RTE update | |
481 // resetToFirmwareUpdate(); | |
482 | |
483 tCCR_control(); | |
484 if( tComm_control() )// will stop while loop if tComm Mode started until exit from UART | |
485 { | |
486 createDiveSettings(); | |
487 updateMenu(); | |
488 ext_flash_write_settings(); | |
489 } | |
490 deco_loop(); | |
491 /* | |
492 bonexControl(); | |
493 if(bC_getStatus() == BC_DISCONNECTED) | |
494 { | |
495 if(tComm_control()) // will stop while loop if tComm Mode started until exit from UART | |
496 { | |
497 createDiveSettings(); | |
498 updateMenu(); | |
499 ext_flash_write_settings(); | |
500 } | |
501 } | |
502 */ | |
503 } | |
504 } | |
505 | |
506 // =============================================================================== | |
507 // timer IRQ | |
508 /// @brief this is called periodically | |
509 /// | |
510 /// - refresh screen (the actual change is done in the VSYNC IRQ) | |
511 /// - start data transfer with RTE / small CPU (DateEX....) | |
512 /// - update logbook | |
513 /// - timeouts | |
514 /// .... | |
515 /// | |
516 /// all this in three steps / switch() routines in a given order | |
517 /// as the previous switch() might influence the next functions | |
518 /// to be called | |
519 /// | |
520 // =============================================================================== | |
521 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) | |
522 { | |
91
8b0fadd413c6
First stable. With minimal button sensitivity fix(for broken buttons)
Dmitry Romanov <kitt@bk.ru>
parents:
89
diff
changeset
|
523 // DataEX_call(); |
38 | 524 #ifdef DEMOMODE |
525 if(htim->Instance==TIM7) | |
526 { | |
527 HAL_GPIO_EXTI_Callback(demoGetCommand()); | |
528 return; | |
529 } | |
530 #endif | |
531 static uint8_t last_base; | |
532 | |
533 SStateList status; | |
534 uint32_t timeout_in_seconds; | |
535 uint32_t timeout_limit_Surface_in_seconds; | |
536 | |
537 _Bool InDiveMode = 0; | |
538 _Bool modeChange = 0; // to exit from menu and logbook | |
539 | |
540 if(stateUsed->mode == MODE_DIVE) | |
541 InDiveMode = 1; | |
542 else | |
543 InDiveMode = 0; | |
544 | |
545 if(returnFromCommCleanUpRequest) | |
546 { | |
547 tComm_exit(); | |
548 returnFromCommCleanUpRequest = 0; | |
549 } | |
550 | |
551 get_globalStateList(&status); | |
552 | |
553 switch(status.base) | |
554 { | |
555 case BaseHome: | |
556 case BaseMenu: | |
557 case BaseInfo: | |
558 updateSetpointStateUsed(); | |
559 DateEx_copy_to_dataOut(); | |
91
8b0fadd413c6
First stable. With minimal button sensitivity fix(for broken buttons)
Dmitry Romanov <kitt@bk.ru>
parents:
89
diff
changeset
|
560 DataEX_call(); |
38 | 561 DataEX_copy_to_LifeData(&modeChange); |
562 //foto session :-) stateRealGetPointerWrite()->lifeData.battery_charge = 99; | |
563 //foto session :-) stateSimGetPointerWrite()->lifeData.battery_charge = 99; | |
564 DataEX_copy_to_deco(); | |
565 if(stateUsed == stateSimGetPointer()) | |
566 simulation_UpdateLifeData(1); | |
567 check_warning(); | |
568 if(stateUsed == stateRealGetPointer()) | |
569 logbook_InitAndWrite(); | |
570 updateMiniLiveLogbook(1); | |
571 timer_UpdateSecond(1); | |
572 base_tempLightLevel = TIM_BACKLIGHT_adjust(); | |
573 tCCR_tick(); | |
574 tHome_tick(); | |
575 if(status.base == BaseHome) | |
576 tMenuEdit_writeSettingsToFlash(); // takes 900 ms!! | |
577 break; | |
578 case BaseStop: | |
579 DateEx_copy_to_dataOut(); | |
91
8b0fadd413c6
First stable. With minimal button sensitivity fix(for broken buttons)
Dmitry Romanov <kitt@bk.ru>
parents:
89
diff
changeset
|
580 DataEX_call(); |
38 | 581 DataEX_control_connection_while_asking_for_sleep(); |
582 break; | |
583 default: | |
584 case BaseComm: | |
585 if(get_globalState() == StUART_RTECONNECT) | |
586 { | |
587 DateEx_copy_to_dataOut(); | |
91
8b0fadd413c6
First stable. With minimal button sensitivity fix(for broken buttons)
Dmitry Romanov <kitt@bk.ru>
parents:
89
diff
changeset
|
588 DataEX_call(); |
38 | 589 DataEX_copy_to_LifeData(0); |
590 } | |
591 break; | |
592 } | |
593 | |
594 /* timeout control */ | |
595 if(modeChange) ///< from RTE, set in data_exchange_main.c | |
596 time_without_button_pressed_deciseconds = (settingsGetPointer()->timeoutSurfacemode / 4) * 3; | |
597 if(status.base != last_base) | |
598 time_without_button_pressed_deciseconds = 0; | |
599 last_base = status.base; | |
600 timeout_in_seconds = time_without_button_pressed_deciseconds / 10; | |
601 time_without_button_pressed_deciseconds += 1; | |
602 if(modeChange || (timeout_in_seconds != time_without_button_pressed_deciseconds / 10)) | |
603 { | |
604 #ifdef NO_TIMEOUT | |
605 timeout_in_seconds = 0; | |
606 #else | |
607 timeout_in_seconds += 1; | |
608 #endif | |
609 | |
610 if(InDiveMode) | |
611 { | |
612 switch(status.base) | |
613 { | |
614 case BaseHome: | |
615 if((status.line != 0) && (timeout_in_seconds >= settingsGetPointer()->timeoutEnterButtonSelectDive)) | |
616 { | |
617 set_globalState(StD); | |
618 timeout_in_seconds = 0; | |
619 } | |
620 break; | |
621 | |
622 case BaseMenu: | |
623 if((status.line == 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuDive) || modeChange)) | |
624 { | |
625 exitMenu(); | |
626 timeout_in_seconds = 0; | |
627 } | |
628 if((status.line != 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuEdit) || modeChange)) | |
629 { | |
630 exitMenuEdit_to_Home(); | |
631 timeout_in_seconds = 0; | |
632 } | |
633 break; | |
634 /* why was this here? 160317 hw | |
635 case BaseInfo: | |
636 if(status.page == InfoPageLogList) | |
637 { | |
638 exitLog(); | |
639 } | |
640 else | |
641 if(status.page == InfoPageLogShow) | |
642 { | |
643 show_logbook_exit(); | |
644 exitLog(); | |
645 } | |
646 else | |
647 if(status.page != InfoPageCompass) | |
648 { | |
649 exitInfo(); | |
650 } | |
651 timeout_in_seconds = 0; | |
652 break; | |
653 */ | |
654 default: | |
655 break; | |
656 } | |
657 } | |
658 else /* surface mode */ | |
659 { | |
660 switch(status.base) | |
661 { | |
662 case BaseHome: | |
663 // added hw 161027 | |
664 if(!(stateRealGetPointer()->warnings.lowBattery) && (stateRealGetPointer()->lifeData.battery_charge > 9)) | |
665 { | |
666 stateRealGetPointerWrite()->lastKnownBatteryPercentage = stateRealGetPointer()->lifeData.battery_charge; | |
667 } | |
668 else if((wasFirmwareUpdateCheckBattery) && (timeout_in_seconds > 3)) | |
669 { | |
670 wasFirmwareUpdateCheckBattery = 0; | |
671 setButtonResponsiveness(settingsGetPointer()->ButtonResponsiveness); // added 170306 | |
672 if( (settingsGetPointer()->lastKnownBatteryPercentage > 0) | |
673 && (settingsGetPointer()->lastKnownBatteryPercentage <= 100) | |
674 && (stateRealGetPointer()->warnings.lowBattery)) | |
675 { | |
676 setBatteryPercentage(settingsGetPointer()->lastKnownBatteryPercentage); | |
677 } | |
678 } | |
679 // stuff before and new @161121 CCR-sensor limit 10 minutes | |
680 if((settingsGetPointer()->dive_mode == DIVEMODE_CCR) && (settingsGetPointer()->CCR_Mode == CCRMODE_Sensors)) | |
681 { | |
682 timeout_limit_Surface_in_seconds = settingsGetPointer()->timeoutSurfacemodeWithSensors; | |
683 } | |
684 else | |
685 { | |
686 timeout_limit_Surface_in_seconds = settingsGetPointer()->timeoutSurfacemode; | |
687 } | |
688 if(timeout_in_seconds >= timeout_limit_Surface_in_seconds) | |
689 { | |
690 gotoSleep(); | |
691 } | |
692 break; | |
693 case BaseMenu: | |
694 if((status.line == 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuSurface) || modeChange)) | |
695 { | |
696 exitMenu(); | |
697 timeout_in_seconds = 0; | |
698 } | |
699 if((status.line != 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuEdit) || modeChange)) | |
700 { | |
701 if((status.page != (uint8_t)((StMPLAN >> 24) & 0x0F)) || (timeout_in_seconds >= 10*(settingsGetPointer()->timeoutMenuEdit))) | |
702 { | |
703 exitMenuEdit_to_Home(); | |
704 timeout_in_seconds = 0; | |
705 } | |
706 } | |
707 break; | |
708 | |
709 case BaseInfo: | |
710 if((timeout_in_seconds >= settingsGetPointer()->timeoutInfo) || modeChange) | |
711 { | |
712 if(status.page == InfoPageLogList) | |
713 { | |
714 exitLog(); | |
715 timeout_in_seconds = 0; | |
716 } | |
717 else | |
718 if(status.page == InfoPageLogShow) | |
719 { | |
720 show_logbook_exit(); | |
721 exitLog(); | |
722 timeout_in_seconds = 0; | |
723 } | |
724 else | |
725 if(status.page != InfoPageCompass) | |
726 { | |
727 exitInfo(); | |
728 timeout_in_seconds = 0; | |
729 } | |
730 } | |
731 break; | |
732 default: | |
733 break; | |
734 } | |
735 } | |
736 } | |
737 | |
738 get_globalStateList(&status); | |
739 | |
740 switch(status.base) | |
741 { | |
742 case BaseHome: | |
743 tHome_refresh(); | |
744 tM_check_content(); | |
745 break; | |
746 case BaseMenu: | |
747 tM_refresh_live_content(); | |
748 tMenuEdit_refresh_live_content(); | |
749 break; | |
750 case BaseInfo: | |
751 tInfo_refresh(); ///< only compass at the moment 23.Feb.2015 hw | |
752 break; | |
753 case BaseComm: | |
754 tComm_refresh(); | |
755 break; | |
756 default: | |
757 if(get_globalState() == StStop) | |
758 tHome_sleepmode_fun(); | |
759 break; | |
760 } | |
761 } | |
762 | |
763 | |
764 /* button and VSYNC IRQ | |
765 * | |
766 * VSYNC will switch foreground and background picture | |
767 * if demanded. see GFX_change_LTDC() | |
768 * | |
769 */ | |
770 // =============================================================================== | |
771 // HAL_GPIO_EXTI_Callback | |
772 /// @brief button and VSYNC IRQ | |
773 /// | |
774 /// VSYNC will switch foreground and background picture if demanded - | |
775 /// see GFX_change_LTDC() | |
776 /// | |
777 // =============================================================================== | |
778 void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin) | |
779 { | |
780 if(!GPIO_Pin) | |
781 return; | |
782 | |
783 uint8_t action = 0; | |
784 SStateList status; | |
785 | |
786 if(GPIO_Pin == VSYNC_IRQ_PIN) // rechts, unten | |
787 { | |
788 GFX_change_LTDC(); | |
789 housekeepingFrame(); | |
790 /* | |
791 #ifdef DEMOMODE | |
792 static uint8_t countCall = 0; | |
793 if(countCall++ < 10) | |
794 return; | |
795 countCall = 0; | |
796 uint8_t buttonAction = demoGetCommand(); | |
797 if(buttonAction) | |
798 GPIO_Pin = buttonAction; | |
799 else | |
800 #endif | |
801 */ | |
802 return; | |
803 } | |
804 | |
805 #ifdef DEMOMODE | |
806 uint8_t demoMachineCall = 0; | |
807 if(GPIO_Pin & 0x80) | |
808 { | |
809 demoMachineCall = 1; | |
810 GPIO_Pin &= 0x7F; | |
811 } | |
812 #endif | |
813 | |
814 time_without_button_pressed_deciseconds = 0; | |
815 | |
816 if(GFX_logoStatus() != 0) | |
817 return; | |
818 | |
819 if(GPIO_Pin == BUTTON_BACK_PIN) // links | |
820 action = ACTION_BUTTON_BACK; | |
821 else | |
822 if(GPIO_Pin == BUTTON_ENTER_PIN) // mitte | |
823 action = ACTION_BUTTON_ENTER; | |
824 else | |
825 if(GPIO_Pin == BUTTON_NEXT_PIN) // rechts | |
826 action = ACTION_BUTTON_NEXT; | |
827 #ifdef BUTTON_CUSTOM_PIN | |
828 else | |
829 if(GPIO_Pin == BUTTON_CUSTOM_PIN) // extra | |
830 action = ACTION_BUTTON_CUSTOM; | |
831 #endif | |
832 | |
833 #ifdef DEMOMODE // user pressed button ? | |
834 if((!demoMachineCall) && demoModeActive()) | |
835 { | |
836 demoSendCommand(action); | |
837 return; | |
838 } | |
839 #endif | |
840 | |
841 get_globalStateList(&status); | |
842 | |
843 if(action == ACTION_BUTTON_CUSTOM) | |
844 { | |
845 GFX_screenshot(); | |
846 } | |
847 | |
848 switch(status.base) | |
849 { | |
850 case BaseStop: | |
851 if(action == ACTION_BUTTON_BACK) | |
852 resetToFirmwareUpdate(); | |
853 break; | |
854 case BaseComm: | |
855 if(action == ACTION_BUTTON_BACK) | |
856 { | |
857 settingsGetPointer()->bluetoothActive = 0; | |
858 MX_Bluetooth_PowerOff(); | |
859 tComm_exit(); | |
860 } | |
861 break; | |
862 case BaseHome: | |
863 if(action == ACTION_BUTTON_NEXT) | |
864 { | |
865 if(status.page == PageSurface) | |
866 openMenu(1); | |
867 else | |
868 tHomeDiveMenuControl(action); | |
869 } | |
870 else | |
871 if(action == ACTION_BUTTON_BACK) | |
872 { | |
873 if(get_globalState() == StS) | |
874 openInfo(StILOGLIST); | |
875 else | |
876 if((status.page == PageDive) && (settingsGetPointer()->design < 7)) | |
877 { | |
878 settingsGetPointer()->design = 7; // auto switch to 9 if necessary | |
879 } | |
880 else | |
881 if((status.page == PageDive) && (status.line != 0)) | |
882 { | |
883 if(settingsGetPointer()->extraDisplay == EXTRADISPLAY_BIGFONT) | |
884 settingsGetPointer()->design = 3; | |
885 else | |
886 if(settingsGetPointer()->extraDisplay == EXTRADISPLAY_DECOGAME) | |
887 settingsGetPointer()->design = 4; | |
888 | |
889 set_globalState(StD); | |
890 } | |
891 else | |
892 tHome_change_field_button_pressed(); | |
893 } | |
894 else | |
895 if(action == ACTION_BUTTON_ENTER) | |
896 { | |
897 if((status.page == PageDive) && (status.line == 0)) | |
898 tHome_change_customview_button_pressed(); | |
899 else | |
900 if(status.page == PageSurface) | |
901 tHome_change_customview_button_pressed(); | |
902 else | |
903 tHomeDiveMenuControl(action); | |
904 } | |
905 break; | |
906 | |
907 case BaseMenu: | |
908 if(status.line == 0) | |
909 sendActionToMenu(action); | |
910 else | |
911 sendActionToMenuEdit(action); | |
912 break; | |
913 | |
914 case BaseInfo: | |
915 if(status.page == InfoPageLogList) | |
916 sendActionToInfoLogList(action); | |
917 else | |
918 if(status.page == InfoPageLogShow) | |
919 sendActionToInfoLogShow(action); | |
920 else | |
921 sendActionToInfo(action); | |
922 break; | |
923 | |
924 default: | |
925 break; | |
926 } | |
927 } | |
928 | |
929 | |
930 void gotoSleep(void) | |
931 { | |
932 /* not at the moment of testing */ | |
933 // ext_flash_erase_firmware_if_not_empty(); | |
934 GFX_logoAutoOff(); | |
935 set_globalState(StStop); | |
936 } | |
937 | |
938 | |
939 // ----------------------------- | |
940 | |
941 uint8_t get_globalMode(void) | |
942 { | |
943 return globalModeID; | |
944 } | |
945 | |
946 | |
947 void set_globalMode(uint8_t newMode) | |
948 { | |
949 if((newMode != DIVEMODE) && (newMode != SURFMODE)) | |
950 return; | |
951 | |
952 globalModeID = newMode; | |
953 } | |
954 | |
955 | |
956 uint32_t get_globalState(void) | |
957 { | |
958 return globalStateID; | |
959 } | |
960 | |
961 | |
962 void get_globalStateList(SStateList *output) | |
963 { | |
964 output->base = (uint8_t)((globalStateID >> 28) & 0x0F); | |
965 output->page = (uint8_t)((globalStateID >> 24) & 0x0F); | |
966 output->line = (uint8_t)((globalStateID >> 16) & 0xFF); | |
967 output->field = (uint8_t)((globalStateID >> 8) & 0xFF); | |
968 output->mode = (uint8_t)((globalStateID ) & 0xFF); | |
969 } | |
970 | |
971 | |
972 void get_idSpecificStateList(uint32_t id, SStateList *output) | |
973 { | |
974 output->base = (uint8_t)((id >> 28) & 0x0F); | |
975 output->page = (uint8_t)((id >> 24) & 0x0F); | |
976 output->line = (uint8_t)((id >> 16) & 0xFF); | |
977 output->field = (uint8_t)((id >> 8) & 0xFF); | |
978 output->mode = (uint8_t)((id ) & 0xFF); | |
979 } | |
980 | |
981 | |
982 void set_globalState_Menu_Page(uint8_t page) | |
983 { | |
984 globalStateID = ((BaseMenu << 28) + (page << 24)); | |
985 } | |
986 | |
987 void set_globalState_Log_Page(uint8_t pageIsLine) | |
988 { | |
989 globalStateID = StILOGLIST + (pageIsLine << 16); | |
990 } | |
991 | |
992 | |
993 void set_globalState_Menu_Line(uint8_t line) | |
994 { | |
995 globalStateID = ((globalStateID & MaskLineFieldDigit) + (line << 16)); | |
996 } | |
997 | |
998 | |
999 void set_globalState(uint32_t newID) | |
1000 { | |
1001 globalStateID = newID; | |
1002 } | |
1003 | |
1004 void set_returnFromComm(void) | |
1005 { | |
1006 returnFromCommCleanUpRequest = 1; | |
1007 } | |
1008 | |
1009 uint8_t font_update_required(void) | |
1010 { | |
1011 uint8_t *fontVersionHigh; | |
1012 uint8_t *fontVersionLow; | |
1013 | |
1014 fontVersionHigh = (uint8_t *)0x08132000; | |
1015 fontVersionLow = (uint8_t *)0x08132001; | |
1016 | |
1017 if(FONTminimum_required_high() < *fontVersionHigh) | |
1018 return 0; | |
1019 | |
1020 if((FONTminimum_required_high() == *fontVersionHigh) && (FONTminimum_required_low() <= *fontVersionLow)) | |
1021 return 0; | |
1022 | |
1023 return 1; | |
1024 } | |
1025 | |
1026 | |
1027 void delayMicros(uint32_t micros) | |
1028 { | |
1029 micros = micros * (168/4) - 10; | |
1030 while(micros--); | |
1031 } | |
1032 | |
1033 | |
1034 void get_RTC_DateTime(RTC_DateTypeDef * sdatestructureget, RTC_TimeTypeDef * stimestructureget) | |
1035 { | |
1036 /* Get the RTC current Time */ | |
1037 if(sdatestructureget) | |
1038 HAL_RTC_GetTime(&RtcHandle, stimestructureget, FORMAT_BIN); | |
1039 /* Get the RTC current Date */ | |
1040 if(stimestructureget) | |
1041 HAL_RTC_GetDate(&RtcHandle, sdatestructureget, FORMAT_BIN); | |
1042 } | |
1043 | |
1044 | |
1045 void set_RTC_DateTime(RTC_DateTypeDef * sdatestructure, RTC_TimeTypeDef * stimestructure) | |
1046 { | |
1047 if(sdatestructure) | |
1048 if(HAL_RTC_SetDate(&RtcHandle,sdatestructure,FORMAT_BCD) != HAL_OK) | |
1049 { | |
1050 /* Initialization Error */ | |
1051 Error_Handler(); | |
1052 } | |
1053 | |
1054 if(stimestructure) | |
1055 if(HAL_RTC_SetTime(&RtcHandle,stimestructure,FORMAT_BCD) != HAL_OK) | |
1056 { | |
1057 /* Initialization Error */ | |
1058 Error_Handler(); | |
1059 } | |
1060 } | |
1061 | |
1062 static void TIM_init(void) | |
1063 { | |
1064 uint16_t uwPrescalerValue = 0; | |
1065 | |
1066 uwPrescalerValue = (uint32_t) ((SystemCoreClock /2) / 10000) - 1; | |
1067 | |
1068 /* Set TIMx instance */ | |
1069 TimHandle.Instance = TIMx; | |
1070 | |
1071 /* Initialize TIM3 peripheral as follows: | |
1072 + Period = 10000 - 1 | |
1073 + Prescaler = ((SystemCoreClock/2)/10000) - 1 | |
1074 + ClockDivision = 0 | |
1075 + Counter direction = Up | |
1076 */ | |
1077 TimHandle.Init.Period = 1000 - 1; | |
1078 TimHandle.Init.Prescaler = uwPrescalerValue; | |
1079 TimHandle.Init.ClockDivision = 0; | |
1080 TimHandle.Init.CounterMode = TIM_COUNTERMODE_UP; | |
1081 if(HAL_TIM_Base_Init(&TimHandle) != HAL_OK) | |
1082 { | |
1083 /* Initialization Error */ | |
1084 Error_Handler(); | |
1085 } | |
1086 | |
1087 /*##-2- Start the TIM Base generation in interrupt mode ####################*/ | |
1088 /* Start Channel1 */ | |
1089 if(HAL_TIM_Base_Start_IT(&TimHandle) != HAL_OK) | |
1090 { | |
1091 /* Starting Error */ | |
1092 Error_Handler(); | |
1093 } | |
1094 } | |
1095 | |
1096 #ifdef DEMOMODE | |
1097 static void TIM_DEMO_init(void) | |
1098 { | |
1099 uint16_t uwPrescalerValue = 0; | |
1100 | |
1101 uwPrescalerValue = (uint32_t) ((SystemCoreClock /2) / 10000) - 1; | |
1102 | |
1103 /* Set TIMx instance */ | |
1104 TimDemoHandle.Instance = TIM7; | |
1105 | |
1106 /* Initialize TIM3 peripheral as follows: | |
1107 + Period = 10000 - 1 | |
1108 + Prescaler = ((SystemCoreClock/2)/10000) - 1 | |
1109 + ClockDivision = 0 | |
1110 + Counter direction = Up | |
1111 */ | |
1112 TimDemoHandle.Init.Period = 1000 - 1; | |
1113 TimDemoHandle.Init.Prescaler = uwPrescalerValue; | |
1114 TimDemoHandle.Init.ClockDivision = 0; | |
1115 TimHandle.Init.CounterMode = TIM_COUNTERMODE_UP; | |
1116 if(HAL_TIM_Base_Init(&TimDemoHandle) != HAL_OK) | |
1117 { | |
1118 /* Initialization Error */ | |
1119 Error_Handler(); | |
1120 } | |
1121 | |
1122 /*##-2- Start the TIM Base generation in interrupt mode ####################*/ | |
1123 /* Start Channel1 */ | |
1124 if(HAL_TIM_Base_Start_IT(&TimDemoHandle) != HAL_OK) | |
1125 { | |
1126 /* Starting Error */ | |
1127 Error_Handler(); | |
1128 } | |
1129 } | |
1130 #endif | |
1131 | |
1132 | |
1133 | |
1134 #ifndef TIM_BACKLIGHT | |
1135 | |
1136 static uint32_t TIM_BACKLIGHT_adjust(void) | |
1137 { | |
1138 return 0; | |
1139 } | |
1140 | |
1141 static void TIM_BACKLIGHT_init(void) | |
1142 { | |
1143 } | |
1144 #else | |
1145 static uint32_t TIM_BACKLIGHT_adjust(void) | |
1146 { | |
1147 static uint32_t levelActual = 12000; | |
1148 static uint8_t brightnessModeLast = 0; | |
1149 // static _Bool wasLostConnection = 0; | |
1150 | |
1151 uint32_t levelAmbient; | |
1152 uint32_t levelMax; | |
1153 uint32_t levelMin; | |
1154 uint32_t levelUpStep_100ms = 200; | |
1155 uint32_t levelDnStep_100ms = 20; | |
1156 | |
1157 TIM_OC_InitTypeDef sConfig; | |
1158 sConfig.OCMode = TIM_OCMODE_PWM1; | |
1159 sConfig.OCPolarity = TIM_OCPOLARITY_HIGH; | |
1160 sConfig.OCFastMode = TIM_OCFAST_DISABLE; | |
1161 | |
1162 const SDiveState * pStateReal = stateRealGetPointer(); | |
1163 | |
1164 | |
1165 // if(pStateReal->data_old__lost_connection_to_slave) | |
1166 // { | |
1167 // changed 160613 from 6000 to 12000 | |
1168 // removed hw 161209 | |
1169 // levelAmbient = 12000; | |
1170 // levelActual = 12000; | |
1171 // wasLostConnection = 1; | |
1172 // } | |
1173 // else | |
1174 // { | |
1175 SSettings *pSettings = settingsGetPointer(); | |
1176 /* 300 - 4000 */ | |
1177 /* important levelAmbient 300 - 1200 */ | |
1178 levelAmbient = 10 * pStateReal->lifeData.ambient_light_level; | |
1179 | |
1180 switch( pSettings->brightness) | |
1181 { | |
1182 case 0: /* Cave */ | |
1183 levelMax = 3000;/* max 25 % (x2) */ | |
1184 levelMin = 1500; | |
1185 break; | |
1186 case 1: /* Eco */ | |
1187 levelMax = 6000;/* max 50 % (x2) */ | |
1188 levelMin = 3000; | |
1189 break; | |
1190 case 2: /* Std */ | |
1191 levelAmbient += 1000; | |
1192 levelMax = 9000; | |
1193 levelMin = 4500; | |
1194 levelUpStep_100ms += levelUpStep_100ms/2; // 4500 instead of 3000 | |
1195 levelDnStep_100ms += levelDnStep_100ms/2; | |
1196 break; | |
1197 case 3: /* High */ | |
1198 default: | |
1199 levelAmbient += 3000; | |
1200 levelMax = 12000; /* max 100% (x2) */ | |
1201 levelMin = 6000; | |
1202 levelUpStep_100ms += levelUpStep_100ms; // 6000 instead of 3000 | |
1203 levelDnStep_100ms += levelDnStep_100ms; | |
1204 break; | |
1205 case 4: /* New Max */ | |
1206 levelAmbient = 12000; | |
1207 levelMax = 12000; /* max 100% (x2) */ | |
1208 levelMin = 12000; | |
1209 levelUpStep_100ms += 12000; | |
1210 levelDnStep_100ms += 0; | |
1211 break; | |
1212 } | |
1213 | |
1214 if((pSettings->brightness != brightnessModeLast))// || wasLostConnection) | |
1215 { | |
1216 levelActual = levelAmbient; | |
1217 brightnessModeLast = pSettings->brightness; | |
1218 // wasLostConnection = 0; | |
1219 } | |
1220 // } | |
1221 | |
1222 if(levelAmbient > levelActual) | |
1223 levelActual += levelUpStep_100ms; | |
1224 else | |
1225 if((levelAmbient < levelActual) && (levelActual > levelMin) && (levelActual > levelDnStep_100ms)) | |
1226 levelActual -= levelDnStep_100ms; | |
1227 | |
1228 if(levelActual > levelMax) | |
1229 levelActual = levelMax; | |
1230 else | |
1231 if(levelActual < levelMin) | |
1232 levelActual = levelMin; | |
1233 | |
1234 // sConfig.Pulse = levelActual / 20; | |
1235 sConfig.Pulse = (levelMin + ((levelMax - levelMin)/2)) / 20; // added 170306 | |
1236 | |
1237 /* xx - 600 */ | |
1238 if(sConfig.Pulse > 600) | |
1239 sConfig.Pulse = 600; | |
1240 else | |
1241 if(sConfig.Pulse < 100) | |
1242 sConfig.Pulse = 100; | |
1243 | |
1244 HAL_TIM_PWM_ConfigChannel(&TimBacklightHandle, &sConfig, TIM_BACKLIGHT_CHANNEL); | |
1245 HAL_TIM_PWM_Start(&TimBacklightHandle, TIM_BACKLIGHT_CHANNEL); | |
1246 | |
1247 return levelActual; | |
1248 } | |
1249 | |
1250 static void TIM_BACKLIGHT_init(void) | |
1251 { | |
1252 uint32_t uwPrescalerValue = 0; | |
1253 TIM_OC_InitTypeDef sConfig; | |
1254 | |
1255 uwPrescalerValue = (uint32_t) ((SystemCoreClock /2) / 18000000) - 1; | |
1256 | |
1257 TimBacklightHandle.Instance = TIM_BACKLIGHT; | |
1258 | |
1259 /* Initialize TIM3 peripheral as follows: | |
1260 30 kHz | |
1261 */ | |
1262 TimBacklightHandle.Init.Period = 600 - 1; | |
1263 TimBacklightHandle.Init.Prescaler = uwPrescalerValue; | |
1264 TimBacklightHandle.Init.ClockDivision = 0; | |
1265 TimBacklightHandle.Init.CounterMode = TIM_COUNTERMODE_UP; | |
1266 HAL_TIM_PWM_Init(&TimBacklightHandle); | |
1267 | |
1268 sConfig.OCMode = TIM_OCMODE_PWM1; | |
1269 sConfig.OCPolarity = TIM_OCPOLARITY_HIGH; | |
1270 sConfig.OCFastMode = TIM_OCFAST_DISABLE; | |
1271 sConfig.Pulse = 50 * 6; | |
1272 | |
1273 HAL_TIM_PWM_ConfigChannel(&TimBacklightHandle, &sConfig, TIM_BACKLIGHT_CHANNEL); | |
1274 HAL_TIM_PWM_Start(&TimBacklightHandle, TIM_BACKLIGHT_CHANNEL); | |
1275 } | |
1276 #endif | |
1277 | |
1278 | |
1279 static void EXTILine_Buttons_Config(void) | |
1280 { | |
1281 GPIO_InitTypeDef GPIO_InitStructure; | |
1282 | |
1283 BUTTON_ENTER_GPIO_ENABLE(); | |
1284 BUTTON_NEXT_GPIO_ENABLE(); | |
1285 BUTTON_BACK_GPIO_ENABLE(); | |
1286 | |
1287 /* Configure pin as weak PULLUP input */ | |
1288 /* buttons */ | |
1289 GPIO_InitStructure.Mode = GPIO_MODE_IT_RISING; | |
1290 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
1291 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
1292 | |
1293 GPIO_InitStructure.Pin = BUTTON_ENTER_PIN; | |
1294 HAL_GPIO_Init(BUTTON_ENTER_GPIO_PORT, &GPIO_InitStructure); | |
1295 | |
1296 GPIO_InitStructure.Pin = BUTTON_NEXT_PIN; | |
1297 HAL_GPIO_Init(BUTTON_NEXT_GPIO_PORT, &GPIO_InitStructure); | |
1298 | |
1299 GPIO_InitStructure.Pin = BUTTON_BACK_PIN; | |
1300 HAL_GPIO_Init(BUTTON_BACK_GPIO_PORT, &GPIO_InitStructure); | |
1301 | |
1302 /* Enable and set EXTI Line0 Interrupt to the lowest priority */ | |
1303 HAL_NVIC_SetPriority(BUTTON_ENTER_EXTI_IRQn, 2, 0); | |
1304 HAL_NVIC_SetPriority(BUTTON_NEXT_EXTI_IRQn, 2, 0); | |
1305 HAL_NVIC_SetPriority(BUTTON_BACK_EXTI_IRQn, 2, 0); | |
1306 HAL_NVIC_EnableIRQ(BUTTON_ENTER_EXTI_IRQn); | |
1307 HAL_NVIC_EnableIRQ(BUTTON_NEXT_EXTI_IRQn); | |
1308 HAL_NVIC_EnableIRQ(BUTTON_BACK_EXTI_IRQn); | |
1309 | |
1310 #ifdef BUTTON_CUSTOM_PIN | |
1311 BUTTON_CUSTOM_GPIO_ENABLE(); | |
1312 GPIO_InitStructure.Pin = BUTTON_CUSTOM_PIN; | |
1313 HAL_GPIO_Init(BUTTON_CUSTOM_GPIO_PORT, &GPIO_InitStructure); | |
1314 HAL_NVIC_SetPriority(BUTTON_CUSTOM_EXTI_IRQn, 2, 0); | |
1315 HAL_NVIC_EnableIRQ(BUTTON_CUSTOM_EXTI_IRQn); | |
1316 #endif | |
1317 } | |
1318 | |
1319 | |
1320 /** | |
1321 * @brief System Clock Configuration | |
1322 * The system Clock is configured as follow : | |
1323 * System Clock source = PLL (HSE) | |
1324 * SYSCLK(Hz) = 180000000 | |
1325 * HCLK(Hz) = 180000000 | |
1326 * AHB Prescaler = 1 | |
1327 * APB1 Prescaler = 4 | |
1328 * APB2 Prescaler = 2 | |
1329 * HSE Frequency(Hz) = 8000000 | |
1330 * PLL_M = 8 | |
1331 * PLL_N = 360 | |
1332 * PLL_P = 2 | |
1333 * PLL_Q = 7 | |
1334 * VDD(V) = 3.3 | |
1335 * Main regulator output voltage = Scale1 mode | |
1336 * Flash Latency(WS) = 5 | |
1337 * The LTDC Clock is configured as follow : | |
1338 * PLLSAIN = 192 | |
1339 * PLLSAIR = 4 | |
1340 * PLLSAIDivR = 8 | |
1341 * @param None | |
1342 * @retval None | |
1343 */ | |
1344 static void SystemClock_Config(void) | |
1345 { | |
1346 | |
1347 /* Enable Power Control clock */ | |
1348 __PWR_CLK_ENABLE(); | |
1349 | |
1350 /* The voltage scaling allows optimizing the power consumption when the device is | |
1351 clocked below the maximum system frequency, to update the voltage scaling value | |
1352 regarding system frequency refer to product datasheet. */ | |
1353 __HAL_PWR_VOLTAGESCALING_CONFIG( PWR_REGULATOR_VOLTAGE_SCALE1 ); | |
1354 | |
1355 /*##-1- System Clock Configuration #########################################*/ | |
1356 /* Enable HighSpeed Oscillator and activate PLL with HSE/HSI as source */ | |
1357 RCC_OscInitTypeDef RCC_OscInitStruct = { 0 }; | |
1358 #ifdef DISC1_BOARD | |
1359 // Use High Speed Internal (HSI) oscillator, running at 16MHz. | |
1360 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI; | |
1361 RCC_OscInitStruct.HSIState = RCC_HSI_ON; | |
1362 RCC_OscInitStruct.HSICalibrationValue = 0x10; | |
1363 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI; | |
1364 RCC_OscInitStruct.PLL.PLLM = 16; // HSI/16 is 1Mhz. | |
1365 #else | |
1366 // Use High Speed External oscillator, running at 8MHz | |
1367 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE; | |
1368 RCC_OscInitStruct.HSEState = RCC_HSE_ON; | |
1369 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE; | |
1370 RCC_OscInitStruct.PLL.PLLM = 8; // HSE/8 is 1Mhz. | |
1371 #endif | |
1372 // System clock = PLL (1MHz) * N/p = 180 MHz. | |
1373 RCC_OscInitStruct.PLL.PLLN = 360; | |
1374 RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2; | |
1375 RCC_OscInitStruct.PLL.PLLQ = 7; | |
1376 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON; | |
1377 HAL_RCC_OscConfig( &RCC_OscInitStruct ); | |
1378 | |
1379 // HAL_PWREx_ActivateOverDrive(); | |
1380 HAL_PWREx_DeactivateOverDrive(); | |
1381 | |
1382 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2 clocks dividers */ | |
1383 RCC_ClkInitTypeDef RCC_ClkInitStruct = { 0 }; | |
1384 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK | |
1385 | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2; | |
1386 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK; | |
1387 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1; | |
1388 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV4; | |
1389 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV2; | |
1390 HAL_RCC_ClockConfig( &RCC_ClkInitStruct, FLASH_LATENCY_8 ); //FLASH_LATENCY_5); | |
1391 | |
1392 /*##-2- LTDC Clock Configuration ###########################################*/ | |
1393 /* LCD clock configuration */ | |
1394 /* PLLSAI_VCO Input = HSE_VALUE/PLL_M = 1 Mhz */ | |
1395 /* PLLSAI_VCO Output = PLLSAI_VCO Input * PLLSAIN = 192 Mhz */ | |
1396 /* PLLLCDCLK = PLLSAI_VCO Output/PLLSAIR = 192/4 = 48 Mhz */ | |
1397 /* LTDC clock frequency = PLLLCDCLK / RCC_PLLSAIDIVR_8 = 48/8 = 6 Mhz */ | |
1398 | |
1399 /* neu: 8MHz/8*300/5/8 = 7,5 MHz = 19,5 Hz bei 800 x 480 */ | |
1400 RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0}; | |
1401 PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_LTDC; | |
1402 PeriphClkInitStruct.PLLSAI.PLLSAIN = 300; //192; | |
1403 PeriphClkInitStruct.PLLSAI.PLLSAIR = 5; //4; | |
1404 PeriphClkInitStruct.PLLSAIDivR = RCC_PLLSAIDIVR_8;//RCC_PLLSAIDIVR_4;// RCC_PLLSAIDIVR_2; // RCC_PLLSAIDIVR_8 | |
1405 HAL_RCCEx_PeriphCLKConfig( &PeriphClkInitStruct ); | |
1406 } | |
1407 | |
1408 | |
1409 /** | |
1410 * @brief This function is executed in case of error occurrence. | |
1411 * @param None | |
1412 * @retval None | |
1413 */ | |
1414 static void Error_Handler(void) | |
1415 { | |
1416 /* Turn LED3 on */ | |
1417 // BSP_LED_On(LED3); | |
1418 while(1) | |
1419 { | |
1420 } | |
1421 } | |
1422 | |
1423 /** | |
1424 * @brief Perform the SDRAM exernal memory inialization sequence | |
1425 * @param hsdram: SDRAM handle | |
1426 * @param Command: Pointer to SDRAM command structure | |
1427 * @retval None | |
1428 */ | |
1429 static void SDRAM_Initialization_Sequence(SDRAM_HandleTypeDef *hsdram, FMC_SDRAM_CommandTypeDef *Command) | |
1430 { | |
1431 __IO uint32_t tmpmrd =0; | |
1432 /* Step 3: Configure a clock configuration enable command */ | |
1433 Command->CommandMode = FMC_SDRAM_CMD_CLK_ENABLE; | |
1434 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1435 Command->AutoRefreshNumber = 1; | |
1436 Command->ModeRegisterDefinition = 0; | |
1437 | |
1438 /* Send the command */ | |
1439 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
1440 | |
1441 /* Step 4: Insert 100 ms delay */ | |
1442 HAL_Delay(100); | |
1443 | |
1444 /* Step 5: Configure a PALL (precharge all) command */ | |
1445 Command->CommandMode = FMC_SDRAM_CMD_PALL; | |
1446 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1447 Command->AutoRefreshNumber = 1; | |
1448 Command->ModeRegisterDefinition = 0; | |
1449 | |
1450 /* Send the command */ | |
1451 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
1452 | |
1453 /* Step 6 : Configure a Auto-Refresh command */ | |
1454 Command->CommandMode = FMC_SDRAM_CMD_AUTOREFRESH_MODE; | |
1455 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1456 Command->AutoRefreshNumber = 4; | |
1457 Command->ModeRegisterDefinition = 0; | |
1458 | |
1459 /* Send the command */ | |
1460 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
1461 | |
1462 /* Step 7: Program the external memory mode register */ | |
1463 tmpmrd = (uint32_t)SDRAM_MODEREG_BURST_LENGTH_2 | | |
1464 SDRAM_MODEREG_BURST_TYPE_SEQUENTIAL | | |
1465 SDRAM_MODEREG_CAS_LATENCY_3 | | |
1466 SDRAM_MODEREG_OPERATING_MODE_STANDARD | | |
1467 SDRAM_MODEREG_WRITEBURST_MODE_SINGLE; | |
1468 | |
1469 Command->CommandMode = FMC_SDRAM_CMD_LOAD_MODE; | |
1470 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1471 Command->AutoRefreshNumber = 1; | |
1472 Command->ModeRegisterDefinition = tmpmrd; | |
1473 | |
1474 /* Send the command */ | |
1475 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
1476 | |
1477 /* Step 8: Set the refresh rate counter */ | |
1478 /* (15.62 us x Freq) - 20 */ | |
1479 /* neu: (8 us x Freq) - 20 */ | |
1480 /* Set the device refresh counter */ | |
1481 HAL_SDRAM_ProgramRefreshRate(hsdram, REFRESH_COUNT); | |
1482 } | |
1483 | |
1484 | |
1485 /** | |
1486 ****************************************************************************** | |
1487 ****************************************************************************** | |
1488 ****************************************************************************** | |
1489 */ | |
1490 | |
1491 | |
1492 /** | |
1493 * @brief DMA2D configuration. | |
1494 * @note This function Configure tha DMA2D peripheral : | |
1495 * 1) Configure the transfer mode : memory to memory W/ pixel format conversion | |
1496 * 2) Configure the output color mode as ARGB4444 | |
1497 * 3) Configure the output memory address at SRAM memory | |
1498 * 4) Configure the data size : 320x120 (pixels) | |
1499 * 5) Configure the input color mode as ARGB8888 | |
1500 * 6) Configure the input memory address at FLASH memory | |
1501 * @retval | |
1502 * None | |
1503 */ | |
1504 | |
1505 static void SDRAM_Config(void) | |
1506 { | |
1507 /*##-1- Configure the SDRAM device #########################################*/ | |
1508 /* SDRAM device configuration */ | |
1509 hsdram.Instance = FMC_SDRAM_DEVICE; | |
1510 | |
1511 /* Timing configuration for 90 Mhz of SD clock frequency (180Mhz/2) */ | |
1512 /* TMRD: 2 Clock cycles */ | |
1513 SDRAM_Timing.LoadToActiveDelay = 2; | |
1514 /* TXSR: min=70ns (6x11.90ns) */ | |
1515 SDRAM_Timing.ExitSelfRefreshDelay = 7; | |
1516 /* TRAS: min=42ns (4x11.90ns) max=120k (ns) */ | |
1517 SDRAM_Timing.SelfRefreshTime = 4; | |
1518 /* TRC: min=63 (6x11.90ns) */ | |
1519 SDRAM_Timing.RowCycleDelay = 7; | |
1520 /* TWR: 2 Clock cycles */ | |
1521 SDRAM_Timing.WriteRecoveryTime = 2; | |
1522 /* TRP: 15ns => 2x11.90ns */ | |
1523 SDRAM_Timing.RPDelay = 2; | |
1524 /* TRCD: 15ns => 2x11.90ns */ | |
1525 SDRAM_Timing.RCDDelay = 2; | |
1526 | |
1527 hsdram.Init.SDBank = FMC_SDRAM_BANK2; | |
1528 hsdram.Init.ColumnBitsNumber = FMC_SDRAM_COLUMN_BITS_NUM_9; | |
1529 hsdram.Init.RowBitsNumber = FMC_SDRAM_ROW_BITS_NUM_13; | |
1530 hsdram.Init.MemoryDataWidth = SDRAM_MEMORY_WIDTH; | |
1531 hsdram.Init.InternalBankNumber = FMC_SDRAM_INTERN_BANKS_NUM_4; | |
1532 hsdram.Init.CASLatency = FMC_SDRAM_CAS_LATENCY_3; | |
1533 hsdram.Init.WriteProtection = FMC_SDRAM_WRITE_PROTECTION_DISABLE; | |
1534 hsdram.Init.SDClockPeriod = SDCLOCK_PERIOD; | |
1535 hsdram.Init.ReadBurst = FMC_SDRAM_RBURST_DISABLE; | |
1536 hsdram.Init.ReadPipeDelay = FMC_SDRAM_RPIPE_DELAY_1; | |
1537 | |
1538 /* Initialize the SDRAM controller */ | |
1539 if(HAL_SDRAM_Init(&hsdram, &SDRAM_Timing) != HAL_OK) | |
1540 { | |
1541 /* Initialization Error */ | |
1542 Error_Handler(); | |
1543 } | |
1544 | |
1545 /* Program the SDRAM external device */ | |
1546 SDRAM_Initialization_Sequence(&hsdram, &command); | |
1547 } | |
1548 | |
1549 | |
1550 #ifdef USE_FULL_ASSERT | |
1551 | |
1552 /** | |
1553 * @brief Reports the name of the source file and the source line number | |
1554 * where the assert_param error has occurred. | |
1555 * @param file: pointer to the source file name | |
1556 * @param line: assert_param error line source number | |
1557 * @retval None | |
1558 */ | |
1559 void assert_failed(uint8_t* file, uint32_t line) | |
1560 { | |
1561 /* User can add his own implementation to report the file name and line number, | |
1562 ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */ | |
1563 | |
1564 /* Infinite loop */ | |
1565 while (1) | |
1566 { | |
1567 } | |
1568 } | |
1569 #endif | |
1570 | |
1571 | |
1572 void deco_loop(void) | |
1573 { | |
1574 typedef enum | |
1575 { | |
1576 CALC_VPM, | |
1577 CALC_VPM_FUTURE, | |
1578 CALC_BUEHLMANN, | |
1579 CALC_BUEHLMANN_FUTURE, | |
1580 } CALC_WHAT; | |
1581 | |
1582 static int what = -1; | |
1583 int counter = 0; | |
1584 if((stateUsed->mode != MODE_DIVE) || (stateUsed->diveSettings.diveMode == DIVEMODE_Apnea) || (decoLock != DECO_CALC_ready )) | |
1585 return; | |
1586 | |
1587 decoLock = DECO_CALC_running; | |
1588 | |
1589 if(stateDeco.diveSettings.deco_type.ub.standard == GF_MODE) | |
1590 { | |
1591 // hw 151110 mh wants future TTS even in deco zone if((what == CALC_BUEHLMANN) && (stateDeco.lifeData.pressure_ambient_bar > stateDeco.diveSettings.internal__pressure_first_stop_ambient_bar_as_upper_limit_for_gf_low_otherwise_zero)) | |
1592 if(what == CALC_BUEHLMANN) | |
1593 { | |
1594 //Calc future | |
1595 what = CALC_BUEHLMANN_FUTURE; | |
1596 } | |
1597 else | |
1598 what = CALC_BUEHLMANN; | |
1599 | |
1600 } | |
1601 else | |
1602 { | |
1603 // hw 151110 mh wants future TTS even in deco zone if((what == CALC_VPM) && (!stateDeco.vpm.deco_zone_reached)) | |
1604 if(what == CALC_VPM) | |
1605 { | |
1606 //Calc future | |
1607 what = CALC_VPM_FUTURE; | |
1608 } | |
1609 else | |
1610 what = CALC_VPM; | |
1611 } | |
1612 | |
1613 //In one of ten calc the other option | |
1614 if(counter == 10) | |
1615 { | |
1616 if(what == CALC_VPM) | |
1617 what = CALC_BUEHLMANN; | |
1618 if(what == CALC_BUEHLMANN) | |
1619 what = CALC_VPM; | |
1620 counter = 0; | |
1621 } | |
1622 | |
1623 decom_CreateGasChangeList(&stateDeco.diveSettings, &stateDeco.lifeData); | |
1624 | |
1625 switch(what) | |
1626 { | |
1627 case CALC_VPM: | |
1628 vpm_calc(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.vpm,&stateDeco.decolistVPM, DECOSTOPS); | |
1629 decoLock = DECO_CALC_FINSHED_vpm; | |
1630 return; | |
1631 case CALC_VPM_FUTURE: | |
1632 decom_tissues_exposure(stateDeco.diveSettings.future_TTS_minutes * 60,&stateDeco.lifeData); | |
1633 vpm_calc(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.vpm,&stateDeco.decolistFutureVPM, FUTURESTOPS); | |
1634 decoLock = DECO_CALC_FINSHED_Futurevpm; | |
1635 return; | |
1636 case CALC_BUEHLMANN: | |
1637 buehlmann_calc_deco(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1638 buehlmann_ceiling_calculator(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1639 buehlmann_relative_gradient_calculator(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1640 decoLock = DECO_CALC_FINSHED_Buehlmann; | |
1641 return; | |
1642 case CALC_BUEHLMANN_FUTURE: | |
1643 decom_tissues_exposure(stateDeco.diveSettings.future_TTS_minutes * 60,&stateDeco.lifeData); | |
1644 buehlmann_calc_deco(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistFutureBuehlmann); | |
1645 //buehlmann_ceiling_calculator(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1646 decoLock = DECO_CALC_FINSHED_FutureBuehlmann; | |
1647 return; | |
1648 } | |
1649 counter++; | |
1650 } | |
1651 | |
1652 void resetToFirmwareUpdate(void) | |
1653 { | |
1654 __HAL_RCC_CLEAR_RESET_FLAGS(); | |
1655 HAL_NVIC_SystemReset(); | |
1656 } | |
1657 | |
1658 // debugging by https://blog.feabhas.com/2013/02/developing-a-generic-hard-fault-handler-for-arm-cortex-m3cortex-m4/ | |
1659 | |
1660 /* | |
1661 void printErrorMsg(const char * errMsg) | |
1662 { | |
1663 | |
1664 // printf(errMsg); | |
1665 // return; | |
1666 | |
1667 while(*errMsg != 0){ | |
1668 ITM_SendChar(*errMsg); | |
1669 ++errMsg; | |
1670 } | |
1671 } | |
1672 | |
1673 enum { r0, r1, r2, r3, r12, lr, pc, psr}; | |
1674 | |
1675 void stackDump(uint32_t stack[]) | |
1676 { | |
1677 static char msg[80]; | |
1678 sprintf(msg, "r0 = 0x%08x\n", stack[r0]); printErrorMsg(msg); | |
1679 sprintf(msg, "r1 = 0x%08x\n", stack[r1]); printErrorMsg(msg); | |
1680 sprintf(msg, "r2 = 0x%08x\n", stack[r2]); printErrorMsg(msg); | |
1681 sprintf(msg, "r3 = 0x%08x\n", stack[r3]); printErrorMsg(msg); | |
1682 sprintf(msg, "r12 = 0x%08x\n", stack[r12]); printErrorMsg(msg); | |
1683 sprintf(msg, "lr = 0x%08x\n", stack[lr]); printErrorMsg(msg); | |
1684 sprintf(msg, "pc = 0x%08x\n", stack[pc]); printErrorMsg(msg); | |
1685 sprintf(msg, "psr = 0x%08x\n", stack[psr]); printErrorMsg(msg); | |
1686 } | |
1687 | |
1688 void printUsageErrorMsg(uint32_t CFSRValue) | |
1689 { | |
1690 printErrorMsg("Usage fault: "); | |
1691 CFSRValue >>= 16; // right shift to lsb | |
1692 if((CFSRValue & (1 << 9)) != 0) { | |
1693 printErrorMsg("Divide by zero\n"); | |
1694 } | |
1695 } | |
1696 | |
1697 void Hard_Fault_Handler()//uint32_t stack[]) | |
1698 { | |
1699 static char msg[80]; | |
1700 printErrorMsg("In Hard Fault Handler\n"); | |
1701 sprintf(msg, "SCB->HFSR = 0x%08x\n", SCB->HFSR); | |
1702 printErrorMsg(msg); | |
1703 if ((SCB->HFSR & (1 << 30)) != 0) { | |
1704 printErrorMsg("Forced Hard Fault\n"); | |
1705 sprintf(msg, "SCB->CFSR = 0x%08x\n", SCB->CFSR ); | |
1706 printErrorMsg(msg); | |
1707 if((SCB->CFSR & 0xFFFF0000) != 0) { | |
1708 printUsageErrorMsg(SCB->CFSR); | |
1709 } | |
1710 } | |
1711 __ASM volatile("BKPT #01"); | |
1712 while(1); | |
1713 } | |
1714 | |
1715 int my_store_of_MSP; | |
1716 | |
1717 void HardFault_Handler(void) | |
1718 { | |
1719 __asm ("MRS my_store_of_MSP, MSP"); | |
1720 Hard_Fault_Handler(); | |
1721 } | |
1722 */ | |
1723 | |
1724 /* | |
1725 __asm void HardFault_Handler(void) | |
1726 { | |
1727 TST lr, #4 // Test for MSP or PSP | |
1728 ITE EQ | |
1729 MRSEQ r0, MSP | |
1730 MRSNE r0, PSP | |
1731 B __cpp(Hard_Fault_Handler) | |
1732 } | |
1733 */ | |
1734 /* | |
1735 HardFault_Handler\ | |
1736 PROC | |
1737 EXPORT HardFault_Handler | |
1738 B . | |
1739 ENDP | |
1740 */ | |
1741 | |
1742 /* | |
1743 __asm int f(int i) | |
1744 { | |
1745 ADD i, i, #1 // error | |
1746 } | |
1747 | |
1748 EXPORT HardFault_Handler | |
1749 HardFault_Handler FUNCTION | |
1750 MRS r0, MSP | |
1751 B __cpp(Hard_Fault_Handler) | |
1752 ENDFUNC | |
1753 */ |