| | |
| | | } |
| | | if(g_com_map[IMU_THRES]>10) |
| | | {g_com_map[IMU_THRES]=2;} |
| | | if(g_com_map[POWER]>MAX_RFPOWER) |
| | | {g_com_map[POWER]=MAX_RFPOWER;} |
| | | if(g_com_map[POWER]<0) |
| | | {g_com_map[POWER]=0;} |
| | | if(g_com_map[POWER]>MAX_RFPOWER) |
| | | {g_com_map[POWER]=MAX_RFPOWER;} |
| | | if(g_com_map[POWER]<0) |
| | | {g_com_map[POWER]=0;} |
| | | if(g_com_map[STATIONARY_TIME]==0) |
| | | { |
| | | g_com_map[STATIONARY_TIME]=10; |
| | | } |
| | | |
| | | } |
| | | u8 active_flag=0; |
| | | void Program_Init(void) |
| | |
| | | hardware_pici= STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+2); |
| | | hardware_type= STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+4); |
| | | //deca_sleep(1000); |
| | | g_com_map[VERSION] = 0x022c; |
| | | g_com_map[VERSION] = (2<<8)|62; |
| | | |
| | | // g_com_map[DEV_ID]=0x7; |
| | | #ifdef DEBUG_MODE |
| | | // g_com_map[DEV_ROLE]=1; |
| | | // g_com_map[DEV_ID]=0x4009; |
| | | // g_com_map[DEV_ID]=0x4009; |
| | | // g_com_map[ACTIVE_INDEX]=1; |
| | | g_com_map[COM_INTERVAL]=50; |
| | | // g_com_map[COM_INTERVAL]=50; |
| | | // g_com_map[MAX_REPORT_ANC_NUM]=1; |
| | | // g_com_map[NOMOVESLEEP_TIME]=10; |
| | | // g_com_map[IMU_ENABLE]=0; |
| | |
| | | void HardWareTypeDiffConfig(void) |
| | | { |
| | | GPIO_InitTypeDef GPIO_InitStruct = {0}; |
| | | //if(g_com_map[MOTORBEEPER_INDEX]!=1&&g_com_map[MOTORBEEPER_INDEX]!=2) |
| | | if(g_com_map[MOTORBEEPER_INDEX]!=1&&g_com_map[MOTORBEEPER_INDEX]!=2) |
| | | { |
| | | g_com_map[MOTORBEEPER_INDEX] = 1; |
| | | g_com_map[MOTORBEEPER_INDEX] = 2; |
| | | } |
| | | hardware_type = g_com_map[MOTORBEEPER_INDEX]; |
| | | switch(hardware_type) |
| | |
| | | /* USER CODE BEGIN 2 */ |
| | | LED_LG_ON; |
| | | Program_Init(); |
| | | LIS3DH_Data_Init(); |
| | | BarInit(); |
| | | Accelerometer_Init(); |
| | | BarInit(); |
| | | Dw1000_Init(); |
| | | Dw1000_App_Init(); |
| | | HardWareTypeDiffConfig(); |
| | |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | |
| | | |
| | | |
| | | // HAL_Delay(2000); |
| | | // mcu_sleep(); |
| | | //LED0_BLINK; |
| | |
| | | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
| | | HAL_GPIO_Init(GPIOC, &GPIO_InitStruct); |
| | | |
| | | |
| | | |
| | | HAL_PWR_EnterSTOPMode(PWR_LOWPOWERREGULATOR_ON, PWR_STOPENTRY_WFI); |
| | | HAL_PWR_DisableWakeUpPin(PWR_WAKEUP_PIN1); |
| | | /*Clear all related wakeup flags*/ |
| | |
| | | nomove_count+=1/(float)tag_frequency; |
| | | if(motor_keeptime>0) |
| | | { |
| | | motor_keeptime-=1/(float)tag_frequency; |
| | | motor_keeptime-=1/(float)tag_frequency; |
| | | } |
| | | if(motor_keeptime<0) |
| | | {motor_keeptime = 0;} |