initial commitHEADmaster

1 files changed, 707 insertions, 0 deletions

diff --git a/Core/Src/main.c b/Core/Src/main.c
new file mode 100644
index 0000000..bc7e67c
--- /dev/null
+++ b/Core/Src/main.c
@@ -0,0 +1,707 @@
+/* USER CODE BEGIN Header */

+/**

+  ******************************************************************************

+  * @file           : main.c

+  * @brief          : Main program body

+  ******************************************************************************

+  * @attention

+  *

+  * Copyright (c) 2023 STMicroelectronics.

+  * All rights reserved.

+  *

+  * This software is licensed under terms that can be found in the LICENSE file

+  * in the root directory of this software component.

+  * If no LICENSE file comes with this software, it is provided AS-IS.

+  *

+  ******************************************************************************

+  */

+/* USER CODE END Header */

+/* Includes ------------------------------------------------------------------*/

+#include "main.h"

+

+/* Private includes ----------------------------------------------------------*/

+/* USER CODE BEGIN Includes */

+#include "AD9851.h"

+#include "Si5351A-RevB-Registers.h"

+/* USER CODE END Includes */

+

+/* Private typedef -----------------------------------------------------------*/

+/* USER CODE BEGIN PTD */

+

+/* USER CODE END PTD */

+

+/* Private define ------------------------------------------------------------*/

+/* USER CODE BEGIN PD */

+#define NS 1000

+#define FULL_BUF_SIZE 256

+#define HALF_BUF_SIZE FULL_BUF_SIZE / 2

+/* USER CODE END PD */

+

+/* Private macro -------------------------------------------------------------*/

+/* USER CODE BEGIN PM */

+

+/* USER CODE END PM */

+

+/* Private variables ---------------------------------------------------------*/

+ADC_HandleTypeDef hadc1;

+ADC_HandleTypeDef hadc2;

+DMA_HandleTypeDef hdma_adc1;

+DMA_HandleTypeDef hdma_adc2;

+

+DAC_HandleTypeDef hdac1;

+DMA_HandleTypeDef hdma_dac1_ch2;

+

+I2C_HandleTypeDef hi2c1;

+

+UART_HandleTypeDef huart1;

+

+/* USER CODE BEGIN PV */

+volatile uint32_t adc_val[FULL_BUF_SIZE];

+volatile uint32_t dac_val[FULL_BUF_SIZE];

+

+uint32_t* in_buf_ptr;

+uint32_t* out_buf_ptr;

+uint32_t out_out_ptr = 0;

+

+int flag = 0;

+

+/* FIR filter designed with

+http://t-filter.appspot.com

+

+sampling frequency: 200000 Hz

+

+* 0 Hz - 16000 Hz

+  gain = 1

+  desired ripple = 5 dB

+  actual ripple = 0 dB

+

+*/

+

+#define FILTER_TAP_NUM 5

+

+static double filter_taps[FILTER_TAP_NUM] = {

+  -4.4408920985006264e-17,

+  4.4408920985006264e-17,

+  1,

+  4.4408920985006264e-17,

+  -4.4408920985006264e-17

+};

+

+float afilter_taps[FILTER_TAP_NUM];

+

+/* USER CODE END PV */

+

+/* Private function prototypes -----------------------------------------------*/

+void SystemClock_Config(void);

+void PeriphCommonClock_Config(void);

+static void MX_GPIO_Init(void);

+static void MX_DMA_Init(void);

+static void MX_ADC2_Init(void);

+static void MX_DAC1_Init(void);

+static void MX_I2C1_Init(void);

+static void MX_ADC1_Init(void);

+static void MX_USART1_UART_Init(void);

+/* USER CODE BEGIN PFP */

+

+/* USER CODE END PFP */

+

+/* Private user code ---------------------------------------------------------*/

+/* USER CODE BEGIN 0 */

+uint32_t fir(uint32_t in);

+

+void HAL_ADC_ConvHalfCpltCallback(ADC_HandleTypeDef* hadc) {

+  //first half of adc buffer is full

+  in_buf_ptr = &adc_val[0];

+  out_buf_ptr = &dac_val[HALF_BUF_SIZE];// + HALF_BUF_SIZE;

+

+  for (int i=0;i<HALF_BUF_SIZE;i++) {

+    uint32_t test = fir(in_buf_ptr[i]);

+    out_buf_ptr[i] = test;

+  }

+

+  flag=1;

+}

+

+void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef* hadc) {

+  //second half of adc buffer is full

+  in_buf_ptr = &adc_val[HALF_BUF_SIZE];// + HALF_BUF_SIZE;

+  out_buf_ptr = &dac_val[0];

+  

+  for (int i=0;i<HALF_BUF_SIZE;i++) {

+    uint32_t test = fir(in_buf_ptr[i]);

+    out_buf_ptr[i] = test;

+  }

+

+  flag=1;

+}

+

+float ema_alpha = 0.1f;

+float ema_out = 0;

+void ema_lpf(float in) {

+  ema_out = ema_alpha * in + (1.0f - ema_alpha) * ema_out;

+}

+

+float firdata[FILTER_TAP_NUM];

+int firptr[FILTER_TAP_NUM];

+int fir_w_ptr = 0;

+

+uint32_t fir(uint32_t in) {

+  float in_f = (float)((int)in-2048);

+  float fir_out = 0;

+  for (int i=0;i<FILTER_TAP_NUM;i++) {

+    fir_out += afilter_taps[firptr[i]] * firdata[i];

+    firptr[i]++;

+  }

+  firdata[fir_w_ptr] = in_f;

+  firptr[fir_w_ptr] = 0;

+  fir_w_ptr++;

+  if (fir_w_ptr == FILTER_TAP_NUM) fir_w_ptr = 0;

+

+  return (uint32_t) (fir_out+2048);

+}

+

+void process_data() {

+  for (int i=0;i<1;i++) {

+    float in = ((float) in_buf_ptr[i]);

+    ema_lpf(in);

+    out_buf_ptr[i] = (uint32_t)(ema_out);

+  }

+}

+

+/* USER CODE END 0 */

+

+/**

+  * @brief  The application entry point.

+  * @retval int

+  */

+int main(void)

+{

+  /* USER CODE BEGIN 1 */

+

+  /* USER CODE END 1 */

+

+  /* MCU Configuration--------------------------------------------------------*/

+

+  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */

+  HAL_Init();

+

+  /* USER CODE BEGIN Init */

+

+  /* USER CODE END Init */

+

+  /* Configure the system clock */

+  SystemClock_Config();

+

+/* Configure the peripherals common clocks */

+  PeriphCommonClock_Config();

+

+  /* USER CODE BEGIN SysInit */

+

+  /* USER CODE END SysInit */

+

+  /* Initialize all configured peripherals */

+  MX_GPIO_Init();

+  MX_DMA_Init();

+  MX_ADC2_Init();

+  MX_DAC1_Init();

+  MX_I2C1_Init();

+  MX_ADC1_Init();

+  MX_USART1_UART_Init();

+  /* USER CODE BEGIN 2 */

+  HAL_ADC_Start_DMA(&hadc1, (uint32_t*) adc_val, FULL_BUF_SIZE);

+  HAL_DAC_Start_DMA(&hdac1, DAC_CHANNEL_1, (uint32_t*) dac_val, FULL_BUF_SIZE, DAC_ALIGN_12B_R);

+

+  float maxfir = 0;

+

+  for (int i=0;i<FILTER_TAP_NUM;i++) {

+    if (filter_taps[i] < 0) maxfir -= filter_taps[i];

+    else maxfir += filter_taps[i];

+  }

+

+  for (int i=0;i<FILTER_TAP_NUM;i++) {

+    afilter_taps[i] = filter_taps[i] / maxfir;

+  }

+

+  uint8_t i2c_buf[2];

+  for (int i=0;i<SI5351A_REVB_REG_CONFIG_NUM_REGS;i++) {

+    i2c_buf[0] = si5351a_revb_registers[i].address;

+    i2c_buf[1] = si5351a_revb_registers[i].value;

+    HAL_I2C_Master_Transmit(&hi2c1, 0x60 << 1, i2c_buf, 2, 1000);

+    HAL_Delay(50);

+  }

+  AD9851_reset();

+  

+  HAL_Delay(50);

+  AD9851_parallel(32881);

+

+

+

+  /* USER CODE END 2 */

+

+  /* Infinite loop */

+  /* USER CODE BEGIN WHILE */

+  while (1)

+  {

+    /* USER CODE END WHILE */

+

+    /* USER CODE BEGIN 3 */

+  }

+  /* USER CODE END 3 */

+}

+

+/**

+  * @brief System Clock Configuration

+  * @retval None

+  */

+void SystemClock_Config(void)

+{

+  RCC_OscInitTypeDef RCC_OscInitStruct = {0};

+  RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

+

+  /** Supply configuration update enable

+  */

+  HAL_PWREx_ConfigSupply(PWR_LDO_SUPPLY);

+

+  /** Configure the main internal regulator output voltage

+  */

+  __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);

+

+  while(!__HAL_PWR_GET_FLAG(PWR_FLAG_VOSRDY)) {}

+

+  /** Macro to configure the PLL clock source

+  */

+  __HAL_RCC_PLL_PLLSOURCE_CONFIG(RCC_PLLSOURCE_HSI);

+

+  /** Initializes the RCC Oscillators according to the specified parameters

+  * in the RCC_OscInitTypeDef structure.

+  */

+  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;

+  RCC_OscInitStruct.HSIState = RCC_HSI_DIV1;

+  RCC_OscInitStruct.HSICalibrationValue = 64;

+  RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;

+  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)

+  {

+    Error_Handler();

+  }

+

+  /** Initializes the CPU, AHB and APB buses clocks

+  */

+  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK

+                              |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2

+                              |RCC_CLOCKTYPE_D3PCLK1|RCC_CLOCKTYPE_D1PCLK1;

+  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_HSI;

+  RCC_ClkInitStruct.SYSCLKDivider = RCC_SYSCLK_DIV1;

+  RCC_ClkInitStruct.AHBCLKDivider = RCC_HCLK_DIV1;

+  RCC_ClkInitStruct.APB3CLKDivider = RCC_APB3_DIV2;

+  RCC_ClkInitStruct.APB1CLKDivider = RCC_APB1_DIV4;

+  RCC_ClkInitStruct.APB2CLKDivider = RCC_APB2_DIV4;

+  RCC_ClkInitStruct.APB4CLKDivider = RCC_APB4_DIV2;

+

+  if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_0) != HAL_OK)

+  {

+    Error_Handler();

+  }

+}

+

+/**

+  * @brief Peripherals Common Clock Configuration

+  * @retval None

+  */

+void PeriphCommonClock_Config(void)

+{

+  RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0};

+

+  /** Initializes the peripherals clock

+  */

+  PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_ADC;

+  PeriphClkInitStruct.PLL2.PLL2M = 4;

+  PeriphClkInitStruct.PLL2.PLL2N = 12;

+  PeriphClkInitStruct.PLL2.PLL2P = 4;

+  PeriphClkInitStruct.PLL2.PLL2Q = 2;

+  PeriphClkInitStruct.PLL2.PLL2R = 2;

+  PeriphClkInitStruct.PLL2.PLL2RGE = RCC_PLL2VCIRANGE_3;

+  PeriphClkInitStruct.PLL2.PLL2VCOSEL = RCC_PLL2VCOWIDE;

+  PeriphClkInitStruct.PLL2.PLL2FRACN = 0;

+  PeriphClkInitStruct.AdcClockSelection = RCC_ADCCLKSOURCE_PLL2;

+  if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct) != HAL_OK)

+  {

+    Error_Handler();

+  }

+}

+

+/**

+  * @brief ADC1 Initialization Function

+  * @param None

+  * @retval None

+  */

+static void MX_ADC1_Init(void)

+{

+

+  /* USER CODE BEGIN ADC1_Init 0 */

+

+  /* USER CODE END ADC1_Init 0 */

+

+  ADC_MultiModeTypeDef multimode = {0};

+  ADC_ChannelConfTypeDef sConfig = {0};

+

+  /* USER CODE BEGIN ADC1_Init 1 */

+

+  /* USER CODE END ADC1_Init 1 */

+

+  /** Common config

+  */

+  hadc1.Instance = ADC1;

+  hadc1.Init.ClockPrescaler = ADC_CLOCK_ASYNC_DIV4;

+  hadc1.Init.Resolution = ADC_RESOLUTION_16B;

+  hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;

+  hadc1.Init.EOCSelection = ADC_EOC_SINGLE_CONV;

+  hadc1.Init.LowPowerAutoWait = DISABLE;

+  hadc1.Init.ContinuousConvMode = DISABLE;

+  hadc1.Init.NbrOfConversion = 1;

+  hadc1.Init.DiscontinuousConvMode = DISABLE;

+  hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;

+  hadc1.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;

+  hadc1.Init.ConversionDataManagement = ADC_CONVERSIONDATA_DR;

+  hadc1.Init.Overrun = ADC_OVR_DATA_PRESERVED;

+  hadc1.Init.LeftBitShift = ADC_LEFTBITSHIFT_NONE;

+  hadc1.Init.OversamplingMode = DISABLE;

+  if (HAL_ADC_Init(&hadc1) != HAL_OK)

+  {

+    Error_Handler();

+  }

+

+  /** Configure the ADC multi-mode

+  */

+  multimode.Mode = ADC_MODE_INDEPENDENT;

+  if (HAL_ADCEx_MultiModeConfigChannel(&hadc1, &multimode) != HAL_OK)

+  {

+    Error_Handler();

+  }

+

+  /** Configure Regular Channel

+  */

+  sConfig.Channel = ADC_CHANNEL_3;

+  sConfig.Rank = ADC_REGULAR_RANK_1;

+  sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;

+  sConfig.SingleDiff = ADC_SINGLE_ENDED;

+  sConfig.OffsetNumber = ADC_OFFSET_NONE;

+  sConfig.Offset = 0;

+  sConfig.OffsetSignedSaturation = DISABLE;

+  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  /* USER CODE BEGIN ADC1_Init 2 */

+

+  /* USER CODE END ADC1_Init 2 */

+

+}

+

+/**

+  * @brief ADC2 Initialization Function

+  * @param None

+  * @retval None

+  */

+static void MX_ADC2_Init(void)

+{

+

+  /* USER CODE BEGIN ADC2_Init 0 */

+

+  /* USER CODE END ADC2_Init 0 */

+

+  ADC_ChannelConfTypeDef sConfig = {0};

+

+  /* USER CODE BEGIN ADC2_Init 1 */

+

+  /* USER CODE END ADC2_Init 1 */

+

+  /** Common config

+  */

+  hadc2.Instance = ADC2;

+  hadc2.Init.ClockPrescaler = ADC_CLOCK_ASYNC_DIV4;

+  hadc2.Init.Resolution = ADC_RESOLUTION_16B;

+  hadc2.Init.ScanConvMode = ADC_SCAN_DISABLE;

+  hadc2.Init.EOCSelection = ADC_EOC_SINGLE_CONV;

+  hadc2.Init.LowPowerAutoWait = DISABLE;

+  hadc2.Init.ContinuousConvMode = DISABLE;

+  hadc2.Init.NbrOfConversion = 1;

+  hadc2.Init.DiscontinuousConvMode = DISABLE;

+  hadc2.Init.ExternalTrigConv = ADC_SOFTWARE_START;

+  hadc2.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;

+  hadc2.Init.ConversionDataManagement = ADC_CONVERSIONDATA_DR;

+  hadc2.Init.Overrun = ADC_OVR_DATA_PRESERVED;

+  hadc2.Init.LeftBitShift = ADC_LEFTBITSHIFT_NONE;

+  hadc2.Init.OversamplingMode = DISABLE;

+  if (HAL_ADC_Init(&hadc2) != HAL_OK)

+  {

+    Error_Handler();

+  }

+

+  /** Configure Regular Channel

+  */

+  sConfig.Channel = ADC_CHANNEL_4;

+  sConfig.Rank = ADC_REGULAR_RANK_1;

+  sConfig.SamplingTime = ADC_SAMPLETIME_1CYCLE_5;

+  sConfig.SingleDiff = ADC_SINGLE_ENDED;

+  sConfig.OffsetNumber = ADC_OFFSET_NONE;

+  sConfig.Offset = 0;

+  sConfig.OffsetSignedSaturation = DISABLE;

+  if (HAL_ADC_ConfigChannel(&hadc2, &sConfig) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  /* USER CODE BEGIN ADC2_Init 2 */

+

+  /* USER CODE END ADC2_Init 2 */

+

+}

+

+/**

+  * @brief DAC1 Initialization Function

+  * @param None

+  * @retval None

+  */

+static void MX_DAC1_Init(void)

+{

+

+  /* USER CODE BEGIN DAC1_Init 0 */

+

+  /* USER CODE END DAC1_Init 0 */

+

+  DAC_ChannelConfTypeDef sConfig = {0};

+

+  /* USER CODE BEGIN DAC1_Init 1 */

+

+  /* USER CODE END DAC1_Init 1 */

+

+  /** DAC Initialization

+  */

+  hdac1.Instance = DAC1;

+  if (HAL_DAC_Init(&hdac1) != HAL_OK)

+  {

+    Error_Handler();

+  }

+

+  /** DAC channel OUT2 config

+  */

+  sConfig.DAC_SampleAndHold = DAC_SAMPLEANDHOLD_DISABLE;

+  sConfig.DAC_Trigger = DAC_TRIGGER_NONE;

+  sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;

+  sConfig.DAC_ConnectOnChipPeripheral = DAC_CHIPCONNECT_DISABLE;

+  sConfig.DAC_UserTrimming = DAC_TRIMMING_FACTORY;

+  if (HAL_DAC_ConfigChannel(&hdac1, &sConfig, DAC_CHANNEL_2) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  /* USER CODE BEGIN DAC1_Init 2 */

+

+  /* USER CODE END DAC1_Init 2 */

+

+}

+

+/**

+  * @brief I2C1 Initialization Function

+  * @param None

+  * @retval None

+  */

+static void MX_I2C1_Init(void)

+{

+

+  /* USER CODE BEGIN I2C1_Init 0 */

+

+  /* USER CODE END I2C1_Init 0 */

+

+  /* USER CODE BEGIN I2C1_Init 1 */

+

+  /* USER CODE END I2C1_Init 1 */

+  hi2c1.Instance = I2C1;

+  hi2c1.Init.Timing = 0x00303D5B;

+  hi2c1.Init.OwnAddress1 = 0;

+  hi2c1.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT;

+  hi2c1.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE;

+  hi2c1.Init.OwnAddress2 = 0;

+  hi2c1.Init.OwnAddress2Masks = I2C_OA2_NOMASK;

+  hi2c1.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE;

+  hi2c1.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE;

+  if (HAL_I2C_Init(&hi2c1) != HAL_OK)

+  {

+    Error_Handler();

+  }

+

+  /** Configure Analogue filter

+  */

+  if (HAL_I2CEx_ConfigAnalogFilter(&hi2c1, I2C_ANALOGFILTER_ENABLE) != HAL_OK)

+  {

+    Error_Handler();

+  }

+

+  /** Configure Digital filter

+  */

+  if (HAL_I2CEx_ConfigDigitalFilter(&hi2c1, 0) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  /* USER CODE BEGIN I2C1_Init 2 */

+

+  /* USER CODE END I2C1_Init 2 */

+

+}

+

+/**

+  * @brief USART1 Initialization Function

+  * @param None

+  * @retval None

+  */

+static void MX_USART1_UART_Init(void)

+{

+

+  /* USER CODE BEGIN USART1_Init 0 */

+

+  /* USER CODE END USART1_Init 0 */

+

+  /* USER CODE BEGIN USART1_Init 1 */

+

+  /* USER CODE END USART1_Init 1 */

+  huart1.Instance = USART1;

+  huart1.Init.BaudRate = 115200;

+  huart1.Init.WordLength = UART_WORDLENGTH_8B;

+  huart1.Init.StopBits = UART_STOPBITS_1;

+  huart1.Init.Parity = UART_PARITY_NONE;

+  huart1.Init.Mode = UART_MODE_TX_RX;

+  huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;

+  huart1.Init.OverSampling = UART_OVERSAMPLING_16;

+  huart1.Init.OneBitSampling = UART_ONE_BIT_SAMPLE_DISABLE;

+  huart1.Init.ClockPrescaler = UART_PRESCALER_DIV1;

+  huart1.AdvancedInit.AdvFeatureInit = UART_ADVFEATURE_NO_INIT;

+  if (HAL_UART_Init(&huart1) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  if (HAL_UARTEx_SetTxFifoThreshold(&huart1, UART_TXFIFO_THRESHOLD_1_8) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  if (HAL_UARTEx_SetRxFifoThreshold(&huart1, UART_RXFIFO_THRESHOLD_1_8) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  if (HAL_UARTEx_DisableFifoMode(&huart1) != HAL_OK)

+  {

+    Error_Handler();

+  }

+  /* USER CODE BEGIN USART1_Init 2 */

+

+  /* USER CODE END USART1_Init 2 */

+

+}

+

+/**

+  * Enable DMA controller clock

+  */

+static void MX_DMA_Init(void)

+{

+

+  /* DMA controller clock enable */

+  __HAL_RCC_DMA1_CLK_ENABLE();

+

+  /* DMA interrupt init */

+  /* DMA1_Stream0_IRQn interrupt configuration */

+  HAL_NVIC_SetPriority(DMA1_Stream0_IRQn, 0, 0);

+  HAL_NVIC_EnableIRQ(DMA1_Stream0_IRQn);

+  /* DMA1_Stream1_IRQn interrupt configuration */

+  HAL_NVIC_SetPriority(DMA1_Stream1_IRQn, 0, 0);

+  HAL_NVIC_EnableIRQ(DMA1_Stream1_IRQn);

+  /* DMA1_Stream2_IRQn interrupt configuration */

+  HAL_NVIC_SetPriority(DMA1_Stream2_IRQn, 0, 0);

+  HAL_NVIC_EnableIRQ(DMA1_Stream2_IRQn);

+

+}

+

+/**

+  * @brief GPIO Initialization Function

+  * @param None

+  * @retval None

+  */

+static void MX_GPIO_Init(void)

+{

+  GPIO_InitTypeDef GPIO_InitStruct = {0};

+/* USER CODE BEGIN MX_GPIO_Init_1 */

+/* USER CODE END MX_GPIO_Init_1 */

+

+  /* GPIO Ports Clock Enable */

+  __HAL_RCC_GPIOC_CLK_ENABLE();

+  __HAL_RCC_GPIOA_CLK_ENABLE();

+  __HAL_RCC_GPIOD_CLK_ENABLE();

+  __HAL_RCC_GPIOB_CLK_ENABLE();

+

+  /*Configure GPIO pin Output Level */

+  HAL_GPIO_WritePin(GPIOC, FQ_UD_Pin|RESET_Pin|W_CLK_Pin|D13_Pin

+                          |D12_Pin, GPIO_PIN_RESET);

+

+  /*Configure GPIO pin Output Level */

+  HAL_GPIO_WritePin(GPIOD, D7_Pin|D6_Pin|D5_Pin|D4_Pin

+                          |D3_Pin|D2_Pin|D1_Pin|D0_Pin

+                          |D11_Pin|D10_Pin|D14_Pin|D15_Pin

+                          |D16_Pin|D17_Pin, GPIO_PIN_RESET);

+

+  /*Configure GPIO pins : FQ_UD_Pin RESET_Pin W_CLK_Pin D13_Pin

+                           D12_Pin */

+  GPIO_InitStruct.Pin = FQ_UD_Pin|RESET_Pin|W_CLK_Pin|D13_Pin

+                          |D12_Pin;

+  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;

+  GPIO_InitStruct.Pull = GPIO_NOPULL;

+  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;

+  HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);

+

+  /*Configure GPIO pins : D7_Pin D6_Pin D5_Pin D4_Pin

+                           D3_Pin D2_Pin D1_Pin D0_Pin

+                           D11_Pin D10_Pin D14_Pin D15_Pin

+                           D16_Pin D17_Pin */

+  GPIO_InitStruct.Pin = D7_Pin|D6_Pin|D5_Pin|D4_Pin

+                          |D3_Pin|D2_Pin|D1_Pin|D0_Pin

+                          |D11_Pin|D10_Pin|D14_Pin|D15_Pin

+                          |D16_Pin|D17_Pin;

+  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;

+  GPIO_InitStruct.Pull = GPIO_NOPULL;

+  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;

+  HAL_GPIO_Init(GPIOD, &GPIO_InitStruct);

+

+/* USER CODE BEGIN MX_GPIO_Init_2 */

+/* USER CODE END MX_GPIO_Init_2 */

+}

+

+/* USER CODE BEGIN 4 */

+

+/* USER CODE END 4 */

+

+/**

+  * @brief  This function is executed in case of error occurrence.

+  * @retval None

+  */

+void Error_Handler(void)

+{

+  /* USER CODE BEGIN Error_Handler_Debug */

+  /* User can add his own implementation to report the HAL error return state */

+  __disable_irq();

+  while (1)

+  {

+  }

+  /* USER CODE END Error_Handler_Debug */

+}

+

+#ifdef  USE_FULL_ASSERT

+/**

+  * @brief  Reports the name of the source file and the source line number

+  *         where the assert_param error has occurred.

+  * @param  file: pointer to the source file name

+  * @param  line: assert_param error line source number

+  * @retval None

+  */

+void assert_failed(uint8_t *file, uint32_t line)

+{

+  /* USER CODE BEGIN 6 */

+  /* User can add his own implementation to report the file name and line number,

+     ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */

+  /* USER CODE END 6 */

+}

+#endif /* USE_FULL_ASSERT */