Subversion Repositories DashDisplay

/**

  ******************************************************************************

  * File Name          : main.c

  * Description        : Main program body

  ******************************************************************************

  *

  * COPYRIGHT(c) 2017 STMicroelectronics

  *

  * Redistribution and use in source and binary forms, with or without modification,

  * are permitted provided that the following conditions are met:

  *   1. Redistributions of source code must retain the above copyright notice,

  *      this list of conditions and the following disclaimer.

  *   2. Redistributions in binary form must reproduce the above copyright notice,

  *      this list of conditions and the following disclaimer in the documentation

  *      and/or other materials provided with the distribution.

  *   3. Neither the name of STMicroelectronics nor the names of its contributors

  *      may be used to endorse or promote products derived from this software

  *      without specific prior written permission.

  *

  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"

  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE

  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE

  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE

  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL

  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR

  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER

  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,

  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE

  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

  *

  ******************************************************************************

  */

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

#include "stm32l1xx_hal.h"

/* USER CODE BEGIN Includes */

#include "ap_math.h"

#include "serial.h"

#include "SSD1306.h"

#include "Font.h"

#include "dials.h"

#include "switches.h"

#include <math.h>

#include "plx.h"

#include "eeprom.h"

#include "displayinfo.h"

#include "small_printf.h"

/* USER CODE END Includes */

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

SPI_HandleTypeDef hspi1;

UART_HandleTypeDef huart1;

UART_HandleTypeDef huart2;

UART_HandleTypeDef huart3;

/* USER CODE BEGIN PV */

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

#define MAXRDG 32

/* timeout when the ignition is switched off */

#define IGNITION_OFF_TIMEOUT 30000UL

int OldObservation[2] =

  { -1, -1 }; // illegal initial value

int OldObservationIndex[2] =

  { -1, -1 }; // if more than one sensor this will be printed

int16_t dial0[2] =

  { 0, 0 };

int16_t dial1[2] =

  { -1, -1 };

uint16_t dial_timer[2] =

  { 0, 0 };

static const int DialTimeout = 50; // about 20 seconds after twiddle, save the dial position.

/* Virtual address defined by the user: 0xFFFF value is prohibited */

uint16_t VirtAddVarTab[NumbOfVar] =

  { 0x1111, 0x2222 };

union

{

  PLX_SensorInfo Sensor[MAXRDG];

  char Bytes[MAXRDG * sizeof(PLX_SensorInfo)];

} Data;

int Max[MAXRDG];

int Min[MAXRDG];

int PLXItems;

uint32_t Latch_Timer = IGNITION_OFF_TIMEOUT;

/* USER CODE END PV */

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

void SystemClock_Config(void);

void Error_Handler(void);

static void MX_GPIO_Init(void);

static void MX_SPI1_Init(void);

static void MX_USART1_UART_Init(void);

static void MX_USART2_UART_Init(void);

static void MX_USART3_UART_Init(void);

/* USER CODE BEGIN PFP */

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

/* USER CODE END PFP */

/* USER CODE BEGIN 0 */

/* dummy function */

void

_init (void)

{

}

// the dial is the switch number we are using.

// suppress is the ItemIndex we wish to suppress on this display

int

DisplayCurrent (int dial, int suppress)

{

  char buff[10];

  int i;

  int rc;

  select_display (dial); // pick the display we are using

  int ItemIndex = dial_pos[dial] / 4;

  // wrap around count if dial too far to the right

  if (ItemIndex >= PLXItems)

    {

      dial_pos[dial] = 0;

      ItemIndex = 0;

    }

  if (ItemIndex < 0)

    {

      ItemIndex = PLXItems - 1;

      dial_pos[dial] = (PLXItems - 1) * 4;

    }

  // check for item suppression

  if (ItemIndex == suppress)

    {

      dial1[dial] = -1;

      OldObservation[dial] = -1;

      OldObservationIndex[dial] = -1;

      clearDisplay ();

      display ();

      return -1; // we suppressed this display

    }

  // do not try to convert if no items in buffer

  if (PLXItems > 0)

    {

      int DataVal = ConvPLX (Data.Sensor[ItemIndex].ReadingH,

                             Data.Sensor[ItemIndex].ReadingL); // data reading

      int Observation = ConvPLX (Data.Sensor[ItemIndex].AddrH,

                                 Data.Sensor[ItemIndex].AddrL);

      int ObservationIndex = ConvPLX (0, Data.Sensor[ItemIndex].Instance);

      // now to convert the readings and format strings

      // find out limits

      char * msg;

      int len;

      // if the user presses the dial then reset min/max to current value

      if (push_pos[dial] == 1)

        {

          Max[ItemIndex] = DataVal;

          Min[ItemIndex] = DataVal; // 12 bit max value

        }

      if (Observation < PLX_MAX_OBS)

        {

          if (Observation != OldObservation[dial]

              || ObservationIndex != OldObservationIndex[dial])

            {

              dial_timer[dial] = DialTimeout;

              dial1[dial] = -1;

              clearDisplay ();

              dial_draw_scale (DisplayInfo[Observation].Low,

                               DisplayInfo[Observation].High, 12, 1,

                               DisplayInfo[Observation].TickScale);

              msg = DisplayInfo[Observation].name;

              len = 7;

              int len1 = ObservationIndex > 0 ? len - 1 : len;

              for (i = 0; i < len1 && msg[i]; i++)

                {

                  buff[i] = msg[i];

                }

              if (ObservationIndex > 0 && i < len)

                {

                  buff[i++] = ObservationIndex + '1';

                }

              print_large_string (buff, 64 - i * 4, 48, i); // this prints spaces for \0 at end of string

              // print suffix if present.

              font_gotoxy (15, 4);

              int i = 0;

              while (DisplayInfo[Observation].suffix[i])

                {

                  font_putchar (DisplayInfo[Observation].suffix[i++]);

                }

              OldObservation[dial] = Observation;

              OldObservationIndex[dial] = ObservationIndex;

              //

              display ();

            }

          else

            {

              // check for timer timeout on consistent timer

              if (dial_timer[dial])

                {

                  dial_timer[dial]--;

                  if (dial_timer[dial] == 0)

                    {

                      uint16_t curr_val = dial_pos[dial];

                      rc = EE_ReadVariable (VirtAddVarTab[dial], &curr_val);

                      if ((rc != 0) || (curr_val != dial_pos[dial]))

                        {

                          //__disable_irq();

                          HAL_FLASH_Unlock ();

                          rc = EE_WriteVariable (VirtAddVarTab[dial],

                                                 dial_pos[dial]);

                          HAL_FLASH_Lock ();

                          //__enable_irq();

                        }

                    }

                }

            }

          double max_rdg;

          double min_rdg;

          double cur_rdg;

          int int_rdg;

          int int_max;

          int int_min;

          max_rdg = ConveriMFDRaw2Data (Observation,

                                        DisplayInfo[Observation].Units,

                                        Max[ItemIndex]);

          min_rdg = ConveriMFDRaw2Data (Observation,

                                        DisplayInfo[Observation].Units,

                                        Min[ItemIndex]);

          cur_rdg = ConveriMFDRaw2Data (Observation,

                                        DisplayInfo[Observation].Units,

                                        DataVal);

          int dp_pos;  // where to print the decimal place

          float scale = 1.0;

          switch (DisplayInfo[Observation].DP)

            {

            case 0:

              scale = 1.0;

              dp_pos = 100;

              break;

            case 1:

              scale = 10.0;

              dp_pos = 1;

              break;

            case 2:

              scale = 100.0;

              dp_pos = 2;

              break;

            }

          int_rdg = (int) (cur_rdg * scale);

          int_max = (int) (max_rdg * scale);

          int_min = (int) (min_rdg * scale);

          cur_rdg -= DisplayInfo[Observation].Low;

          cur_rdg = 100 * cur_rdg

              / (DisplayInfo[Observation].High - DisplayInfo[Observation].Low);

          dial0[dial] = (int) cur_rdg;

          /* old needle un-draw */

          if (dial1[dial] >= 0)

            {

              dial_draw_needle (dial1[dial]);

            }

          dial_draw_needle (dial0[dial]);

          // print value overlaid by needle

          // this is actual reading

          print_digits (30, 30, 5, dp_pos, int_rdg);

          font_gotoxy (0, 0);

          font_digits (5, dp_pos, int_min);

          font_gotoxy (0, 1);

          font_puts ("Min");

          font_gotoxy (15, 0);

          font_digits (5, dp_pos, int_max);

          font_gotoxy (18, 1);

          font_puts ("Max");

          dial1[dial] = dial0[dial];

          display ();

        }

    }

  return ItemIndex;

}

/* USER CODE END 0 */

int main(void)

{

  /* USER CODE BEGIN 1 */

  GPIO_InitTypeDef GPIO_InitStruct;

  __HAL_RCC_SPI1_CLK_ENABLE()

  ;

  __HAL_RCC_USART1_CLK_ENABLE()

  ; // PLX main port

  __HAL_RCC_USART2_CLK_ENABLE()

  ; // debug port

  __HAL_RCC_USART3_CLK_ENABLE (); // Bluetooth port

  /* USER CODE END 1 */

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

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

  HAL_Init();

  /* Configure the system clock */

  SystemClock_Config();

  /* Initialize all configured peripherals */

  MX_GPIO_Init();

  MX_SPI1_Init();

  MX_USART1_UART_Init();

  MX_USART2_UART_Init();

  MX_USART3_UART_Init();

  /* USER CODE BEGIN 2 */

  /* Turn on USART1 IRQ */

  HAL_NVIC_SetPriority (USART1_IRQn, 2, 0);

  HAL_NVIC_EnableIRQ (USART1_IRQn);

  /* Turn on USART2 IRQ  */

  HAL_NVIC_SetPriority (USART2_IRQn, 4, 0);

  HAL_NVIC_EnableIRQ (USART2_IRQn);

  /* turn on USART3 IRQ */

  HAL_NVIC_SetPriority (USART3_IRQn, 4, 0);

  HAL_NVIC_EnableIRQ (USART3_IRQn);

  /* setup the USART control blocks */

  init_usart_ctl (&uc1, huart1.Instance);

  init_usart_ctl (&uc2, huart2.Instance);

  init_usart_ctl (&uc3, huart3.Instance);

  EnableSerialRxInterrupt (&uc1);

  EnableSerialRxInterrupt (&uc2);

  EnableSerialRxInterrupt (&uc3);

  /* Unlock the Flash to enable the flash control register access *************/

  HAL_FLASH_Unlock ();

  //__disable_irq();

  EE_Init ();

  //__enable_irq();

  HAL_FLASH_Lock ();

  InitSwitches ();

  int i;

  uint16_t rc;

  for (i = 0; i < 2; i++)

    {

      uint16_t val;

      uint16_t rc = EE_ReadVariable (VirtAddVarTab[i], &val);

      if (rc == 0)

        {

          dial_pos[i] = val;

        }

      else

        {

          break;

        }

    }

  ap_init (); // set up the approximate math library

  int disp;

  ssd1306_begin (1, 0);

  dial_origin (64, 60);

  dial_size (60);

  /* reset the display timeout, latch on power from accessories */

  Latch_Timer = IGNITION_OFF_TIMEOUT;

  HAL_GPIO_WritePin (POWER_LATCH_GPIO_Port, POWER_LATCH_Pin, GPIO_PIN_RESET);

  for (disp = 0; disp < 2; disp++)

    {

      select_display (disp);

      clearDisplay ();

      dim (0);

      //font_puts(

      //                "Hello world !!\rThis text is a test of the text rendering library in a 5*7 font");

      dial_draw_scale (0, 10, 12, 5, 1);

      char buffer[] = "Display  ";

      buffer[8] = disp + '1';

      print_large_string (buffer, 20, 30, 9);

      display ();

    }

  /* USER CODE END 2 */

  /* Infinite loop */

  /* USER CODE BEGIN WHILE */

  uint32_t Ticks = HAL_GetTick () + 100;

  /* while ignition is on, keep resetting power latch timer */

  if (HAL_GPIO_ReadPin (IGNITION_GPIO_Port, IGNITION_Pin) == GPIO_PIN_RESET)

    {

      Latch_Timer = HAL_GetTick () + IGNITION_OFF_TIMEOUT;

    }

  else

    {

      /* if the ignition has been off for a while, then turn off power */

      if (HAL_GetTick () > Latch_Timer)

        {

          HAL_GPIO_WritePin (POWER_LATCH_GPIO_Port, POWER_LATCH_Pin,

                             GPIO_PIN_RESET);

        }

    }

  uint32_t timeout = 0;  //

  // PLX decoder protocols

  char PLXPacket = 0;

  for (i = 0; i < MAXRDG; i++)

    {

      Max[i] = 0;

      Min[i] = 0xFFF; // 12 bit max value

    }

  int PLXPtr = 0;

  while (1)

    {

// poll switche

      HandleSwitches ();

// Handle the bluetooth pairing function by pressing both buttons.

      if ((push_pos[0] == 1) && (push_pos[1] == 1))

        {

          HAL_GPIO_WritePin (BT_BUTTON_GPIO_Port, BT_BUTTON_Pin, GPIO_PIN_SET);

        }

      else

        {

          HAL_GPIO_WritePin (BT_BUTTON_GPIO_Port, BT_BUTTON_Pin,

                             GPIO_PIN_RESET);

        }

      uint16_t cc = SerialCharsReceived (&uc1);

      int chr;

      if (cc == 0)

        {

          timeout++;

          if (timeout % 1000 == 0)

            {

              PutCharSerial (&uc3, '+');

            }

          if (timeout > 60000)

            {

              // do turn off screen

            }

        }

      for (chr = 0; chr < cc; chr++)

        {

          char c = GetCharSerial (&uc1);

          timeout = 0;

          if (c == PLX_Start) // at any time if the start byte appears, reset the pointers

            {

              PLXPtr = 0;    // reset the pointer

              PLXPacket = 1;

            }

          else if (c == PLX_Stop)

            {

              if (PLXPacket)

                {

                  // we can now decode the selected parameter

                  PLXItems = PLXPtr / sizeof(PLX_SensorInfo); // total

                  // saturate the rotary switch position

                  int DataVal;

                  // process min/max

                  for (i = 0; i < PLXItems; i++)

                    {

                      // Send item to BT

                      uint16_t addr = ConvPLX (Data.Sensor[i].AddrH,

                                               Data.Sensor[i].AddrL);

                      uint8_t inst = Data.Sensor[i].Instance;

                      uint16_t reading = ConvPLX (Data.Sensor[i].ReadingH,

                                                  Data.Sensor[i].ReadingL);

                      char outbuff[100];

                      int cnt = simple_sprintf (outbuff, "%d,%d,%d\n", addr, inst,

                                         reading);

                      int i;

                      for (i = 0; i < cnt; i++)

                        {

                          PutCharSerial (&uc3, outbuff[i]);

                        }

                      DataVal = ConvPLX (Data.Sensor[i].ReadingH,

                                         Data.Sensor[i].ReadingL);

                      if (DataVal > Max[i])

                        {

                          Max[i] = DataVal;

                        }

                      if (DataVal < Min[i])

                        {

                          Min[i] = DataVal;

                        }

                    }

                  // now to display the information

                  int suppress = DisplayCurrent (0, -1);

                  DisplayCurrent (1, suppress);

                }

              PLXPtr = 0;

              PLXPacket = 0;

            }

          else if (c > PLX_Stop) // illegal char, restart reading

            {

              PLXPacket = 0;

              PLXPtr = 0;

            }

          else if (PLXPtr < sizeof(Data.Bytes))

            {

              Data.Bytes[PLXPtr++] = c;

            }

        }

      HAL_Delay (1);

    }

  /* USER CODE END WHILE */

  /* USER CODE BEGIN 3 */

  /* USER CODE END 3 */

}

/** System Clock Configuration

*/

void SystemClock_Config(void)

{

  RCC_OscInitTypeDef RCC_OscInitStruct;

  RCC_ClkInitTypeDef RCC_ClkInitStruct;

  __HAL_RCC_PWR_CLK_ENABLE();

  __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);

  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;

  RCC_OscInitStruct.HSEState = RCC_HSE_ON;

  RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;

  RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;

  RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL12;

  RCC_OscInitStruct.PLL.PLLDIV = RCC_PLL_DIV3;

  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)

  {

    Error_Handler();

  }

  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK

                              |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;

  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;

  RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;

  RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;

  RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

  if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_1) != HAL_OK)

  {

    Error_Handler();

  }

  HAL_SYSTICK_Config(HAL_RCC_GetHCLKFreq()/1000);

  HAL_SYSTICK_CLKSourceConfig(SYSTICK_CLKSOURCE_HCLK);

  /* SysTick_IRQn interrupt configuration */

  HAL_NVIC_SetPriority(SysTick_IRQn, 0, 0);

}

/* SPI1 init function */

static void MX_SPI1_Init(void)

{

  hspi1.Instance = SPI1;

  hspi1.Init.Mode = SPI_MODE_MASTER;

  hspi1.Init.Direction = SPI_DIRECTION_1LINE;

  hspi1.Init.DataSize = SPI_DATASIZE_8BIT;

  hspi1.Init.CLKPolarity = SPI_POLARITY_HIGH;

  hspi1.Init.CLKPhase = SPI_PHASE_1EDGE;

  hspi1.Init.NSS = SPI_NSS_SOFT;

  hspi1.Init.BaudRatePrescaler = SPI_BAUDRATEPRESCALER_4;

  hspi1.Init.FirstBit = SPI_FIRSTBIT_MSB;

  hspi1.Init.TIMode = SPI_TIMODE_DISABLE;

  hspi1.Init.CRCCalculation = SPI_CRCCALCULATION_DISABLE;

  hspi1.Init.CRCPolynomial = 10;

  if (HAL_SPI_Init(&hspi1) != HAL_OK)

  {

    Error_Handler();

  }

}

/* USART1 init function */

static void MX_USART1_UART_Init(void)

{

  huart1.Instance = USART1;

  huart1.Init.BaudRate = 19200;

  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;

  if (HAL_UART_Init(&huart1) != HAL_OK)

  {

    Error_Handler();

  }

}

/* USART2 init function */

static void MX_USART2_UART_Init(void)

{

  huart2.Instance = USART2;

  huart2.Init.BaudRate = 115200;

  huart2.Init.WordLength = UART_WORDLENGTH_8B;

  huart2.Init.StopBits = UART_STOPBITS_1;

  huart2.Init.Parity = UART_PARITY_NONE;

  huart2.Init.Mode = UART_MODE_TX_RX;

  huart2.Init.HwFlowCtl = UART_HWCONTROL_NONE;

  huart2.Init.OverSampling = UART_OVERSAMPLING_16;

  if (HAL_UART_Init(&huart2) != HAL_OK)

  {

    Error_Handler();

  }

}

/* USART3 init function */

static void MX_USART3_UART_Init(void)

{

  huart3.Instance = USART3;

  huart3.Init.BaudRate = 19200;

  huart3.Init.WordLength = UART_WORDLENGTH_8B;

  huart3.Init.StopBits = UART_STOPBITS_1;

  huart3.Init.Parity = UART_PARITY_NONE;

  huart3.Init.Mode = UART_MODE_TX_RX;

  huart3.Init.HwFlowCtl = UART_HWCONTROL_NONE;

  huart3.Init.OverSampling = UART_OVERSAMPLING_16;

  if (HAL_UART_Init(&huart3) != HAL_OK)

  {

    Error_Handler();

  }

}

/** Configure pins as

        * Analog

        * Input

        * Output

        * EVENT_OUT

        * EXTI

*/

static void MX_GPIO_Init(void)

{

  GPIO_InitTypeDef GPIO_InitStruct;

  /* GPIO Ports Clock Enable */

  __HAL_RCC_GPIOH_CLK_ENABLE();

  __HAL_RCC_GPIOA_CLK_ENABLE();

  __HAL_RCC_GPIOC_CLK_ENABLE();

  __HAL_RCC_GPIOB_CLK_ENABLE();

  /*Configure GPIO pin Output Level */

  HAL_GPIO_WritePin(GPIOA, SPI1_NSS1_Pin|SPI1CD_Pin|BT_BUTTON_Pin, GPIO_PIN_RESET);

  /*Configure GPIO pin Output Level */

  HAL_GPIO_WritePin(GPIOC, SPI_RESET_Pin|SPI_NSS2_Pin|POWER_LATCH_Pin|USB_PWR_Pin, GPIO_PIN_RESET);

  /*Configure GPIO pins : SPI1_NSS1_Pin SPI1CD_Pin BT_BUTTON_Pin */

  GPIO_InitStruct.Pin = SPI1_NSS1_Pin|SPI1CD_Pin|BT_BUTTON_Pin;

  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;

  GPIO_InitStruct.Pull = GPIO_NOPULL;

  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;

  HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

  /*Configure GPIO pins : SPI_RESET_Pin SPI_NSS2_Pin POWER_LATCH_Pin USB_PWR_Pin */

  GPIO_InitStruct.Pin = SPI_RESET_Pin|SPI_NSS2_Pin|POWER_LATCH_Pin|USB_PWR_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 pin : SW1_PUSH_Pin */

  GPIO_InitStruct.Pin = SW1_PUSH_Pin;

  GPIO_InitStruct.Mode = GPIO_MODE_IT_RISING;

  GPIO_InitStruct.Pull = GPIO_NOPULL;

  HAL_GPIO_Init(SW1_PUSH_GPIO_Port, &GPIO_InitStruct);

  /*Configure GPIO pins : SW_I_Pin SW1_Q_Pin SW2_PUSH_Pin */

  GPIO_InitStruct.Pin = SW_I_Pin|SW1_Q_Pin|SW2_PUSH_Pin;

  GPIO_InitStruct.Mode = GPIO_MODE_INPUT;

  GPIO_InitStruct.Pull = GPIO_NOPULL;

  HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);

  /*Configure GPIO pins : SW2_I_Pin SW2_Q_Pin IGNITION_Pin */

  GPIO_InitStruct.Pin = SW2_I_Pin|SW2_Q_Pin|IGNITION_Pin;

  GPIO_InitStruct.Mode = GPIO_MODE_INPUT;

  GPIO_InitStruct.Pull = GPIO_NOPULL;

  HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);

}

/* USER CODE BEGIN 4 */

/* USER CODE END 4 */

/**

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

  * @param  None

  * @retval None

  */

void Error_Handler(void)

{

  /* USER CODE BEGIN Error_Handler */

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

  while (1)

    {

    }

  /* USER CODE END Error_Handler */

}

#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

/**

  * @}

  */