control.cpp 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105
  1. #include "control.h"
  2. #include "stm32g4xx_hal.h"
  3. #include "cmsis_os.h"
  4. //#include "menu.h"
  5. //#include "buzzer.h"
  6. #include <stdio.h>
  7. #define BEEP_TIME 1000
  8. //SemaphoreHandle_t semphEncoder;
  9. bool encInit = false;
  10. bool encDir = false;
  11. TIM_HandleTypeDef htim2;
  12. //
  13. void init_encoder(void)
  14. {
  15. TIM_Encoder_InitTypeDef sConfig = {0};
  16. TIM_MasterConfigTypeDef sMasterConfig = {0};
  17. __HAL_RCC_TIM2_CLK_ENABLE();
  18. init_gpio_encoder();
  19. htim2.Instance = TIM2;
  20. htim2.Init.Prescaler = 0;
  21. htim2.Init.CounterMode = TIM_COUNTERMODE_UP;
  22. htim2.Init.Period = 65535;
  23. htim2.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  24. htim2.Init.RepetitionCounter = 0;
  25. htim2.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  26. sConfig.EncoderMode = TIM_ENCODERMODE_TI12; //TIM_ENCODERMODE_TI12;
  27. sConfig.IC1Polarity = TIM_ICPOLARITY_RISING;
  28. sConfig.IC1Selection = TIM_ICSELECTION_DIRECTTI;
  29. sConfig.IC1Prescaler = TIM_ICPSC_DIV1;
  30. sConfig.IC1Filter = 0; //100;
  31. sConfig.IC2Polarity = TIM_ICPOLARITY_RISING;
  32. sConfig.IC2Selection = TIM_ICSELECTION_DIRECTTI;
  33. sConfig.IC2Prescaler = TIM_ICPSC_DIV1;
  34. sConfig.IC2Filter = 0; //100;
  35. HAL_TIM_Encoder_Init(&htim2, &sConfig);
  36. sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  37. sMasterConfig.MasterOutputTrigger2 = TIM_TRGO2_RESET;
  38. sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  39. HAL_TIMEx_MasterConfigSynchronization(&htim2, &sMasterConfig);
  40. HAL_NVIC_SetPriority(TIM2_IRQn, 6, 0);
  41. HAL_NVIC_EnableIRQ(TIM2_IRQn);
  42. HAL_TIM_Encoder_Start_IT(&htim2, TIM_CHANNEL_1);
  43. //HAL_TIM_Encoder_Start_IT(&htim2, TIM_CHANNEL_ALL);
  44. }
  45. //
  46. void init_gpio_encoder(void)
  47. {
  48. GPIO_InitTypeDef GPIO_InitStruct = {0};
  49. __HAL_RCC_GPIOA_CLK_ENABLE();
  50. __HAL_RCC_GPIOB_CLK_ENABLE();
  51. GPIO_InitStruct.Pin = GPIO_PIN_0;
  52. GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
  53. GPIO_InitStruct.Pull = GPIO_PULLUP;
  54. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
  55. GPIO_InitStruct.Alternate = GPIO_AF1_TIM2;
  56. HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
  57. GPIO_InitStruct.Pin = GPIO_PIN_3;
  58. HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
  59. // Кнопка энкодера
  60. GPIO_InitStruct.Pin = GPIO_PIN_4;
  61. GPIO_InitStruct.Mode = GPIO_MODE_IT_FALLING;
  62. GPIO_InitStruct.Pull = GPIO_PULLUP;
  63. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
  64. HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
  65. HAL_NVIC_SetPriority(EXTI4_IRQn, 6, 0);
  66. HAL_NVIC_EnableIRQ(EXTI4_IRQn);
  67. }
  68. extern "C" {
  69. void TIM2_IRQHandler(void)
  70. {
  71. HAL_TIM_IRQHandler(&htim2);
  72. }
  73. void EXTI4_IRQHandler(void)
  74. {
  75. HAL_GPIO_EXTI_IRQHandler(GPIO_PIN_4);
  76. }
  77. }