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