Guest User

Untitled

a guest
May 24th, 2021
81
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 12.43 KB | None | 0 0
  1. /* USER CODE BEGIN Header */
  2. /**
  3.   ******************************************************************************
  4.   * @file           : main.c
  5.   * @brief          : Main program body
  6.   ******************************************************************************
  7.   * @attention
  8.   *
  9.   * <h2><center>&copy; Copyright (c) 2021 STMicroelectronics.
  10.   * All rights reserved.</center></h2>
  11.   *
  12.   * This software component is licensed by ST under BSD 3-Clause license,
  13.   * the "License"; You may not use this file except in compliance with the
  14.   * License. You may obtain a copy of the License at:
  15.   *                        opensource.org/licenses/BSD-3-Clause
  16.   *
  17.   ******************************************************************************
  18.   */
  19. /* USER CODE END Header */
  20. /* Includes ------------------------------------------------------------------*/
  21. #include "main.h"
  22.  
  23. /* Private includes ----------------------------------------------------------*/
  24. /* USER CODE BEGIN Includes */
  25. #include "string.h"
  26. /* USER CODE END Includes */
  27.  
  28. /* Private typedef -----------------------------------------------------------*/
  29. /* USER CODE BEGIN PTD */
  30.  
  31. /* USER CODE END PTD */
  32.  
  33. /* Private define ------------------------------------------------------------*/
  34. /* USER CODE BEGIN PD */
  35. /* USER CODE END PD */
  36.  
  37. /* Private macro -------------------------------------------------------------*/
  38. /* USER CODE BEGIN PM */
  39.  
  40. /* USER CODE END PM */
  41.  
  42. /* Private variables ---------------------------------------------------------*/
  43. TIM_HandleTypeDef htim2;
  44. TIM_HandleTypeDef htim3;
  45. TIM_HandleTypeDef htim4;
  46.  
  47. UART_HandleTypeDef huart1;
  48.  
  49. /* USER CODE BEGIN PV */
  50. volatile uint8_t count1 = 0;
  51. volatile uint8_t count2 = 0;
  52. volatile uint8_t count3 = 0;
  53. float freq1  = 0;
  54. float freq2  = 0;
  55. float freq1_send  = 0;
  56. float freq2_send  = 0;
  57. volatile uint16_t count3_main_send = 0;
  58. /* USER CODE END PV */
  59.  
  60. /* Private function prototypes -----------------------------------------------*/
  61. void SystemClock_Config(void);
  62. static void MX_GPIO_Init(void);
  63. static void MX_USART1_UART_Init(void);
  64. static void MX_TIM2_Init(void);
  65. static void MX_TIM3_Init(void);
  66. static void MX_TIM4_Init(void);
  67. /* USER CODE BEGIN PFP */
  68.  
  69. /* USER CODE END PFP */
  70.  
  71. /* Private user code ---------------------------------------------------------*/
  72. /* USER CODE BEGIN 0 */
  73. void HAL_TIM_IC_CaptureCallback(TIM_HandleTypeDef *htim)
  74.  
  75. {
  76.     count3++;
  77.      if(count3 == 1)
  78.     {
  79.         __HAL_TIM_SET_COUNTER(&htim4, 0x0000);
  80.     }
  81.     if(count3 == 2)
  82.     {
  83.         HAL_TIM_Base_Stop_IT(&htim4);
  84.         uint16_t count3_main = HAL_TIM_ReadCapturedValue(&htim4);
  85.         HAL_TIM_Base_Start_IT(&htim4);
  86.         count3_main_send = count3_main;
  87.        
  88.     }
  89.  
  90.     if(htim == &htim3)
  91.     {
  92.         if(htim->Channel == HAL_TIM_ACTIVE_CHANNEL_2)
  93.         {
  94.             count1++;
  95.  
  96.             if(count1 == 1)
  97.             {
  98.                 __HAL_TIM_SET_COUNTER(&htim3, 0x0000);
  99.  
  100.             }
  101.  
  102.             else if(count1 == 2)
  103.             {
  104.                 HAL_TIM_IC_Stop_IT(&htim3, TIM_CHANNEL_2);
  105.  
  106.                 count1 = 0;
  107.  
  108.                 uint16_t count1_main = HAL_TIM_ReadCapturedValue(&htim3, TIM_CHANNEL_2);
  109.                 //uint16_t count3_main = HAL_TIM_ReadCapturedValue(&htim4, TIM_CHANNEL_1);
  110.  
  111.                 float freq1 = (1*1000000)/(0.5* count1_main);
  112.  
  113.  
  114.                 HAL_TIM_IC_Start_IT(&htim3, TIM_CHANNEL_2);
  115.                 //HAL_TIM_Base_Start_IT(&htim5);
  116.                 freq1_send = freq1;
  117.             }
  118.         }
  119.  
  120.     }
  121.  
  122.     if(htim == &htim2)
  123.     {
  124.         if(htim->Channel == HAL_TIM_ACTIVE_CHANNEL_2)
  125.         {
  126.             count2++;
  127.  
  128.             if(count2 == 1)
  129.             {
  130.                 __HAL_TIM_SET_COUNTER(&htim2, 0x0000);
  131.                 //__HAL_TIM_SET_COUNTER(&htim4, 0x0000);
  132.  
  133.             }
  134.  
  135.             else if(count2 == 2)
  136.             {
  137.                 HAL_TIM_IC_Stop_IT(&htim2, TIM_CHANNEL_2);
  138.  
  139.                 count2 = 0;
  140.  
  141.                 uint16_t count2_main = HAL_TIM_ReadCapturedValue(&htim2, TIM_CHANNEL_2);
  142.  
  143.                 float freq2 = (1*1000000)/(0.5* count2_main);
  144.  
  145.                 HAL_TIM_IC_Start_IT(&htim2, TIM_CHANNEL_2);
  146.                 freq2_send = freq2;
  147.                 //HAL_TIM_IC_Start_IT(&htim4, TIM_CHANNEL_1);
  148.                 //HAL_TIM_IC_Start_IT(&htim4, TIM_CHANNEL_2);
  149.  
  150.             }
  151.         }
  152.     }
  153. }
  154.  
  155. /* USER CODE END 0 */
  156.  
  157. /**
  158.   * @brief  The application entry point.
  159.   * @retval int
  160.   */
  161. int main(void)
  162. {
  163.   /* USER CODE BEGIN 1 */
  164.  
  165.   /* USER CODE END 1 */
  166.  
  167.   /* MCU Configuration--------------------------------------------------------*/
  168.  
  169.   /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  170.   HAL_Init();
  171.  
  172.   /* USER CODE BEGIN Init */
  173.  
  174.   /* USER CODE END Init */
  175.  
  176.   /* Configure the system clock */
  177.   SystemClock_Config();
  178.  
  179.   /* USER CODE BEGIN SysInit */
  180.  
  181.   /* USER CODE END SysInit */
  182.  
  183.   /* Initialize all configured peripherals */
  184.   MX_GPIO_Init();
  185.   MX_USART1_UART_Init();
  186.   MX_TIM2_Init();
  187.   MX_TIM3_Init();
  188.   MX_TIM4_Init();
  189.   /* USER CODE BEGIN 2 */
  190.  HAL_TIM_IC_Start_IT(&htim2, TIM_CHANNEL_2);
  191.  HAL_TIM_IC_Start_IT(&htim3, TIM_CHANNEL_2);
  192.  //HAL_TIM_Base_Start_IT(&htim5);
  193.  //HAL_TIM_IC_Start_IT(&htim5, TIM_CHANNEL_1);
  194. HAL_TIM_Base_Start_IT(&htim4);
  195.   /* USER CODE END 2 */
  196.  
  197.   /* Infinite loop */
  198.   /* USER CODE BEGIN WHILE */
  199.  
  200.   while (1)
  201.   {
  202.  
  203.     /* USER CODE END WHILE */
  204.  
  205.     /* USER CODE BEGIN 3 */
  206.  
  207.       char str[120] = {0,};
  208.       snprintf(str, 120, "Capture Freq1: %.3f Hz | Freq2: %.3f Hz | cm: %d\n", (float)freq1_send,(float)freq2_send, count3_main_send);
  209.       //snprintf(str, 96, "Capture Freq: %.3f Hz\n", (float)freq);
  210.       HAL_UART_Transmit(&huart1, (uint8_t*)str, strlen(str), 100);
  211.  
  212.  
  213.   /* USER CODE END 3 */
  214. }
  215. }
  216.  
  217. /**
  218.   * @brief System Clock Configuration
  219.   * @retval None
  220.   */
  221. void SystemClock_Config(void)
  222. {
  223.   RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  224.   RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
  225.  
  226.   /** Configure the main internal regulator output voltage
  227.   */
  228.   __HAL_RCC_PWR_CLK_ENABLE();
  229.   __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE3);
  230.   /** Initializes the RCC Oscillators according to the specified parameters
  231.   * in the RCC_OscInitTypeDef structure.
  232.   */
  233.   RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
  234.   RCC_OscInitStruct.HSIState = RCC_HSI_ON;
  235.   RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
  236.   RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;
  237.   if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  238.   {
  239.     Error_Handler();
  240.   }
  241.   /** Initializes the CPU, AHB and APB buses clocks
  242.   */
  243.   RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
  244.                               |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  245.   RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_HSI;
  246.   RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  247.   RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV16;
  248.   RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV16;
  249.  
  250.   if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_0) != HAL_OK)
  251.   {
  252.     Error_Handler();
  253.   }
  254. }
  255.  
  256. /**
  257.   * @brief TIM2 Initialization Function
  258.   * @param None
  259.   * @retval None
  260.   */
  261. static void MX_TIM2_Init(void)
  262. {
  263.  
  264.   /* USER CODE BEGIN TIM2_Init 0 */
  265.  
  266.   /* USER CODE END TIM2_Init 0 */
  267.  
  268.   TIM_MasterConfigTypeDef sMasterConfig = {0};
  269.   TIM_IC_InitTypeDef sConfigIC = {0};
  270.  
  271.   /* USER CODE BEGIN TIM2_Init 1 */
  272.  
  273.   /* USER CODE END TIM2_Init 1 */
  274.   htim2.Instance = TIM2;
  275.   htim2.Init.Prescaler = 0;
  276.   htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
  277.   htim2.Init.Period = 4294967295;
  278.   htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  279.   htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  280.   if (HAL_TIM_IC_Init(&htim2) != HAL_OK)
  281.   {
  282.     Error_Handler();
  283.   }
  284.   sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  285.   sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  286.   if (HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig) != HAL_OK)
  287.   {
  288.     Error_Handler();
  289.   }
  290.   sConfigIC.ICPolarity = TIM_INPUTCHANNELPOLARITY_RISING;
  291.   sConfigIC.ICSelection = TIM_ICSELECTION_DIRECTTI;
  292.   sConfigIC.ICPrescaler = TIM_ICPSC_DIV1;
  293.   sConfigIC.ICFilter = 0;
  294.   if (HAL_TIM_IC_ConfigChannel(&htim2, &sConfigIC, TIM_CHANNEL_2) != HAL_OK)
  295.   {
  296.     Error_Handler();
  297.   }
  298.   /* USER CODE BEGIN TIM2_Init 2 */
  299.  
  300.   /* USER CODE END TIM2_Init 2 */
  301.  
  302. }
  303.  
  304. /**
  305.   * @brief TIM3 Initialization Function
  306.   * @param None
  307.   * @retval None
  308.   */
  309. static void MX_TIM3_Init(void)
  310. {
  311.  
  312.   /* USER CODE BEGIN TIM3_Init 0 */
  313.  
  314.   /* USER CODE END TIM3_Init 0 */
  315.  
  316.   TIM_MasterConfigTypeDef sMasterConfig = {0};
  317.   TIM_IC_InitTypeDef sConfigIC = {0};
  318.  
  319.   /* USER CODE BEGIN TIM3_Init 1 */
  320.  
  321.   /* USER CODE END TIM3_Init 1 */
  322.   htim3.Instance = TIM3;
  323.   htim3.Init.Prescaler = 0;
  324.   htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
  325.   htim3.Init.Period = 65535;
  326.   htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  327.   htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  328.   if (HAL_TIM_IC_Init(&htim3) != HAL_OK)
  329.   {
  330.     Error_Handler();
  331.   }
  332.   sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  333.   sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  334.   if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
  335.   {
  336.     Error_Handler();
  337.   }
  338.   sConfigIC.ICPolarity = TIM_INPUTCHANNELPOLARITY_RISING;
  339.   sConfigIC.ICSelection = TIM_ICSELECTION_DIRECTTI;
  340.   sConfigIC.ICPrescaler = TIM_ICPSC_DIV1;
  341.   sConfigIC.ICFilter = 0;
  342.   if (HAL_TIM_IC_ConfigChannel(&htim3, &sConfigIC, TIM_CHANNEL_2) != HAL_OK)
  343.   {
  344.     Error_Handler();
  345.   }
  346.   /* USER CODE BEGIN TIM3_Init 2 */
  347.  
  348.   /* USER CODE END TIM3_Init 2 */
  349.  
  350. }
  351.  
  352. /**
  353.   * @brief TIM4 Initialization Function
  354.   * @param None
  355.   * @retval None
  356.   */
  357. static void MX_TIM4_Init(void)
  358. {
  359.  
  360.   /* USER CODE BEGIN TIM4_Init 0 */
  361.  
  362.   /* USER CODE END TIM4_Init 0 */
  363.  
  364.   TIM_MasterConfigTypeDef sMasterConfig = {0};
  365.   TIM_IC_InitTypeDef sConfigIC = {0};
  366.  
  367.   /* USER CODE BEGIN TIM4_Init 1 */
  368.  
  369.   /* USER CODE END TIM4_Init 1 */
  370.   htim4.Instance = TIM4;
  371.   htim4.Init.Prescaler = 0;
  372.   htim4.Init.CounterMode = TIM_COUNTERMODE_UP;
  373.   htim4.Init.Period = 65535;
  374.   htim4.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  375.   htim4.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  376.   if (HAL_TIM_IC_Init(&htim4) != HAL_OK)
  377.   {
  378.     Error_Handler();
  379.   }
  380.   sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  381.   sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  382.   if (HAL_TIMEx_MasterConfigSynchronization(&htim4, &sMasterConfig) != HAL_OK)
  383.   {
  384.     Error_Handler();
  385.   }
  386.   sConfigIC.ICPolarity = TIM_INPUTCHANNELPOLARITY_RISING;
  387.   sConfigIC.ICSelection = TIM_ICSELECTION_DIRECTTI;
  388.   sConfigIC.ICPrescaler = TIM_ICPSC_DIV1;
  389.   sConfigIC.ICFilter = 0;
  390.   if (HAL_TIM_IC_ConfigChannel(&htim4, &sConfigIC, TIM_CHANNEL_2) != HAL_OK)
  391.   {
  392.     Error_Handler();
  393.   }
  394.   /* USER CODE BEGIN TIM4_Init 2 */
  395.  
  396.   /* USER CODE END TIM4_Init 2 */
  397.  
  398. }
  399.  
  400. /**
  401.   * @brief USART1 Initialization Function
  402.   * @param None
  403.   * @retval None
  404.   */
  405. static void MX_USART1_UART_Init(void)
  406. {
  407.  
  408.   /* USER CODE BEGIN USART1_Init 0 */
  409.  
  410.   /* USER CODE END USART1_Init 0 */
  411.  
  412.   /* USER CODE BEGIN USART1_Init 1 */
  413.  
  414.   /* USER CODE END USART1_Init 1 */
  415.   huart1.Instance = USART1;
  416.   huart1.Init.BaudRate = 9600;
  417.   huart1.Init.WordLength = UART_WORDLENGTH_8B;
  418.   huart1.Init.StopBits = UART_STOPBITS_1;
  419.   huart1.Init.Parity = UART_PARITY_NONE;
  420.   huart1.Init.Mode = UART_MODE_TX_RX;
  421.   huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
  422.   huart1.Init.OverSampling = UART_OVERSAMPLING_16;
  423.   if (HAL_UART_Init(&huart1) != HAL_OK)
  424.   {
  425.     Error_Handler();
  426.   }
  427.   /* USER CODE BEGIN USART1_Init 2 */
  428.  
  429.   /* USER CODE END USART1_Init 2 */
  430.  
  431. }
  432.  
  433. /**
  434.   * @brief GPIO Initialization Function
  435.   * @param None
  436.   * @retval None
  437.   */
  438. static void MX_GPIO_Init(void)
  439. {
  440.  
  441.   /* GPIO Ports Clock Enable */
  442.   __HAL_RCC_GPIOA_CLK_ENABLE();
  443.   __HAL_RCC_GPIOB_CLK_ENABLE();
  444.  
  445. }
  446.  
  447. /* USER CODE BEGIN 4 */
  448.  
  449. /* USER CODE END 4 */
  450.  
  451. /**
  452.   * @brief  This function is executed in case of error occurrence.
  453.   * @retval None
  454.   */
  455. void Error_Handler(void)
  456. {
  457.   /* USER CODE BEGIN Error_Handler_Debug */
  458.   /* User can add his own implementation to report the HAL error return state */
  459.   __disable_irq();
  460.   while (1)
  461.   {
  462.   }
  463.   /* USER CODE END Error_Handler_Debug */
  464. }
  465.  
  466. #ifdef  USE_FULL_ASSERT
  467. /**
  468.   * @brief  Reports the name of the source file and the source line number
  469.   *         where the assert_param error has occurred.
  470.   * @param  file: pointer to the source file name
  471.   * @param  line: assert_param error line source number
  472.   * @retval None
  473.   */
  474. void assert_failed(uint8_t *file, uint32_t line)
  475. {
  476.   /* USER CODE BEGIN 6 */
  477.   /* User can add his own implementation to report the file name and line number,
  478.      ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
  479.   /* USER CODE END 6 */
  480. }
  481. #endif /* USE_FULL_ASSERT */
  482.  
  483. /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
  484.  
Advertisement
Add Comment
Please, Sign In to add comment