| | |
| | | /* Private define ------------------------------------------------------------*/ |
| | | /* USER CODE BEGIN PD */ |
| | | //#define DEBUG_MODE |
| | | #define Period (uint32_t) 32768 - 1 |
| | | #define Timeout (uint32_t) 32768 - 1//(32768 - 1) |
| | | //#define LPTIM_Period (uint32_t) 32768 - 1 |
| | | //#define Timeout (uint32_t) 32768 - 1//(32768 - 1) |
| | | /* USER CODE END PD */ |
| | | |
| | | /* Private macro -------------------------------------------------------------*/ |
| | |
| | | LPTIM_HandleTypeDef hlptim1; |
| | | |
| | | SPI_HandleTypeDef hspi1; |
| | | |
| | | TIM_HandleTypeDef htim2; |
| | | |
| | | UART_HandleTypeDef huart1; |
| | | DMA_HandleTypeDef hdma_usart1_rx; |
| | |
| | | static void MX_SPI1_Init(void); |
| | | static void MX_ADC_Init(void); |
| | | static void MX_DMA_Init(void); |
| | | static void MX_TIM2_Init(void); |
| | | /* USER CODE BEGIN PFP */ |
| | | |
| | | /* USER CODE END PFP */ |
| | |
| | | } |
| | | switch(motor_state) |
| | | {case 0: |
| | | MOTOR_OFF; |
| | | // MOTOR_OFF; |
| | | break; |
| | | case 1: |
| | | if(current_time<MOTOR_ONTIME) |
| | | { |
| | | MOTOR_ON; |
| | | // MOTOR_ON; |
| | | }else{ |
| | | MOTOR_OFF; |
| | | // MOTOR_OFF; |
| | | } |
| | | |
| | | break; |
| | | case 2: |
| | | MOTOR_ON; |
| | | // MOTOR_ON; |
| | | break; |
| | | case 3: |
| | | MOTOR_OFF; |
| | | // MOTOR_OFF; |
| | | break; |
| | | } |
| | | if(HAL_GPIO_ReadPin(INPUT_5V_GPIO_Port,INPUT_5V_Pin)) |
| | |
| | | { |
| | | g_com_map[COM_INTERVAL]=100; |
| | | } |
| | | if(module_power>MAX_RFPOWER) |
| | | {module_power=MAX_RFPOWER;} |
| | | if(module_power<0) |
| | | {module_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;} |
| | | module_power = g_com_map[POWER]; |
| | | imu_enable=g_com_map[IMU_ENABLE]; |
| | | motor_enable=g_com_map[MOTOR_ENABLE]; |
| | |
| | | /* Initialize all configured peripherals */ |
| | | MX_GPIO_Init(); |
| | | MX_LPTIM1_Init(); |
| | | MX_DMA_Init(); |
| | | MX_USART1_UART_Init(); |
| | | MX_SPI1_Init(); |
| | | MX_ADC_Init(); |
| | | MX_DMA_Init(); |
| | | MX_TIM2_Init(); |
| | | /* USER CODE BEGIN 2 */ |
| | | LED_LG_ON; |
| | | Program_Init(); |
| | | LIS3DH_Data_Init(); |
| | | BarInit(); |
| | | // BarInit(); |
| | | Dw1000_Init(); |
| | | Dw1000_App_Init(); |
| | | |
| | |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | |
| | | // HAL_Delay(2000); |
| | | // mcu_sleep(); |
| | | //LED0_BLINK; |
| | |
| | | } |
| | | |
| | | /** |
| | | * @brief TIM2 Initialization Function |
| | | * @param None |
| | | * @retval None |
| | | */ |
| | | static void MX_TIM2_Init(void) |
| | | { |
| | | |
| | | /* USER CODE BEGIN TIM2_Init 0 */ |
| | | |
| | | /* USER CODE END TIM2_Init 0 */ |
| | | |
| | | TIM_ClockConfigTypeDef sClockSourceConfig = {0}; |
| | | TIM_MasterConfigTypeDef sMasterConfig = {0}; |
| | | TIM_OC_InitTypeDef sConfigOC = {0}; |
| | | |
| | | /* USER CODE BEGIN TIM2_Init 1 */ |
| | | |
| | | /* USER CODE END TIM2_Init 1 */ |
| | | htim2.Instance = TIM2; |
| | | htim2.Init.Prescaler = 9; |
| | | htim2.Init.CounterMode = TIM_COUNTERMODE_UP; |
| | | htim2.Init.Period = 1171; |
| | | htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; |
| | | htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE; |
| | | if (HAL_TIM_Base_Init(&htim2) != HAL_OK) |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | sClockSourceConfig.ClockSource = TIM_CLOCKSOURCE_INTERNAL; |
| | | if (HAL_TIM_ConfigClockSource(&htim2, &sClockSourceConfig) != HAL_OK) |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | if (HAL_TIM_PWM_Init(&htim2) != HAL_OK) |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET; |
| | | sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE; |
| | | if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK) |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | sConfigOC.OCMode = TIM_OCMODE_PWM1; |
| | | sConfigOC.Pulse = 585; |
| | | sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH; |
| | | sConfigOC.OCFastMode = TIM_OCFAST_DISABLE; |
| | | if (HAL_TIM_PWM_ConfigChannel(&htim2, &sConfigOC, TIM_CHANNEL_3) != HAL_OK) |
| | | { |
| | | Error_Handler(); |
| | | } |
| | | /* USER CODE BEGIN TIM2_Init 2 */ |
| | | if(HAL_TIM_PWM_Start(&htim2, TIM_CHANNEL_3) != HAL_OK) |
| | | { |
| | | /* Starting Error */ |
| | | Error_Handler(); |
| | | } |
| | | /* USER CODE END TIM2_Init 2 */ |
| | | HAL_TIM_MspPostInit(&htim2); |
| | | |
| | | } |
| | | |
| | | /** |
| | | * @brief USART1 Initialization Function |
| | | * @param None |
| | | * @retval None |
| | |
| | | HAL_GPIO_WritePin(GPIOA, SCL_Pin|SDA_Pin|SPI_CS_Pin, GPIO_PIN_SET); |
| | | |
| | | /*Configure GPIO pin Output Level */ |
| | | HAL_GPIO_WritePin(GPIOB, BAT_MEAS_GND_Pin|MOTOR_Pin|PWR_CTL_Pin, GPIO_PIN_SET); |
| | | HAL_GPIO_WritePin(GPIOB, BAT_MEAS_GND_Pin|PWR_CTL_Pin, GPIO_PIN_SET); |
| | | |
| | | /*Configure GPIO pin Output Level */ |
| | | HAL_GPIO_WritePin(GPIOB, LED1_G_Pin|LED1_R_Pin|LED2_R_Pin, GPIO_PIN_RESET); |
| | |
| | | GPIO_InitStruct.Pull = GPIO_PULLUP; |
| | | HAL_GPIO_Init(USER_KEY_GPIO_Port, &GPIO_InitStruct); |
| | | |
| | | /*Configure GPIO pins : MOTOR_Pin LED1_G_Pin LED1_R_Pin LED2_R_Pin |
| | | PWR_CTL_Pin */ |
| | | GPIO_InitStruct.Pin = MOTOR_Pin|LED1_G_Pin|LED1_R_Pin|LED2_R_Pin |
| | | |PWR_CTL_Pin; |
| | | GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; |
| | | GPIO_InitStruct.Pull = GPIO_NOPULL; |
| | | GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; |
| | | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
| | | |
| | | /*Configure GPIO pin : INPUT_5V_Pin */ |
| | | GPIO_InitStruct.Pin = INPUT_5V_Pin; |
| | | GPIO_InitStruct.Mode = GPIO_MODE_INPUT; |
| | | GPIO_InitStruct.Pull = GPIO_PULLDOWN; |
| | | HAL_GPIO_Init(INPUT_5V_GPIO_Port, &GPIO_InitStruct); |
| | | |
| | | /*Configure GPIO pins : LED1_G_Pin LED1_R_Pin LED2_R_Pin PWR_CTL_Pin */ |
| | | GPIO_InitStruct.Pin = LED1_G_Pin|LED1_R_Pin|LED2_R_Pin|PWR_CTL_Pin; |
| | | GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; |
| | | GPIO_InitStruct.Pull = GPIO_NOPULL; |
| | | GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW; |
| | | HAL_GPIO_Init(GPIOB, &GPIO_InitStruct); |
| | | |
| | | /*Configure GPIO pins : DW_WKUP_Pin DW_CTRL_Pin LED2_G_Pin */ |
| | | GPIO_InitStruct.Pin = DW_WKUP_Pin|DW_CTRL_Pin|LED2_G_Pin; |
| | | GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; |