main.cpp 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151
  1. #include "stm32g4xx_hal.h"
  2. #include "cmsis_os.h"
  3. #include "terminal_user.h"
  4. #include "terminal_usartbridge.h"
  5. #include "control.h"
  6. #include "oled_common.h"
  7. #include "settings.h"
  8. #include "uart_bridge.h"
  9. #include "menu.h"
  10. #include <stdio.h>
  11. void SystemClock_Config(void);
  12. void Error_Handler(void);
  13. static void MX_GPIO_Init(void);
  14. void StartupTask(void const *params);
  15. osThreadId startupTaskHandle;
  16. int main()
  17. {
  18. HAL_Init();
  19. SystemClock_Config();
  20. osThreadDef(Startup, StartupTask, osPriorityNormal, 0, 2*128);
  21. startupTaskHandle = osThreadCreate(osThread(Startup), NULL);
  22. osKernelStart();
  23. return 0;
  24. }
  25. //
  26. void StartupTask(void const *argument)
  27. {
  28. MX_GPIO_Init();
  29. // Терминал
  30. sbsTerminal.configure();
  31. // USART терминал
  32. terminalUsartBridge.configure();
  33. // Настройки
  34. settings_crc_init();
  35. #if 0
  36. settings_set_def();
  37. settings_save();
  38. #endif
  39. settings_load();
  40. //
  41. init_encoder();
  42. // Порт для связи с роботом и обработка данных
  43. ub_init_os();
  44. init_usart();
  45. // Дисплей
  46. init_oled();
  47. // Меню
  48. menu_init();
  49. #if 0
  50. for (;;) {
  51. HAL_GPIO_TogglePin(GPIOC, GPIO_PIN_6);
  52. osDelay(200);
  53. printf("hello world\r\n");
  54. }
  55. #endif
  56. vTaskDelete(NULL);
  57. }
  58. //
  59. static void MX_GPIO_Init(void)
  60. {
  61. GPIO_InitTypeDef GPIO_InitStruct = {0};
  62. /* GPIO Ports Clock Enable */
  63. __HAL_RCC_GPIOC_CLK_ENABLE();
  64. __HAL_RCC_GPIOF_CLK_ENABLE();
  65. __HAL_RCC_GPIOA_CLK_ENABLE();
  66. /*Configure GPIO pin Output Level */
  67. HAL_GPIO_WritePin(GPIOC, GPIO_PIN_6, GPIO_PIN_RESET);
  68. /*Configure GPIO pin : PC13 */
  69. GPIO_InitStruct.Pin = GPIO_PIN_13;
  70. GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  71. GPIO_InitStruct.Pull = GPIO_NOPULL;
  72. HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
  73. /*Configure GPIO pin : PC6 */
  74. GPIO_InitStruct.Pin = GPIO_PIN_6;
  75. GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  76. GPIO_InitStruct.Pull = GPIO_NOPULL;
  77. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  78. HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
  79. }
  80. //
  81. void SystemClock_Config(void)
  82. {
  83. RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  84. RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
  85. HAL_PWREx_ControlVoltageScaling(PWR_REGULATOR_VOLTAGE_SCALE1_BOOST);
  86. HAL_PWR_EnableBkUpAccess();
  87. __HAL_RCC_LSEDRIVE_CONFIG(RCC_LSEDRIVE_LOW);
  88. RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI48|RCC_OSCILLATORTYPE_HSE
  89. |RCC_OSCILLATORTYPE_LSE;
  90. RCC_OscInitStruct.HSEState = RCC_HSE_ON;
  91. RCC_OscInitStruct.LSEState = RCC_LSE_ON;
  92. RCC_OscInitStruct.HSI48State = RCC_HSI48_ON;
  93. RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
  94. RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
  95. RCC_OscInitStruct.PLL.PLLM = RCC_PLLM_DIV2;
  96. RCC_OscInitStruct.PLL.PLLN = 85;
  97. RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
  98. RCC_OscInitStruct.PLL.PLLQ = RCC_PLLQ_DIV2;
  99. RCC_OscInitStruct.PLL.PLLR = RCC_PLLR_DIV2;
  100. if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  101. {
  102. Error_Handler();
  103. }
  104. RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
  105. |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  106. RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
  107. RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  108. RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;
  109. RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
  110. if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_4) != HAL_OK)
  111. {
  112. Error_Handler();
  113. }
  114. }
  115. //
  116. void Error_Handler(void)
  117. {
  118. __disable_irq();
  119. while (1) {}
  120. }