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