Mercurial > public > ostc4
annotate Discovery/Src/base.c @ 116:b848056057ce FlipDisplay
Added small helper for runtime evaluation
Moved initialisation of settings before GFX init to have parameters available during init phase
author | Ideenmodellierer |
---|---|
date | Sun, 06 Jan 2019 22:27:46 +0100 |
parents | 3834b6272ee5 |
children | 135eae957389 |
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 */ | |
116 | 328 /* #define DEBUG_RUNTIME TRUE */ |
329 #ifdef DEBUG_RUNTIME | |
330 #define MEASURECNT 60 /* number of measuremets to be stored */ | |
331 static uint32_t loopcnt[MEASURECNT]; | |
332 #endif | |
38 | 333 // =============================================================================== |
334 // main | |
335 /// @brief This function makes initializations and has the nonIRQ endless loop | |
336 /// for bluetooth and deco calculations | |
337 /// | |
338 // =============================================================================== | |
339 int main(void) | |
340 { | |
341 uint32_t pLayerInvisible; | |
342 uint16_t totalDiveCounterFound; | |
116 | 343 #ifdef DEBUG_RUNTIME |
344 RTC_TimeTypeDef Stime; | |
345 uint8_t measurementindex = 0; | |
346 uint8_t lastsecond = 0xFF; | |
347 #endif | |
348 | |
38 | 349 |
350 set_globalState( StBoot0 ); | |
351 | |
352 HAL_Init(); | |
353 HAL_NVIC_SetPriorityGrouping( NVIC_PRIORITYGROUP_2 ); | |
354 | |
355 SystemClock_Config(); | |
356 | |
357 MX_GPIO_Init(); | |
358 // MX_SmallCPU_NO_Reset_Helper(); //161116 hw | |
359 MX_SPI_Init(); | |
360 MX_UART_Init(); | |
361 SDRAM_Config(); | |
362 HAL_Delay( 100 ); | |
116 | 363 |
364 stateRealGetPointerWrite()->lastKnownBatteryPercentage = 0; // damit das nicht in settings kopiert wird. | |
365 set_settings_to_Standard(); | |
366 mod_settings_for_first_start_with_empty_ext_flash(); | |
367 ext_flash_read_settings(); | |
368 if( newFirmwareVersionCheckViaSettings() ) // test for old firmware version in loaded settings | |
369 { | |
370 wasFirmwareUpdateCheckBattery = 1; | |
371 set_settings_button_to_standard_with_individual_buttonBalance(); // will adapt individual values | |
372 } | |
373 //settingsGetPointer()->bluetoothActive = 0; /* MX_Bluetooth_PowerOff(); unnecessary as part of MX_GPIO_Init() */ | |
374 //settingsGetPointer()->compassBearing = 0; | |
375 set_new_settings_missing_in_ext_flash(); // inlcudes update of firmware version 161121 | |
376 | |
38 | 377 GFX_init( &pLayerInvisible ); |
378 | |
379 TIM_init(); | |
380 TIM_BACKLIGHT_init(); | |
381 | |
382 /* | |
383 GFX_helper_font_memory_list(&FontT24); | |
384 GFX_helper_font_memory_list(&FontT42); | |
385 GFX_helper_font_memory_list(&FontT48); | |
386 GFX_helper_font_memory_list(&FontT54); | |
387 GFX_helper_font_memory_list(&FontT84); | |
388 GFX_helper_font_memory_list(&FontT105); | |
389 GFX_helper_font_memory_list(&FontT144); | |
390 */ | |
391 | |
116 | 392 |
38 | 393 |
394 // new 170508: bluetooth on at start | |
395 settingsGetPointer()->bluetoothActive = 1; | |
396 MX_Bluetooth_PowerOn(); | |
397 | |
398 // Haase Geburtstag: | |
399 // settingsGetPointer()->serialHigh = (3012 / 256); | |
400 // settingsGetPointer()->serialLow = (3012 & 0xFF); | |
401 | |
402 // settingsGetPointer()->showDebugInfo = 1; | |
403 | |
404 /* | |
405 if(settingsGetPointer()->scooterControl) | |
406 { | |
407 settingsGetPointer()->bluetoothActive = 1; | |
408 MX_Bluetooth_PowerOn(); | |
409 if(settingsGetPointer()->scooterDeviceAddress[0] != 0) | |
410 bC_setConnectRequest(); | |
411 } | |
412 */ | |
413 /* | |
414 if( (hardwareDataGetPointer()->primarySerial == 20+18) | |
415 || (hardwareDataGetPointer()->primarySerial == 20+25) | |
416 || (hardwareDataGetPointer()->primarySerial == 20+27)) | |
417 { | |
418 MX_Bluetooth_PowerOn(); | |
419 tComm_Set_Bluetooth_Name(1); | |
420 } | |
421 */ | |
422 errorsInSettings = check_and_correct_settings(); | |
423 createDiveSettings(); | |
424 | |
425 #ifdef QUICK_SLEEP | |
426 settingsGetPointer()->timeoutSurfacemode = 20; | |
427 #else | |
428 settingsGetPointer()->timeoutSurfacemode = 120; | |
429 #endif | |
430 | |
431 #ifdef DEMOMODE | |
432 demoConfigureSettings(); | |
433 TIM_DEMO_init(); | |
434 #endif | |
435 | |
436 // ----------------------------- | |
437 | |
438 display_power_on__1_of_2__pre_RGB(); | |
439 GFX_LTDC_Init(); | |
440 GFX_LTDC_LayerDefaultInit( TOP_LAYER, pLayerInvisible ); | |
441 GFX_LTDC_LayerDefaultInit( BACKGRD_LAYER, pLayerInvisible ); | |
442 GFX_SetFramesTopBottom( pLayerInvisible, pLayerInvisible, 480 ); | |
443 HAL_Delay( 20 ); | |
444 display_power_on__2_of_2__post_RGB(); | |
445 GFX_use_colorscheme( settingsGetPointer()->tX_colorscheme ); | |
446 | |
447 // ----------------------------- | |
448 tHome_init(); | |
449 tI_init(); | |
450 tM_init(); | |
451 tMenuEdit_init(); | |
452 tInfoLog_init(); | |
453 tComm_init(); | |
454 DataEX_init(); | |
455 setButtonResponsiveness( settingsGetPointer()->ButtonResponsiveness ); | |
456 set_globalState_tHome(); | |
457 | |
458 GFX_start_VSYNC_IRQ(); | |
459 tCCR_init(); | |
460 | |
461 GFX_logoAutoOff(); | |
462 EXTILine_Buttons_Config(); | |
463 | |
464 ext_flash_repair_dive_log(); | |
465 //ext_flash_repair_SPECIAL_dive_numbers_starting_count_with(1); | |
466 | |
467 totalDiveCounterFound = logbook_lastDive_diveNumber(); | |
468 if( settingsGetPointer()->totalDiveCounter < totalDiveCounterFound ) | |
469 settingsGetPointer()->totalDiveCounter = totalDiveCounterFound; | |
470 | |
471 if( settingsGetPointer()->debugModeOnStart ) | |
472 { | |
473 settingsGetPointer()->debugModeOnStart = 0; | |
474 ext_flash_write_settings(); | |
475 setDebugMode(); | |
476 openInfo( StIDEBUG ); | |
477 } | |
478 | |
479 /* @brief main LOOP | |
480 * | |
481 * this is executed while no IRQ interrupts it | |
482 * - deco calculation | |
483 * - bluetooth | |
484 * and resetToFirmwareUpdate() | |
485 * because tComm_control() does not exit before disconnection | |
486 */ | |
487 while( 1 ) | |
488 { | |
489 if( bootToBootloader ) | |
490 resetToFirmwareUpdate(); | |
491 | |
492 // this will allways reset after RTE reset -> no good! | |
493 // if(DataEX_was_power_on()) // new to allow for update after RTE update | |
494 // resetToFirmwareUpdate(); | |
495 | |
496 tCCR_control(); | |
497 if( tComm_control() )// will stop while loop if tComm Mode started until exit from UART | |
498 { | |
499 createDiveSettings(); | |
500 updateMenu(); | |
501 ext_flash_write_settings(); | |
502 } | |
503 deco_loop(); | |
504 /* | |
505 bonexControl(); | |
506 if(bC_getStatus() == BC_DISCONNECTED) | |
507 { | |
508 if(tComm_control()) // will stop while loop if tComm Mode started until exit from UART | |
509 { | |
510 createDiveSettings(); | |
511 updateMenu(); | |
512 ext_flash_write_settings(); | |
513 } | |
514 } | |
515 */ | |
116 | 516 |
517 #ifdef DEBUG_RUNTIME | |
518 translateTime(stateUsed->lifeData.timeBinaryFormat, &Stime); | |
519 if(lastsecond == 0xFF) | |
520 { | |
521 measurementindex = 0; | |
522 loopcnt[measurementindex] = 0; | |
523 lastsecond = Stime.Seconds; | |
524 } | |
525 loopcnt[measurementindex]++; | |
526 | |
527 if(lastsecond != Stime.Seconds) | |
528 { | |
529 measurementindex++; | |
530 if (measurementindex == MEASURECNT) measurementindex = 0; | |
531 loopcnt[measurementindex] = 0; | |
532 lastsecond = Stime.Seconds; | |
533 if(measurementindex +1 < MEASURECNT) loopcnt[measurementindex +1] = 0xffff; /* helps to identify the latest value */ | |
534 } | |
535 #endif | |
536 | |
38 | 537 } |
538 } | |
539 | |
540 // =============================================================================== | |
541 // timer IRQ | |
542 /// @brief this is called periodically | |
543 /// | |
544 /// - refresh screen (the actual change is done in the VSYNC IRQ) | |
545 /// - start data transfer with RTE / small CPU (DateEX....) | |
546 /// - update logbook | |
547 /// - timeouts | |
548 /// .... | |
549 /// | |
550 /// all this in three steps / switch() routines in a given order | |
551 /// as the previous switch() might influence the next functions | |
552 /// to be called | |
553 /// | |
554 // =============================================================================== | |
555 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) | |
556 { | |
557 #ifdef DEMOMODE | |
558 if(htim->Instance==TIM7) | |
559 { | |
560 HAL_GPIO_EXTI_Callback(demoGetCommand()); | |
561 return; | |
562 } | |
563 #endif | |
564 static uint8_t last_base; | |
565 | |
566 SStateList status; | |
567 uint32_t timeout_in_seconds; | |
568 uint32_t timeout_limit_Surface_in_seconds; | |
569 | |
570 _Bool InDiveMode = 0; | |
571 _Bool modeChange = 0; // to exit from menu and logbook | |
572 | |
573 if(stateUsed->mode == MODE_DIVE) | |
574 InDiveMode = 1; | |
575 else | |
576 InDiveMode = 0; | |
577 | |
578 if(returnFromCommCleanUpRequest) | |
579 { | |
580 tComm_exit(); | |
581 returnFromCommCleanUpRequest = 0; | |
582 } | |
583 | |
584 get_globalStateList(&status); | |
585 | |
586 switch(status.base) | |
587 { | |
588 case BaseHome: | |
589 case BaseMenu: | |
590 case BaseInfo: | |
591 updateSetpointStateUsed(); | |
592 DateEx_copy_to_dataOut(); | |
593 DataEX_call(); | |
594 DataEX_copy_to_LifeData(&modeChange); | |
595 //foto session :-) stateRealGetPointerWrite()->lifeData.battery_charge = 99; | |
596 //foto session :-) stateSimGetPointerWrite()->lifeData.battery_charge = 99; | |
597 DataEX_copy_to_deco(); | |
598 if(stateUsed == stateSimGetPointer()) | |
599 simulation_UpdateLifeData(1); | |
600 check_warning(); | |
601 if(stateUsed == stateRealGetPointer()) | |
602 logbook_InitAndWrite(); | |
603 updateMiniLiveLogbook(1); | |
604 timer_UpdateSecond(1); | |
605 base_tempLightLevel = TIM_BACKLIGHT_adjust(); | |
606 tCCR_tick(); | |
607 tHome_tick(); | |
608 if(status.base == BaseHome) | |
609 tMenuEdit_writeSettingsToFlash(); // takes 900 ms!! | |
610 break; | |
611 case BaseStop: | |
612 DateEx_copy_to_dataOut(); | |
613 DataEX_call(); | |
614 DataEX_control_connection_while_asking_for_sleep(); | |
615 break; | |
616 default: | |
617 case BaseComm: | |
618 if(get_globalState() == StUART_RTECONNECT) | |
619 { | |
620 DateEx_copy_to_dataOut(); | |
621 DataEX_call(); | |
622 DataEX_copy_to_LifeData(0); | |
623 } | |
624 break; | |
625 } | |
626 | |
627 /* timeout control */ | |
628 if(modeChange) ///< from RTE, set in data_exchange_main.c | |
629 time_without_button_pressed_deciseconds = (settingsGetPointer()->timeoutSurfacemode / 4) * 3; | |
630 if(status.base != last_base) | |
631 time_without_button_pressed_deciseconds = 0; | |
632 last_base = status.base; | |
633 timeout_in_seconds = time_without_button_pressed_deciseconds / 10; | |
634 time_without_button_pressed_deciseconds += 1; | |
635 if(modeChange || (timeout_in_seconds != time_without_button_pressed_deciseconds / 10)) | |
636 { | |
637 #ifdef NO_TIMEOUT | |
638 timeout_in_seconds = 0; | |
639 #else | |
640 timeout_in_seconds += 1; | |
641 #endif | |
642 | |
643 if(InDiveMode) | |
644 { | |
645 switch(status.base) | |
646 { | |
647 case BaseHome: | |
648 if((status.line != 0) && (timeout_in_seconds >= settingsGetPointer()->timeoutEnterButtonSelectDive)) | |
649 { | |
650 set_globalState(StD); | |
651 timeout_in_seconds = 0; | |
652 } | |
653 break; | |
104 | 654 |
38 | 655 case BaseMenu: |
656 if((status.line == 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuDive) || modeChange)) | |
657 { | |
658 exitMenu(); | |
659 timeout_in_seconds = 0; | |
660 } | |
661 if((status.line != 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuEdit) || modeChange)) | |
662 { | |
663 exitMenuEdit_to_Home(); | |
664 timeout_in_seconds = 0; | |
665 } | |
666 break; | |
667 /* why was this here? 160317 hw | |
668 case BaseInfo: | |
669 if(status.page == InfoPageLogList) | |
670 { | |
671 exitLog(); | |
672 } | |
673 else | |
674 if(status.page == InfoPageLogShow) | |
675 { | |
676 show_logbook_exit(); | |
677 exitLog(); | |
678 } | |
679 else | |
680 if(status.page != InfoPageCompass) | |
681 { | |
682 exitInfo(); | |
683 } | |
684 timeout_in_seconds = 0; | |
685 break; | |
686 */ | |
687 default: | |
688 break; | |
689 } | |
690 } | |
691 else /* surface mode */ | |
692 { | |
693 switch(status.base) | |
694 { | |
695 case BaseHome: | |
696 // added hw 161027 | |
697 if(!(stateRealGetPointer()->warnings.lowBattery) && (stateRealGetPointer()->lifeData.battery_charge > 9)) | |
698 { | |
699 stateRealGetPointerWrite()->lastKnownBatteryPercentage = stateRealGetPointer()->lifeData.battery_charge; | |
700 } | |
701 else if((wasFirmwareUpdateCheckBattery) && (timeout_in_seconds > 3)) | |
702 { | |
703 wasFirmwareUpdateCheckBattery = 0; | |
704 setButtonResponsiveness(settingsGetPointer()->ButtonResponsiveness); // added 170306 | |
705 if( (settingsGetPointer()->lastKnownBatteryPercentage > 0) | |
706 && (settingsGetPointer()->lastKnownBatteryPercentage <= 100) | |
707 && (stateRealGetPointer()->warnings.lowBattery)) | |
708 { | |
709 setBatteryPercentage(settingsGetPointer()->lastKnownBatteryPercentage); | |
710 } | |
711 } | |
712 // stuff before and new @161121 CCR-sensor limit 10 minutes | |
713 if((settingsGetPointer()->dive_mode == DIVEMODE_CCR) && (settingsGetPointer()->CCR_Mode == CCRMODE_Sensors)) | |
714 { | |
715 timeout_limit_Surface_in_seconds = settingsGetPointer()->timeoutSurfacemodeWithSensors; | |
716 } | |
717 else | |
718 { | |
719 timeout_limit_Surface_in_seconds = settingsGetPointer()->timeoutSurfacemode; | |
720 } | |
721 if(timeout_in_seconds >= timeout_limit_Surface_in_seconds) | |
722 { | |
723 gotoSleep(); | |
724 } | |
725 break; | |
726 case BaseMenu: | |
727 if((status.line == 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuSurface) || modeChange)) | |
728 { | |
729 exitMenu(); | |
730 timeout_in_seconds = 0; | |
731 } | |
732 if((status.line != 0) && ((timeout_in_seconds >= settingsGetPointer()->timeoutMenuEdit) || modeChange)) | |
733 { | |
734 if((status.page != (uint8_t)((StMPLAN >> 24) & 0x0F)) || (timeout_in_seconds >= 10*(settingsGetPointer()->timeoutMenuEdit))) | |
735 { | |
736 exitMenuEdit_to_Home(); | |
737 timeout_in_seconds = 0; | |
738 } | |
739 } | |
740 break; | |
741 | |
742 case BaseInfo: | |
743 if((timeout_in_seconds >= settingsGetPointer()->timeoutInfo) || modeChange) | |
744 { | |
745 if(status.page == InfoPageLogList) | |
746 { | |
747 exitLog(); | |
748 timeout_in_seconds = 0; | |
749 } | |
750 else | |
751 if(status.page == InfoPageLogShow) | |
752 { | |
753 show_logbook_exit(); | |
754 exitLog(); | |
755 timeout_in_seconds = 0; | |
756 } | |
757 else | |
758 if(status.page != InfoPageCompass) | |
759 { | |
760 exitInfo(); | |
761 timeout_in_seconds = 0; | |
762 } | |
763 } | |
764 break; | |
765 default: | |
766 break; | |
767 } | |
768 } | |
769 } | |
770 | |
771 get_globalStateList(&status); | |
772 | |
773 switch(status.base) | |
774 { | |
775 case BaseHome: | |
776 tHome_refresh(); | |
777 tM_check_content(); | |
778 break; | |
779 case BaseMenu: | |
780 tM_refresh_live_content(); | |
781 tMenuEdit_refresh_live_content(); | |
782 break; | |
783 case BaseInfo: | |
784 tInfo_refresh(); ///< only compass at the moment 23.Feb.2015 hw | |
785 break; | |
786 case BaseComm: | |
787 tComm_refresh(); | |
788 break; | |
789 default: | |
790 if(get_globalState() == StStop) | |
791 tHome_sleepmode_fun(); | |
792 break; | |
793 } | |
794 } | |
795 | |
796 | |
797 /* button and VSYNC IRQ | |
798 * | |
799 * VSYNC will switch foreground and background picture | |
800 * if demanded. see GFX_change_LTDC() | |
801 * | |
802 */ | |
803 // =============================================================================== | |
804 // HAL_GPIO_EXTI_Callback | |
805 /// @brief button and VSYNC IRQ | |
806 /// | |
807 /// VSYNC will switch foreground and background picture if demanded - | |
808 /// see GFX_change_LTDC() | |
809 /// | |
810 // =============================================================================== | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
811 void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
812 if (!GPIO_Pin) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
813 return; |
38 | 814 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
815 uint8_t action = 0; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
816 SStateList status; |
38 | 817 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
818 if (GPIO_Pin == VSYNC_IRQ_PIN) // rechts, unten |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
819 { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
820 GFX_change_LTDC(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
821 housekeepingFrame(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
822 /* |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
823 #ifdef DEMOMODE |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
824 static uint8_t countCall = 0; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
825 if(countCall++ < 10) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
826 return; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
827 countCall = 0; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
828 uint8_t buttonAction = demoGetCommand(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
829 if(buttonAction) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
830 GPIO_Pin = buttonAction; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
831 else |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
832 #endif |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
833 */ |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
834 return; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
835 } |
115 | 836 |
108 | 837 SSettings* pSettings; |
838 pSettings = settingsGetPointer(); | |
115 | 839 if (GPIO_Pin == VSYNC_IRQ_PIN) // rechts, unten |
840 { | |
841 GFX_change_LTDC(); | |
842 housekeepingFrame(); | |
843 /* | |
844 #ifdef DEMOMODE | |
845 static uint8_t countCall = 0; | |
846 if(countCall++ < 10) | |
847 return; | |
848 countCall = 0; | |
849 uint8_t buttonAction = demoGetCommand(); | |
850 if(buttonAction) | |
851 GPIO_Pin = buttonAction; | |
852 else | |
853 #endif | |
854 */ | |
855 return; | |
856 } | |
38 | 857 |
858 #ifdef DEMOMODE | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
859 uint8_t demoMachineCall = 0; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
860 if(GPIO_Pin & 0x80) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
861 { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
862 demoMachineCall = 1; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
863 GPIO_Pin &= 0x7F; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
864 } |
38 | 865 #endif |
866 | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
867 time_without_button_pressed_deciseconds = 0; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
868 |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
869 if (GFX_logoStatus() != 0) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
870 return; |
38 | 871 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
872 if (GPIO_Pin == BUTTON_BACK_PIN) { // links |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
873 HAL_Delay(BUTTON_DEBOUNCE_DELAY); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
874 if (HAL_GPIO_ReadPin(BUTTON_BACK_GPIO_PORT, BUTTON_BACK_PIN) == 1) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
875 action = ACTION_BUTTON_BACK; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
876 } |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
877 } |
38 | 878 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
879 else if (GPIO_Pin == BUTTON_ENTER_PIN) { // mitte |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
880 HAL_Delay(BUTTON_DEBOUNCE_DELAY); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
881 if (HAL_GPIO_ReadPin(BUTTON_ENTER_GPIO_PORT, BUTTON_ENTER_PIN) == 1) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
882 action = ACTION_BUTTON_ENTER; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
883 } |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
884 } |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
885 |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
886 else if (GPIO_Pin == BUTTON_NEXT_PIN) { // rechts |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
887 HAL_Delay(BUTTON_DEBOUNCE_DELAY); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
888 if (HAL_GPIO_ReadPin(BUTTON_NEXT_GPIO_PORT, BUTTON_NEXT_PIN) == 1) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
889 action = ACTION_BUTTON_NEXT; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
890 } |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
891 } |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
892 |
38 | 893 if(GPIO_Pin == BUTTON_BACK_PIN) // links |
108 | 894 { |
895 if(!pSettings->FlipDisplay) | |
896 { | |
897 action = ACTION_BUTTON_BACK; | |
898 } | |
899 else | |
900 { | |
901 action = ACTION_BUTTON_NEXT; | |
902 } | |
903 } | |
38 | 904 else |
108 | 905 { |
906 if(GPIO_Pin == BUTTON_ENTER_PIN) // mitte | |
907 action = ACTION_BUTTON_ENTER; | |
908 else | |
909 { | |
910 if(GPIO_Pin == BUTTON_NEXT_PIN) // rechts | |
911 { | |
912 if(!pSettings->FlipDisplay) action = ACTION_BUTTON_NEXT; | |
913 else action = ACTION_BUTTON_BACK; | |
914 } | |
915 } | |
916 } | |
917 #ifdef BUTTON_CUSTOM_PIN | |
918 else | |
919 if(GPIO_Pin == BUTTON_CUSTOM_PIN) // extra | |
920 action = ACTION_BUTTON_CUSTOM; | |
921 #endif | |
38 | 922 |
923 #ifdef DEMOMODE // user pressed button ? | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
924 if((!demoMachineCall) && demoModeActive()) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
925 { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
926 demoSendCommand(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
927 return; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
928 } |
38 | 929 #endif |
930 | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
931 get_globalStateList(&status); |
38 | 932 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
933 if (action == ACTION_BUTTON_CUSTOM) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
934 GFX_screenshot(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
935 } |
38 | 936 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
937 switch (status.base) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
938 case BaseStop: |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
939 if (action == ACTION_BUTTON_BACK) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
940 resetToFirmwareUpdate(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
941 break; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
942 case BaseComm: |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
943 if (action == ACTION_BUTTON_BACK) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
944 settingsGetPointer()->bluetoothActive = 0; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
945 MX_Bluetooth_PowerOff(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
946 tComm_exit(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
947 } |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
948 break; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
949 case BaseHome: |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
950 if (action == ACTION_BUTTON_NEXT) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
951 if (status.page == PageSurface) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
952 openMenu(1); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
953 else |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
954 tHomeDiveMenuControl(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
955 } else if (action == ACTION_BUTTON_BACK) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
956 if (get_globalState() == StS) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
957 openInfo(StILOGLIST); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
958 else if ((status.page == PageDive) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
959 && (settingsGetPointer()->design < 7)) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
960 settingsGetPointer()->design = 7; // auto switch to 9 if necessary |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
961 } else if ((status.page == PageDive) && (status.line != 0)) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
962 if (settingsGetPointer()->extraDisplay == EXTRADISPLAY_BIGFONT) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
963 settingsGetPointer()->design = 3; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
964 else if (settingsGetPointer()->extraDisplay |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
965 == EXTRADISPLAY_DECOGAME) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
966 settingsGetPointer()->design = 4; |
38 | 967 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
968 set_globalState(StD); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
969 } else |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
970 tHome_change_field_button_pressed(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
971 } else if (action == ACTION_BUTTON_ENTER) { |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
972 if ((status.page == PageDive) && (status.line == 0)) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
973 tHome_change_customview_button_pressed(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
974 else if (status.page == PageSurface) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
975 tHome_change_customview_button_pressed(); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
976 else |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
977 tHomeDiveMenuControl(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
978 } |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
979 break; |
38 | 980 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
981 case BaseMenu: |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
982 if (status.line == 0) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
983 sendActionToMenu(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
984 else |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
985 sendActionToMenuEdit(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
986 break; |
38 | 987 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
988 case BaseInfo: |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
989 if (status.page == InfoPageLogList) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
990 sendActionToInfoLogList(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
991 else if (status.page == InfoPageLogShow) |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
992 sendActionToInfoLogShow(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
993 else |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
994 sendActionToInfo(action); |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
995 break; |
38 | 996 |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
997 default: |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
998 break; |
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
999 } |
38 | 1000 } |
1001 | |
1002 | |
1003 void gotoSleep(void) | |
1004 { | |
1005 /* not at the moment of testing */ | |
1006 // ext_flash_erase_firmware_if_not_empty(); | |
1007 GFX_logoAutoOff(); | |
1008 set_globalState(StStop); | |
1009 } | |
1010 | |
1011 | |
1012 // ----------------------------- | |
1013 | |
1014 uint8_t get_globalMode(void) | |
1015 { | |
1016 return globalModeID; | |
1017 } | |
1018 | |
1019 | |
1020 void set_globalMode(uint8_t newMode) | |
1021 { | |
1022 if((newMode != DIVEMODE) && (newMode != SURFMODE)) | |
1023 return; | |
1024 | |
1025 globalModeID = newMode; | |
1026 } | |
1027 | |
1028 | |
1029 uint32_t get_globalState(void) | |
1030 { | |
1031 return globalStateID; | |
1032 } | |
1033 | |
1034 | |
1035 void get_globalStateList(SStateList *output) | |
1036 { | |
1037 output->base = (uint8_t)((globalStateID >> 28) & 0x0F); | |
1038 output->page = (uint8_t)((globalStateID >> 24) & 0x0F); | |
1039 output->line = (uint8_t)((globalStateID >> 16) & 0xFF); | |
1040 output->field = (uint8_t)((globalStateID >> 8) & 0xFF); | |
1041 output->mode = (uint8_t)((globalStateID ) & 0xFF); | |
1042 } | |
1043 | |
1044 | |
1045 void get_idSpecificStateList(uint32_t id, SStateList *output) | |
1046 { | |
1047 output->base = (uint8_t)((id >> 28) & 0x0F); | |
1048 output->page = (uint8_t)((id >> 24) & 0x0F); | |
1049 output->line = (uint8_t)((id >> 16) & 0xFF); | |
1050 output->field = (uint8_t)((id >> 8) & 0xFF); | |
1051 output->mode = (uint8_t)((id ) & 0xFF); | |
1052 } | |
1053 | |
1054 | |
1055 void set_globalState_Menu_Page(uint8_t page) | |
1056 { | |
1057 globalStateID = ((BaseMenu << 28) + (page << 24)); | |
1058 } | |
1059 | |
1060 void set_globalState_Log_Page(uint8_t pageIsLine) | |
1061 { | |
1062 globalStateID = StILOGLIST + (pageIsLine << 16); | |
1063 } | |
1064 | |
1065 | |
1066 void set_globalState_Menu_Line(uint8_t line) | |
1067 { | |
1068 globalStateID = ((globalStateID & MaskLineFieldDigit) + (line << 16)); | |
1069 } | |
1070 | |
1071 | |
1072 void set_globalState(uint32_t newID) | |
1073 { | |
1074 globalStateID = newID; | |
1075 } | |
1076 | |
1077 void set_returnFromComm(void) | |
1078 { | |
1079 returnFromCommCleanUpRequest = 1; | |
1080 } | |
1081 | |
1082 uint8_t font_update_required(void) | |
1083 { | |
1084 uint8_t *fontVersionHigh; | |
1085 uint8_t *fontVersionLow; | |
1086 | |
1087 fontVersionHigh = (uint8_t *)0x08132000; | |
1088 fontVersionLow = (uint8_t *)0x08132001; | |
1089 | |
1090 if(FONTminimum_required_high() < *fontVersionHigh) | |
1091 return 0; | |
1092 | |
1093 if((FONTminimum_required_high() == *fontVersionHigh) && (FONTminimum_required_low() <= *fontVersionLow)) | |
1094 return 0; | |
1095 | |
1096 return 1; | |
1097 } | |
1098 | |
1099 | |
1100 void delayMicros(uint32_t micros) | |
1101 { | |
1102 micros = micros * (168/4) - 10; | |
1103 while(micros--); | |
1104 } | |
1105 | |
1106 | |
1107 void get_RTC_DateTime(RTC_DateTypeDef * sdatestructureget, RTC_TimeTypeDef * stimestructureget) | |
1108 { | |
1109 /* Get the RTC current Time */ | |
1110 if(sdatestructureget) | |
1111 HAL_RTC_GetTime(&RtcHandle, stimestructureget, FORMAT_BIN); | |
1112 /* Get the RTC current Date */ | |
1113 if(stimestructureget) | |
1114 HAL_RTC_GetDate(&RtcHandle, sdatestructureget, FORMAT_BIN); | |
1115 } | |
1116 | |
1117 | |
1118 void set_RTC_DateTime(RTC_DateTypeDef * sdatestructure, RTC_TimeTypeDef * stimestructure) | |
1119 { | |
1120 if(sdatestructure) | |
1121 if(HAL_RTC_SetDate(&RtcHandle,sdatestructure,FORMAT_BCD) != HAL_OK) | |
1122 { | |
1123 /* Initialization Error */ | |
1124 Error_Handler(); | |
1125 } | |
1126 | |
1127 if(stimestructure) | |
1128 if(HAL_RTC_SetTime(&RtcHandle,stimestructure,FORMAT_BCD) != HAL_OK) | |
1129 { | |
1130 /* Initialization Error */ | |
1131 Error_Handler(); | |
1132 } | |
1133 } | |
1134 | |
1135 static void TIM_init(void) | |
1136 { | |
1137 uint16_t uwPrescalerValue = 0; | |
1138 | |
1139 uwPrescalerValue = (uint32_t) ((SystemCoreClock /2) / 10000) - 1; | |
1140 | |
1141 /* Set TIMx instance */ | |
1142 TimHandle.Instance = TIMx; | |
1143 | |
1144 /* Initialize TIM3 peripheral as follows: | |
1145 + Period = 10000 - 1 | |
1146 + Prescaler = ((SystemCoreClock/2)/10000) - 1 | |
1147 + ClockDivision = 0 | |
1148 + Counter direction = Up | |
1149 */ | |
1150 TimHandle.Init.Period = 1000 - 1; | |
1151 TimHandle.Init.Prescaler = uwPrescalerValue; | |
1152 TimHandle.Init.ClockDivision = 0; | |
1153 TimHandle.Init.CounterMode = TIM_COUNTERMODE_UP; | |
1154 if(HAL_TIM_Base_Init(&TimHandle) != HAL_OK) | |
1155 { | |
1156 /* Initialization Error */ | |
1157 Error_Handler(); | |
1158 } | |
1159 | |
1160 /*##-2- Start the TIM Base generation in interrupt mode ####################*/ | |
1161 /* Start Channel1 */ | |
1162 if(HAL_TIM_Base_Start_IT(&TimHandle) != HAL_OK) | |
1163 { | |
1164 /* Starting Error */ | |
1165 Error_Handler(); | |
1166 } | |
1167 } | |
1168 | |
1169 #ifdef DEMOMODE | |
1170 static void TIM_DEMO_init(void) | |
1171 { | |
1172 uint16_t uwPrescalerValue = 0; | |
1173 | |
1174 uwPrescalerValue = (uint32_t) ((SystemCoreClock /2) / 10000) - 1; | |
1175 | |
1176 /* Set TIMx instance */ | |
1177 TimDemoHandle.Instance = TIM7; | |
1178 | |
1179 /* Initialize TIM3 peripheral as follows: | |
1180 + Period = 10000 - 1 | |
1181 + Prescaler = ((SystemCoreClock/2)/10000) - 1 | |
1182 + ClockDivision = 0 | |
1183 + Counter direction = Up | |
1184 */ | |
1185 TimDemoHandle.Init.Period = 1000 - 1; | |
1186 TimDemoHandle.Init.Prescaler = uwPrescalerValue; | |
1187 TimDemoHandle.Init.ClockDivision = 0; | |
1188 TimHandle.Init.CounterMode = TIM_COUNTERMODE_UP; | |
1189 if(HAL_TIM_Base_Init(&TimDemoHandle) != HAL_OK) | |
1190 { | |
1191 /* Initialization Error */ | |
1192 Error_Handler(); | |
1193 } | |
1194 | |
1195 /*##-2- Start the TIM Base generation in interrupt mode ####################*/ | |
1196 /* Start Channel1 */ | |
1197 if(HAL_TIM_Base_Start_IT(&TimDemoHandle) != HAL_OK) | |
1198 { | |
1199 /* Starting Error */ | |
1200 Error_Handler(); | |
1201 } | |
1202 } | |
1203 #endif | |
1204 | |
1205 | |
1206 | |
1207 #ifndef TIM_BACKLIGHT | |
1208 | |
1209 static uint32_t TIM_BACKLIGHT_adjust(void) | |
1210 { | |
1211 return 0; | |
1212 } | |
1213 | |
1214 static void TIM_BACKLIGHT_init(void) | |
1215 { | |
1216 } | |
1217 #else | |
1218 static uint32_t TIM_BACKLIGHT_adjust(void) | |
1219 { | |
1220 static uint32_t levelActual = 12000; | |
1221 static uint8_t brightnessModeLast = 0; | |
1222 // static _Bool wasLostConnection = 0; | |
1223 | |
1224 uint32_t levelAmbient; | |
1225 uint32_t levelMax; | |
1226 uint32_t levelMin; | |
1227 uint32_t levelUpStep_100ms = 200; | |
1228 uint32_t levelDnStep_100ms = 20; | |
1229 | |
1230 TIM_OC_InitTypeDef sConfig; | |
1231 sConfig.OCMode = TIM_OCMODE_PWM1; | |
1232 sConfig.OCPolarity = TIM_OCPOLARITY_HIGH; | |
1233 sConfig.OCFastMode = TIM_OCFAST_DISABLE; | |
1234 | |
1235 const SDiveState * pStateReal = stateRealGetPointer(); | |
1236 | |
1237 | |
1238 // if(pStateReal->data_old__lost_connection_to_slave) | |
1239 // { | |
1240 // changed 160613 from 6000 to 12000 | |
1241 // removed hw 161209 | |
1242 // levelAmbient = 12000; | |
1243 // levelActual = 12000; | |
1244 // wasLostConnection = 1; | |
1245 // } | |
1246 // else | |
1247 // { | |
1248 SSettings *pSettings = settingsGetPointer(); | |
1249 /* 300 - 4000 */ | |
1250 /* important levelAmbient 300 - 1200 */ | |
1251 levelAmbient = 10 * pStateReal->lifeData.ambient_light_level; | |
1252 | |
1253 switch( pSettings->brightness) | |
1254 { | |
1255 case 0: /* Cave */ | |
1256 levelMax = 3000;/* max 25 % (x2) */ | |
1257 levelMin = 1500; | |
1258 break; | |
1259 case 1: /* Eco */ | |
1260 levelMax = 6000;/* max 50 % (x2) */ | |
1261 levelMin = 3000; | |
1262 break; | |
1263 case 2: /* Std */ | |
1264 levelAmbient += 1000; | |
1265 levelMax = 9000; | |
1266 levelMin = 4500; | |
1267 levelUpStep_100ms += levelUpStep_100ms/2; // 4500 instead of 3000 | |
1268 levelDnStep_100ms += levelDnStep_100ms/2; | |
1269 break; | |
1270 case 3: /* High */ | |
1271 default: | |
1272 levelAmbient += 3000; | |
1273 levelMax = 12000; /* max 100% (x2) */ | |
1274 levelMin = 6000; | |
1275 levelUpStep_100ms += levelUpStep_100ms; // 6000 instead of 3000 | |
1276 levelDnStep_100ms += levelDnStep_100ms; | |
1277 break; | |
1278 case 4: /* New Max */ | |
1279 levelAmbient = 12000; | |
1280 levelMax = 12000; /* max 100% (x2) */ | |
1281 levelMin = 12000; | |
1282 levelUpStep_100ms += 12000; | |
1283 levelDnStep_100ms += 0; | |
1284 break; | |
1285 } | |
1286 | |
1287 if((pSettings->brightness != brightnessModeLast))// || wasLostConnection) | |
1288 { | |
1289 levelActual = levelAmbient; | |
1290 brightnessModeLast = pSettings->brightness; | |
1291 // wasLostConnection = 0; | |
1292 } | |
1293 // } | |
1294 | |
1295 if(levelAmbient > levelActual) | |
1296 levelActual += levelUpStep_100ms; | |
1297 else | |
1298 if((levelAmbient < levelActual) && (levelActual > levelMin) && (levelActual > levelDnStep_100ms)) | |
1299 levelActual -= levelDnStep_100ms; | |
1300 | |
1301 if(levelActual > levelMax) | |
1302 levelActual = levelMax; | |
1303 else | |
1304 if(levelActual < levelMin) | |
1305 levelActual = levelMin; | |
1306 | |
1307 // sConfig.Pulse = levelActual / 20; | |
1308 sConfig.Pulse = (levelMin + ((levelMax - levelMin)/2)) / 20; // added 170306 | |
1309 | |
1310 /* xx - 600 */ | |
1311 if(sConfig.Pulse > 600) | |
1312 sConfig.Pulse = 600; | |
1313 else | |
1314 if(sConfig.Pulse < 100) | |
1315 sConfig.Pulse = 100; | |
1316 | |
1317 HAL_TIM_PWM_ConfigChannel(&TimBacklightHandle, &sConfig, TIM_BACKLIGHT_CHANNEL); | |
1318 HAL_TIM_PWM_Start(&TimBacklightHandle, TIM_BACKLIGHT_CHANNEL); | |
1319 | |
1320 return levelActual; | |
1321 } | |
1322 | |
1323 static void TIM_BACKLIGHT_init(void) | |
1324 { | |
1325 uint32_t uwPrescalerValue = 0; | |
1326 TIM_OC_InitTypeDef sConfig; | |
1327 | |
1328 uwPrescalerValue = (uint32_t) ((SystemCoreClock /2) / 18000000) - 1; | |
1329 | |
1330 TimBacklightHandle.Instance = TIM_BACKLIGHT; | |
1331 | |
1332 /* Initialize TIM3 peripheral as follows: | |
1333 30 kHz | |
1334 */ | |
1335 TimBacklightHandle.Init.Period = 600 - 1; | |
1336 TimBacklightHandle.Init.Prescaler = uwPrescalerValue; | |
1337 TimBacklightHandle.Init.ClockDivision = 0; | |
1338 TimBacklightHandle.Init.CounterMode = TIM_COUNTERMODE_UP; | |
1339 HAL_TIM_PWM_Init(&TimBacklightHandle); | |
1340 | |
1341 sConfig.OCMode = TIM_OCMODE_PWM1; | |
1342 sConfig.OCPolarity = TIM_OCPOLARITY_HIGH; | |
1343 sConfig.OCFastMode = TIM_OCFAST_DISABLE; | |
1344 sConfig.Pulse = 50 * 6; | |
1345 | |
1346 HAL_TIM_PWM_ConfigChannel(&TimBacklightHandle, &sConfig, TIM_BACKLIGHT_CHANNEL); | |
1347 HAL_TIM_PWM_Start(&TimBacklightHandle, TIM_BACKLIGHT_CHANNEL); | |
1348 } | |
1349 #endif | |
1350 | |
1351 | |
1352 static void EXTILine_Buttons_Config(void) | |
1353 { | |
1354 GPIO_InitTypeDef GPIO_InitStructure; | |
1355 | |
1356 BUTTON_ENTER_GPIO_ENABLE(); | |
1357 BUTTON_NEXT_GPIO_ENABLE(); | |
1358 BUTTON_BACK_GPIO_ENABLE(); | |
1359 | |
1360 /* Configure pin as weak PULLUP input */ | |
1361 /* buttons */ | |
1362 GPIO_InitStructure.Mode = GPIO_MODE_IT_RISING; | |
1363 GPIO_InitStructure.Pull = GPIO_NOPULL; | |
1364 GPIO_InitStructure.Speed = GPIO_SPEED_LOW; | |
1365 | |
1366 GPIO_InitStructure.Pin = BUTTON_ENTER_PIN; | |
1367 HAL_GPIO_Init(BUTTON_ENTER_GPIO_PORT, &GPIO_InitStructure); | |
1368 | |
1369 GPIO_InitStructure.Pin = BUTTON_NEXT_PIN; | |
1370 HAL_GPIO_Init(BUTTON_NEXT_GPIO_PORT, &GPIO_InitStructure); | |
1371 | |
1372 GPIO_InitStructure.Pin = BUTTON_BACK_PIN; | |
1373 HAL_GPIO_Init(BUTTON_BACK_GPIO_PORT, &GPIO_InitStructure); | |
1374 | |
1375 /* Enable and set EXTI Line0 Interrupt to the lowest priority */ | |
1376 HAL_NVIC_SetPriority(BUTTON_ENTER_EXTI_IRQn, 2, 0); | |
1377 HAL_NVIC_SetPriority(BUTTON_NEXT_EXTI_IRQn, 2, 0); | |
1378 HAL_NVIC_SetPriority(BUTTON_BACK_EXTI_IRQn, 2, 0); | |
1379 HAL_NVIC_EnableIRQ(BUTTON_ENTER_EXTI_IRQn); | |
1380 HAL_NVIC_EnableIRQ(BUTTON_NEXT_EXTI_IRQn); | |
1381 HAL_NVIC_EnableIRQ(BUTTON_BACK_EXTI_IRQn); | |
1382 | |
1383 #ifdef BUTTON_CUSTOM_PIN | |
1384 BUTTON_CUSTOM_GPIO_ENABLE(); | |
1385 GPIO_InitStructure.Pin = BUTTON_CUSTOM_PIN; | |
1386 HAL_GPIO_Init(BUTTON_CUSTOM_GPIO_PORT, &GPIO_InitStructure); | |
1387 HAL_NVIC_SetPriority(BUTTON_CUSTOM_EXTI_IRQn, 2, 0); | |
1388 HAL_NVIC_EnableIRQ(BUTTON_CUSTOM_EXTI_IRQn); | |
1389 #endif | |
1390 } | |
1391 | |
1392 | |
1393 /** | |
1394 * @brief System Clock Configuration | |
1395 * The system Clock is configured as follow : | |
1396 * System Clock source = PLL (HSE) | |
1397 * SYSCLK(Hz) = 180000000 | |
1398 * HCLK(Hz) = 180000000 | |
1399 * AHB Prescaler = 1 | |
1400 * APB1 Prescaler = 4 | |
1401 * APB2 Prescaler = 2 | |
1402 * HSE Frequency(Hz) = 8000000 | |
1403 * PLL_M = 8 | |
1404 * PLL_N = 360 | |
1405 * PLL_P = 2 | |
1406 * PLL_Q = 7 | |
1407 * VDD(V) = 3.3 | |
1408 * Main regulator output voltage = Scale1 mode | |
1409 * Flash Latency(WS) = 5 | |
1410 * The LTDC Clock is configured as follow : | |
1411 * PLLSAIN = 192 | |
1412 * PLLSAIR = 4 | |
1413 * PLLSAIDivR = 8 | |
1414 * @param None | |
1415 * @retval None | |
1416 */ | |
1417 static void SystemClock_Config(void) | |
1418 { | |
1419 | |
1420 /* Enable Power Control clock */ | |
1421 __PWR_CLK_ENABLE(); | |
1422 | |
1423 /* The voltage scaling allows optimizing the power consumption when the device is | |
1424 clocked below the maximum system frequency, to update the voltage scaling value | |
1425 regarding system frequency refer to product datasheet. */ | |
1426 __HAL_PWR_VOLTAGESCALING_CONFIG( PWR_REGULATOR_VOLTAGE_SCALE1 ); | |
1427 | |
1428 /*##-1- System Clock Configuration #########################################*/ | |
1429 /* Enable HighSpeed Oscillator and activate PLL with HSE/HSI as source */ | |
1430 RCC_OscInitTypeDef RCC_OscInitStruct = { 0 }; | |
1431 #ifdef DISC1_BOARD | |
1432 // Use High Speed Internal (HSI) oscillator, running at 16MHz. | |
1433 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI; | |
1434 RCC_OscInitStruct.HSIState = RCC_HSI_ON; | |
1435 RCC_OscInitStruct.HSICalibrationValue = 0x10; | |
1436 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI; | |
1437 RCC_OscInitStruct.PLL.PLLM = 16; // HSI/16 is 1Mhz. | |
1438 #else | |
1439 // Use High Speed External oscillator, running at 8MHz | |
1440 RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE; | |
1441 RCC_OscInitStruct.HSEState = RCC_HSE_ON; | |
1442 RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE; | |
1443 RCC_OscInitStruct.PLL.PLLM = 8; // HSE/8 is 1Mhz. | |
1444 #endif | |
1445 // System clock = PLL (1MHz) * N/p = 180 MHz. | |
1446 RCC_OscInitStruct.PLL.PLLN = 360; | |
1447 RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2; | |
1448 RCC_OscInitStruct.PLL.PLLQ = 7; | |
1449 RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON; | |
1450 HAL_RCC_OscConfig( &RCC_OscInitStruct ); | |
1451 | |
1452 // HAL_PWREx_ActivateOverDrive(); | |
1453 HAL_PWREx_DeactivateOverDrive(); | |
1454 | |
1455 /* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2 clocks dividers */ | |
1456 RCC_ClkInitTypeDef RCC_ClkInitStruct = { 0 }; | |
1457 RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK | |
1458 | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2; | |
1459 RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK; | |
1460 RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1; | |
1461 RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV4; | |
1462 RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV2; | |
1463 HAL_RCC_ClockConfig( &RCC_ClkInitStruct, FLASH_LATENCY_8 ); //FLASH_LATENCY_5); | |
1464 | |
1465 /*##-2- LTDC Clock Configuration ###########################################*/ | |
1466 /* LCD clock configuration */ | |
1467 /* PLLSAI_VCO Input = HSE_VALUE/PLL_M = 1 Mhz */ | |
1468 /* PLLSAI_VCO Output = PLLSAI_VCO Input * PLLSAIN = 192 Mhz */ | |
1469 /* PLLLCDCLK = PLLSAI_VCO Output/PLLSAIR = 192/4 = 48 Mhz */ | |
1470 /* LTDC clock frequency = PLLLCDCLK / RCC_PLLSAIDIVR_8 = 48/8 = 6 Mhz */ | |
1471 | |
1472 /* neu: 8MHz/8*300/5/8 = 7,5 MHz = 19,5 Hz bei 800 x 480 */ | |
1473 RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0}; | |
1474 PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_LTDC; | |
1475 PeriphClkInitStruct.PLLSAI.PLLSAIN = 300; //192; | |
1476 PeriphClkInitStruct.PLLSAI.PLLSAIR = 5; //4; | |
1477 PeriphClkInitStruct.PLLSAIDivR = RCC_PLLSAIDIVR_8;//RCC_PLLSAIDIVR_4;// RCC_PLLSAIDIVR_2; // RCC_PLLSAIDIVR_8 | |
1478 HAL_RCCEx_PeriphCLKConfig( &PeriphClkInitStruct ); | |
1479 } | |
1480 | |
1481 | |
1482 /** | |
1483 * @brief This function is executed in case of error occurrence. | |
1484 * @param None | |
1485 * @retval None | |
1486 */ | |
1487 static void Error_Handler(void) | |
1488 { | |
1489 /* Turn LED3 on */ | |
1490 // BSP_LED_On(LED3); | |
1491 while(1) | |
1492 { | |
1493 } | |
1494 } | |
1495 | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1496 /** |
38 | 1497 * @brief Perform the SDRAM exernal memory inialization sequence |
1498 * @param hsdram: SDRAM handle | |
1499 * @param Command: Pointer to SDRAM command structure | |
1500 * @retval None | |
1501 */ | |
1502 static void SDRAM_Initialization_Sequence(SDRAM_HandleTypeDef *hsdram, FMC_SDRAM_CommandTypeDef *Command) | |
1503 { | |
1504 __IO uint32_t tmpmrd =0; | |
1505 /* Step 3: Configure a clock configuration enable command */ | |
1506 Command->CommandMode = FMC_SDRAM_CMD_CLK_ENABLE; | |
1507 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1508 Command->AutoRefreshNumber = 1; | |
1509 Command->ModeRegisterDefinition = 0; | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1510 |
38 | 1511 /* Send the command */ |
1512 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
1513 | |
1514 /* Step 4: Insert 100 ms delay */ | |
1515 HAL_Delay(100); | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1516 |
38 | 1517 /* Step 5: Configure a PALL (precharge all) command */ |
1518 Command->CommandMode = FMC_SDRAM_CMD_PALL; | |
1519 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1520 Command->AutoRefreshNumber = 1; | |
1521 Command->ModeRegisterDefinition = 0; | |
1522 | |
1523 /* Send the command */ | |
1524 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1525 |
38 | 1526 /* Step 6 : Configure a Auto-Refresh command */ |
1527 Command->CommandMode = FMC_SDRAM_CMD_AUTOREFRESH_MODE; | |
1528 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1529 Command->AutoRefreshNumber = 4; | |
1530 Command->ModeRegisterDefinition = 0; | |
1531 | |
1532 /* Send the command */ | |
1533 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1534 |
38 | 1535 /* Step 7: Program the external memory mode register */ |
1536 tmpmrd = (uint32_t)SDRAM_MODEREG_BURST_LENGTH_2 | | |
1537 SDRAM_MODEREG_BURST_TYPE_SEQUENTIAL | | |
1538 SDRAM_MODEREG_CAS_LATENCY_3 | | |
1539 SDRAM_MODEREG_OPERATING_MODE_STANDARD | | |
1540 SDRAM_MODEREG_WRITEBURST_MODE_SINGLE; | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1541 |
38 | 1542 Command->CommandMode = FMC_SDRAM_CMD_LOAD_MODE; |
1543 Command->CommandTarget = FMC_SDRAM_CMD_TARGET_BANK2; | |
1544 Command->AutoRefreshNumber = 1; | |
1545 Command->ModeRegisterDefinition = tmpmrd; | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1546 |
38 | 1547 /* Send the command */ |
1548 HAL_SDRAM_SendCommand(hsdram, Command, 0x1000); | |
1549 | |
1550 /* Step 8: Set the refresh rate counter */ | |
1551 /* (15.62 us x Freq) - 20 */ | |
1552 /* neu: (8 us x Freq) - 20 */ | |
1553 /* Set the device refresh counter */ | |
1554 HAL_SDRAM_ProgramRefreshRate(hsdram, REFRESH_COUNT); | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1555 } |
38 | 1556 |
1557 | |
1558 /** | |
1559 ****************************************************************************** | |
1560 ****************************************************************************** | |
1561 ****************************************************************************** | |
1562 */ | |
1563 | |
1564 | |
1565 /** | |
1566 * @brief DMA2D configuration. | |
1567 * @note This function Configure tha DMA2D peripheral : | |
1568 * 1) Configure the transfer mode : memory to memory W/ pixel format conversion | |
1569 * 2) Configure the output color mode as ARGB4444 | |
1570 * 3) Configure the output memory address at SRAM memory | |
1571 * 4) Configure the data size : 320x120 (pixels) | |
1572 * 5) Configure the input color mode as ARGB8888 | |
1573 * 6) Configure the input memory address at FLASH memory | |
1574 * @retval | |
1575 * None | |
1576 */ | |
1577 | |
1578 static void SDRAM_Config(void) | |
1579 { | |
1580 /*##-1- Configure the SDRAM device #########################################*/ | |
1581 /* SDRAM device configuration */ | |
1582 hsdram.Instance = FMC_SDRAM_DEVICE; | |
1583 | |
1584 /* Timing configuration for 90 Mhz of SD clock frequency (180Mhz/2) */ | |
1585 /* TMRD: 2 Clock cycles */ | |
1586 SDRAM_Timing.LoadToActiveDelay = 2; | |
1587 /* TXSR: min=70ns (6x11.90ns) */ | |
1588 SDRAM_Timing.ExitSelfRefreshDelay = 7; | |
1589 /* TRAS: min=42ns (4x11.90ns) max=120k (ns) */ | |
1590 SDRAM_Timing.SelfRefreshTime = 4; | |
1591 /* TRC: min=63 (6x11.90ns) */ | |
1592 SDRAM_Timing.RowCycleDelay = 7; | |
1593 /* TWR: 2 Clock cycles */ | |
1594 SDRAM_Timing.WriteRecoveryTime = 2; | |
1595 /* TRP: 15ns => 2x11.90ns */ | |
1596 SDRAM_Timing.RPDelay = 2; | |
1597 /* TRCD: 15ns => 2x11.90ns */ | |
1598 SDRAM_Timing.RCDDelay = 2; | |
1599 | |
1600 hsdram.Init.SDBank = FMC_SDRAM_BANK2; | |
1601 hsdram.Init.ColumnBitsNumber = FMC_SDRAM_COLUMN_BITS_NUM_9; | |
1602 hsdram.Init.RowBitsNumber = FMC_SDRAM_ROW_BITS_NUM_13; | |
1603 hsdram.Init.MemoryDataWidth = SDRAM_MEMORY_WIDTH; | |
1604 hsdram.Init.InternalBankNumber = FMC_SDRAM_INTERN_BANKS_NUM_4; | |
1605 hsdram.Init.CASLatency = FMC_SDRAM_CAS_LATENCY_3; | |
1606 hsdram.Init.WriteProtection = FMC_SDRAM_WRITE_PROTECTION_DISABLE; | |
1607 hsdram.Init.SDClockPeriod = SDCLOCK_PERIOD; | |
1608 hsdram.Init.ReadBurst = FMC_SDRAM_RBURST_DISABLE; | |
1609 hsdram.Init.ReadPipeDelay = FMC_SDRAM_RPIPE_DELAY_1; | |
1610 | |
1611 /* Initialize the SDRAM controller */ | |
1612 if(HAL_SDRAM_Init(&hsdram, &SDRAM_Timing) != HAL_OK) | |
1613 { | |
1614 /* Initialization Error */ | |
1615 Error_Handler(); | |
1616 } | |
95
2a74647d28d1
Debounce. Bounced buttons fixed.
Dmitry Romanov <kitt@bk.ru>
parents:
91
diff
changeset
|
1617 |
38 | 1618 /* Program the SDRAM external device */ |
1619 SDRAM_Initialization_Sequence(&hsdram, &command); | |
1620 } | |
1621 | |
1622 | |
1623 #ifdef USE_FULL_ASSERT | |
1624 | |
1625 /** | |
1626 * @brief Reports the name of the source file and the source line number | |
1627 * where the assert_param error has occurred. | |
1628 * @param file: pointer to the source file name | |
1629 * @param line: assert_param error line source number | |
1630 * @retval None | |
1631 */ | |
1632 void assert_failed(uint8_t* file, uint32_t line) | |
1633 { | |
1634 /* User can add his own implementation to report the file name and line number, | |
1635 ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */ | |
1636 | |
1637 /* Infinite loop */ | |
1638 while (1) | |
1639 { | |
1640 } | |
1641 } | |
1642 #endif | |
1643 | |
1644 | |
1645 void deco_loop(void) | |
1646 { | |
1647 typedef enum | |
1648 { | |
1649 CALC_VPM, | |
1650 CALC_VPM_FUTURE, | |
1651 CALC_BUEHLMANN, | |
1652 CALC_BUEHLMANN_FUTURE, | |
1653 } CALC_WHAT; | |
1654 | |
1655 static int what = -1; | |
1656 int counter = 0; | |
1657 if((stateUsed->mode != MODE_DIVE) || (stateUsed->diveSettings.diveMode == DIVEMODE_Apnea) || (decoLock != DECO_CALC_ready )) | |
1658 return; | |
1659 | |
1660 decoLock = DECO_CALC_running; | |
1661 | |
1662 if(stateDeco.diveSettings.deco_type.ub.standard == GF_MODE) | |
1663 { | |
1664 // 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)) | |
1665 if(what == CALC_BUEHLMANN) | |
1666 { | |
1667 //Calc future | |
1668 what = CALC_BUEHLMANN_FUTURE; | |
1669 } | |
1670 else | |
1671 what = CALC_BUEHLMANN; | |
1672 | |
1673 } | |
1674 else | |
1675 { | |
1676 // hw 151110 mh wants future TTS even in deco zone if((what == CALC_VPM) && (!stateDeco.vpm.deco_zone_reached)) | |
1677 if(what == CALC_VPM) | |
1678 { | |
1679 //Calc future | |
1680 what = CALC_VPM_FUTURE; | |
1681 } | |
1682 else | |
1683 what = CALC_VPM; | |
1684 } | |
1685 | |
1686 //In one of ten calc the other option | |
1687 if(counter == 10) | |
1688 { | |
1689 if(what == CALC_VPM) | |
1690 what = CALC_BUEHLMANN; | |
1691 if(what == CALC_BUEHLMANN) | |
1692 what = CALC_VPM; | |
1693 counter = 0; | |
1694 } | |
1695 | |
1696 decom_CreateGasChangeList(&stateDeco.diveSettings, &stateDeco.lifeData); | |
1697 | |
1698 switch(what) | |
1699 { | |
1700 case CALC_VPM: | |
1701 vpm_calc(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.vpm,&stateDeco.decolistVPM, DECOSTOPS); | |
1702 decoLock = DECO_CALC_FINSHED_vpm; | |
1703 return; | |
1704 case CALC_VPM_FUTURE: | |
1705 decom_tissues_exposure(stateDeco.diveSettings.future_TTS_minutes * 60,&stateDeco.lifeData); | |
1706 vpm_calc(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.vpm,&stateDeco.decolistFutureVPM, FUTURESTOPS); | |
1707 decoLock = DECO_CALC_FINSHED_Futurevpm; | |
1708 return; | |
1709 case CALC_BUEHLMANN: | |
1710 buehlmann_calc_deco(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1711 buehlmann_ceiling_calculator(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1712 buehlmann_relative_gradient_calculator(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1713 decoLock = DECO_CALC_FINSHED_Buehlmann; | |
1714 return; | |
1715 case CALC_BUEHLMANN_FUTURE: | |
1716 decom_tissues_exposure(stateDeco.diveSettings.future_TTS_minutes * 60,&stateDeco.lifeData); | |
1717 buehlmann_calc_deco(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistFutureBuehlmann); | |
1718 //buehlmann_ceiling_calculator(&stateDeco.lifeData,&stateDeco.diveSettings,&stateDeco.decolistBuehlmann); | |
1719 decoLock = DECO_CALC_FINSHED_FutureBuehlmann; | |
1720 return; | |
1721 } | |
1722 counter++; | |
1723 } | |
1724 | |
1725 void resetToFirmwareUpdate(void) | |
1726 { | |
1727 __HAL_RCC_CLEAR_RESET_FLAGS(); | |
1728 HAL_NVIC_SystemReset(); | |
1729 } | |
1730 | |
1731 // debugging by https://blog.feabhas.com/2013/02/developing-a-generic-hard-fault-handler-for-arm-cortex-m3cortex-m4/ | |
1732 | |
1733 /* | |
1734 void printErrorMsg(const char * errMsg) | |
1735 { | |
1736 | |
1737 // printf(errMsg); | |
1738 // return; | |
1739 | |
1740 while(*errMsg != 0){ | |
1741 ITM_SendChar(*errMsg); | |
1742 ++errMsg; | |
1743 } | |
1744 } | |
1745 | |
1746 enum { r0, r1, r2, r3, r12, lr, pc, psr}; | |
1747 | |
1748 void stackDump(uint32_t stack[]) | |
1749 { | |
1750 static char msg[80]; | |
1751 sprintf(msg, "r0 = 0x%08x\n", stack[r0]); printErrorMsg(msg); | |
1752 sprintf(msg, "r1 = 0x%08x\n", stack[r1]); printErrorMsg(msg); | |
1753 sprintf(msg, "r2 = 0x%08x\n", stack[r2]); printErrorMsg(msg); | |
1754 sprintf(msg, "r3 = 0x%08x\n", stack[r3]); printErrorMsg(msg); | |
1755 sprintf(msg, "r12 = 0x%08x\n", stack[r12]); printErrorMsg(msg); | |
1756 sprintf(msg, "lr = 0x%08x\n", stack[lr]); printErrorMsg(msg); | |
1757 sprintf(msg, "pc = 0x%08x\n", stack[pc]); printErrorMsg(msg); | |
1758 sprintf(msg, "psr = 0x%08x\n", stack[psr]); printErrorMsg(msg); | |
1759 } | |
1760 | |
1761 void printUsageErrorMsg(uint32_t CFSRValue) | |
1762 { | |
1763 printErrorMsg("Usage fault: "); | |
1764 CFSRValue >>= 16; // right shift to lsb | |
1765 if((CFSRValue & (1 << 9)) != 0) { | |
1766 printErrorMsg("Divide by zero\n"); | |
1767 } | |
1768 } | |
1769 | |
1770 void Hard_Fault_Handler()//uint32_t stack[]) | |
1771 { | |
1772 static char msg[80]; | |
1773 printErrorMsg("In Hard Fault Handler\n"); | |
1774 sprintf(msg, "SCB->HFSR = 0x%08x\n", SCB->HFSR); | |
1775 printErrorMsg(msg); | |
1776 if ((SCB->HFSR & (1 << 30)) != 0) { | |
1777 printErrorMsg("Forced Hard Fault\n"); | |
1778 sprintf(msg, "SCB->CFSR = 0x%08x\n", SCB->CFSR ); | |
1779 printErrorMsg(msg); | |
1780 if((SCB->CFSR & 0xFFFF0000) != 0) { | |
1781 printUsageErrorMsg(SCB->CFSR); | |
1782 } | |
1783 } | |
1784 __ASM volatile("BKPT #01"); | |
1785 while(1); | |
1786 } | |
1787 | |
1788 int my_store_of_MSP; | |
1789 | |
1790 void HardFault_Handler(void) | |
1791 { | |
1792 __asm ("MRS my_store_of_MSP, MSP"); | |
1793 Hard_Fault_Handler(); | |
1794 } | |
1795 */ | |
1796 | |
1797 /* | |
1798 __asm void HardFault_Handler(void) | |
1799 { | |
1800 TST lr, #4 // Test for MSP or PSP | |
1801 ITE EQ | |
1802 MRSEQ r0, MSP | |
1803 MRSNE r0, PSP | |
1804 B __cpp(Hard_Fault_Handler) | |
1805 } | |
1806 */ | |
1807 /* | |
1808 HardFault_Handler\ | |
1809 PROC | |
1810 EXPORT HardFault_Handler | |
1811 B . | |
1812 ENDP | |
1813 */ | |
1814 | |
1815 /* | |
1816 __asm int f(int i) | |
1817 { | |
1818 ADD i, i, #1 // error | |
1819 } | |
1820 | |
1821 EXPORT HardFault_Handler | |
1822 HardFault_Handler FUNCTION | |
1823 MRS r0, MSP | |
1824 B __cpp(Hard_Fault_Handler) | |
1825 ENDFUNC | |
1826 */ |