#include "FreeRTOS.h"
|
#include "task.h"
|
#include "timers.h"
|
#include "ble_config.h"
|
#include "pan_clktrim.h"
|
#include "pan_power.h"
|
#if BLE_EN
|
#include "pan_ble.h"
|
#endif
|
#if CONFIG_RTT_LOG_ENABLE
|
#include "SEGGER_RTT.h"
|
#endif
|
#include "app_log.h"
|
#include "soc_api.h"
|
#include "utility.h"
|
|
/*******************************************************************************
|
* Macro
|
******************************************************************************/
|
|
|
/*******************************************************************************
|
* Variable Define & Declaration
|
******************************************************************************/
|
|
|
/*******************************************************************************
|
* Function Declaration
|
******************************************************************************/
|
|
|
/*******************************************************************************
|
* Function Define
|
******************************************************************************/
|
#if CONFIG_OS_EN
|
|
#if CONFIG_AUTO_OPTIMIZE_POWER_PARAM
|
#define TEMP_CHECK_INTERVAL_MS (CONFIG_TEMP_SAMPLE_INTERVAL_S*1000)
|
|
static TimerHandle_t temp_check_timer;
|
static ADC_HandleTypeDef adc_temperature = {
|
.id = ADC_CH_TEMP,
|
};
|
|
void temp_check_cb(TimerHandle_t xtimer)
|
{
|
float temp;
|
|
//printf("[W] temp_check_cb\r\n");
|
|
if (HAL_ADC_GetValue(&adc_temperature, &temp) == HAL_SUCCESS) {
|
PW_AutoOptimizeParams((int)temp);
|
|
#if BLE_EN
|
/* Update SCA */
|
static uint8_t config = 0xFF;
|
uint16_t SCA = CONFIG_BT_CTLR_SCA;
|
if(temp > 15 && temp < 30){
|
if(config == 0)
|
return;
|
config = 0;
|
SCA = CONFIG_BT_CTLR_SCA;
|
}
|
else{
|
if(config == 1)
|
return;
|
config = 1;
|
SCA = (CONFIG_LOW_SPEED_CLOCK_SRC==0 ? 1000:500);
|
}
|
pan_misc_upd_local_sca(SCA);
|
|
//printf("update SCA:%d\n", SCA);
|
#endif
|
}
|
}
|
|
void temp_check_start(uint32_t ms)
|
{
|
(void)ms;
|
|
if(temp_check_timer){
|
xTimerStart(temp_check_timer, 0);
|
}
|
}
|
|
void temp_check_stop(void)
|
{
|
if(temp_check_timer){
|
xTimerStop(temp_check_timer, 0);
|
}
|
}
|
|
void temp_check_init(void)
|
{
|
temp_check_timer = xTimerCreate("pwr_param_upd_timer", pdMS_TO_TICKS(TEMP_CHECK_INTERVAL_MS), pdTRUE, NULL, temp_check_cb);
|
if(temp_check_timer == NULL){
|
printf("[E] %s %d temp check timer create failed\n", __FILE__, __LINE__);
|
}
|
temp_check_start(0);
|
}
|
#endif /* CONFIG_AUTO_OPTIMIZE_POWER_PARAM */
|
|
|
TaskHandle_t main_task_h;
|
|
void main_task(void *p)
|
{
|
#if CONFIG_AUTO_OPTIMIZE_POWER_PARAM
|
if(!PW_ParamExists()) {
|
printf("[E] Optimized power configuration is not found!\n");
|
while(1);
|
}
|
HAL_ADC_Init(&adc_temperature);
|
temp_check_cb(NULL);
|
temp_check_init();
|
#endif /* CONFIG_AUTO_OPTIMIZE_POWER_PARAM */
|
|
extern int $Super$$main(void);
|
$Super$$main();
|
|
vTaskDelete(NULL);
|
}
|
|
__NO_RETURN void os_schedule_main(void)
|
{
|
xTaskCreate(main_task, "main_task", CONFIG_MAIN_TASK_STACK_SIZE, NULL, CONFIG_MAIN_TASK_PRIO, &main_task_h);
|
|
/* Start OS */
|
vTaskStartScheduler();
|
|
printf("[E] This is not where the program should go\r\n");
|
while(1);
|
}
|
|
#endif /* CONFIG_OS_EN */
|
