FuriHal: use proper divider for core2 when transition to sleep, remove extra stop mode transition checks, cleanup code. Furi: proper assert and check messages. (#2615)
This commit is contained in:
		
							parent
							
								
									d70ba2b740
								
							
						
					
					
						commit
						0ec8fc4c55
					
				| @ -88,7 +88,7 @@ bool ble_app_init() { | ||||
|             .min_tx_power = 0, | ||||
|             .max_tx_power = 0, | ||||
|             .rx_model_config = 1, | ||||
|             /* New stack (13.3->16.0)*/ | ||||
|             /* New stack (13.3->15.0) */ | ||||
|             .max_adv_set_nbr = 1, // Only used if SHCI_C2_BLE_INIT_OPTIONS_EXT_ADV is set
 | ||||
|             .max_adv_data_len = 31, // Only used if SHCI_C2_BLE_INIT_OPTIONS_EXT_ADV is set
 | ||||
|             .tx_path_compens = 0, // RF TX Path Compensation, * 0.1 dB
 | ||||
|  | ||||
| @ -84,9 +84,7 @@ void furi_hal_bt_init() { | ||||
|     } | ||||
| 
 | ||||
|     // Explicitly tell that we are in charge of CLK48 domain
 | ||||
|     if(!LL_HSEM_IsSemaphoreLocked(HSEM, CFG_HW_CLK48_CONFIG_SEMID)) { | ||||
|         furi_check(LL_HSEM_1StepLock(HSEM, CFG_HW_CLK48_CONFIG_SEMID) == 0); | ||||
|     } | ||||
|     furi_check(LL_HSEM_1StepLock(HSEM, CFG_HW_CLK48_CONFIG_SEMID) == 0); | ||||
| 
 | ||||
|     // Start Core2
 | ||||
|     ble_glue_init(); | ||||
| @ -129,9 +127,7 @@ bool furi_hal_bt_start_radio_stack() { | ||||
|     furi_mutex_acquire(furi_hal_bt_core2_mtx, FuriWaitForever); | ||||
| 
 | ||||
|     // Explicitly tell that we are in charge of CLK48 domain
 | ||||
|     if(!LL_HSEM_IsSemaphoreLocked(HSEM, CFG_HW_CLK48_CONFIG_SEMID)) { | ||||
|         furi_check(LL_HSEM_1StepLock(HSEM, CFG_HW_CLK48_CONFIG_SEMID) == 0); | ||||
|     } | ||||
|     furi_check(LL_HSEM_1StepLock(HSEM, CFG_HW_CLK48_CONFIG_SEMID) == 0); | ||||
| 
 | ||||
|     do { | ||||
|         // Wait until C2 is started or timeout
 | ||||
|  | ||||
| @ -213,7 +213,11 @@ void furi_hal_clock_switch_to_hsi() { | ||||
|     while(LL_RCC_GetSysClkSource() != LL_RCC_SYS_CLKSOURCE_STATUS_HSI) | ||||
|         ; | ||||
| 
 | ||||
|     LL_FLASH_SetLatency(LL_FLASH_LATENCY_1); | ||||
|     LL_C2_RCC_SetAHBPrescaler(LL_RCC_SYSCLK_DIV_1); | ||||
| 
 | ||||
|     LL_FLASH_SetLatency(LL_FLASH_LATENCY_0); | ||||
|     while(LL_FLASH_GetLatency() != LL_FLASH_LATENCY_0) | ||||
|         ; | ||||
| } | ||||
| 
 | ||||
| void furi_hal_clock_switch_to_pll() { | ||||
| @ -228,7 +232,11 @@ void furi_hal_clock_switch_to_pll() { | ||||
|     while(!LL_RCC_PLLSAI1_IsReady()) | ||||
|         ; | ||||
| 
 | ||||
|     LL_C2_RCC_SetAHBPrescaler(LL_RCC_SYSCLK_DIV_2); | ||||
| 
 | ||||
|     LL_FLASH_SetLatency(LL_FLASH_LATENCY_3); | ||||
|     while(LL_FLASH_GetLatency() != LL_FLASH_LATENCY_3) | ||||
|         ; | ||||
| 
 | ||||
|     LL_RCC_SetSysClkSource(LL_RCC_SYS_CLKSOURCE_PLL); | ||||
|     LL_RCC_SetSMPSClockSource(LL_RCC_SMPS_CLKSOURCE_HSE); | ||||
|  | ||||
| @ -29,10 +29,6 @@ | ||||
| #define FURI_HAL_POWER_DEBUG_STOP_GPIO (&gpio_ext_pc3) | ||||
| #endif | ||||
| 
 | ||||
| #ifndef FURI_HAL_POWER_DEBUG_ABNORMAL_GPIO | ||||
| #define FURI_HAL_POWER_DEBUG_ABNORMAL_GPIO (&gpio_ext_pb3) | ||||
| #endif | ||||
| 
 | ||||
| #ifndef FURI_HAL_POWER_STOP_MODE | ||||
| #define FURI_HAL_POWER_STOP_MODE (LL_PWR_MODE_STOP2) | ||||
| #endif | ||||
| @ -92,10 +88,8 @@ void furi_hal_power_init() { | ||||
| #ifdef FURI_HAL_POWER_DEBUG | ||||
|     furi_hal_gpio_init_simple(FURI_HAL_POWER_DEBUG_WFI_GPIO, GpioModeOutputPushPull); | ||||
|     furi_hal_gpio_init_simple(FURI_HAL_POWER_DEBUG_STOP_GPIO, GpioModeOutputPushPull); | ||||
|     furi_hal_gpio_init_simple(FURI_HAL_POWER_DEBUG_ABNORMAL_GPIO, GpioModeOutputPushPull); | ||||
|     furi_hal_gpio_write(FURI_HAL_POWER_DEBUG_WFI_GPIO, 0); | ||||
|     furi_hal_gpio_write(FURI_HAL_POWER_DEBUG_STOP_GPIO, 0); | ||||
|     furi_hal_gpio_write(FURI_HAL_POWER_DEBUG_ABNORMAL_GPIO, 0); | ||||
| #endif | ||||
| 
 | ||||
|     LL_PWR_SetRegulVoltageScaling(LL_PWR_REGU_VOLTAGE_SCALE1); | ||||
| @ -158,9 +152,7 @@ bool furi_hal_power_sleep_available() { | ||||
| 
 | ||||
| static inline bool furi_hal_power_deep_sleep_available() { | ||||
|     return furi_hal_bt_is_alive() && !furi_hal_rtc_is_flag_set(FuriHalRtcFlagLegacySleep) && | ||||
|            !furi_hal_debug_is_gdb_session_active() && !LL_PWR_IsActiveFlag_CRPE() && | ||||
|            !LL_PWR_IsActiveFlag_CRP() && !LL_PWR_IsActiveFlag_BLEA() && | ||||
|            !LL_PWR_IsActiveFlag_BLEWU(); | ||||
|            !furi_hal_debug_is_gdb_session_active(); | ||||
| } | ||||
| 
 | ||||
| static inline void furi_hal_power_light_sleep() { | ||||
| @ -211,16 +203,7 @@ static inline void furi_hal_power_deep_sleep() { | ||||
|     __force_stores(); | ||||
| #endif | ||||
| 
 | ||||
|     bool should_abort_sleep = LL_PWR_IsActiveFlag_CRPE() || LL_PWR_IsActiveFlag_CRP() || | ||||
|                               LL_PWR_IsActiveFlag_BLEA() || LL_PWR_IsActiveFlag_BLEWU(); | ||||
| 
 | ||||
|     if(should_abort_sleep) { | ||||
| #ifdef FURI_HAL_POWER_DEBUG | ||||
|         furi_hal_gpio_write(FURI_HAL_POWER_DEBUG_ABNORMAL_GPIO, 1); | ||||
| #endif | ||||
|     } else { | ||||
|         __WFI(); | ||||
|     } | ||||
|     __WFI(); | ||||
| 
 | ||||
|     LL_LPM_EnableSleep(); | ||||
| 
 | ||||
|  | ||||
| @ -48,21 +48,21 @@ FURI_NORETURN void __furi_halt(); | ||||
|     } while(0) | ||||
| 
 | ||||
| /** Check condition and crash if check failed */ | ||||
| #define furi_check(__e)                             \ | ||||
|     do {                                            \ | ||||
|         if(!(__e)) {                                \ | ||||
|             furi_crash(__FURI_ASSERT_MESSAGE_FLAG); \ | ||||
|         }                                           \ | ||||
|     } while(0) | ||||
| 
 | ||||
| /** Only in debug build: Assert condition and crash if assert failed  */ | ||||
| #ifdef FURI_DEBUG | ||||
| #define furi_assert(__e)                           \ | ||||
| #define furi_check(__e)                            \ | ||||
|     do {                                           \ | ||||
|         if(!(__e)) {                               \ | ||||
|             furi_crash(__FURI_CHECK_MESSAGE_FLAG); \ | ||||
|         }                                          \ | ||||
|     } while(0) | ||||
| 
 | ||||
| /** Only in debug build: Assert condition and crash if assert failed  */ | ||||
| #ifdef FURI_DEBUG | ||||
| #define furi_assert(__e)                            \ | ||||
|     do {                                            \ | ||||
|         if(!(__e)) {                                \ | ||||
|             furi_crash(__FURI_ASSERT_MESSAGE_FLAG); \ | ||||
|         }                                           \ | ||||
|     } while(0) | ||||
| #else | ||||
| #define furi_assert(__e) \ | ||||
|     do {                 \ | ||||
|  | ||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user
	 あく
						あく