// STM32 Blue Pill HAL Blink + printf() example

#include <stdio.h>
#include <stdint.h>
#include <string.h>
#include <stm32f1xx_hal.h>

// Set STM32F103 LED RED (PC13)
#define LED_PORT                GPIOC
#define LED_PIN                 GPIO_PIN_13
#define LED_PORT_CLK_ENABLE     __HAL_RCC_GPIOC_CLK_ENABLE

static volatile uint32_t ms_ticks = 0;
static volatile char tick_1ms_elapsed = 0;
static volatile char tick_1000ms_elapsed = 0;
unsigned long mycnt1;
float myflt1;

UART_HandleTypeDef huart2;

void Error_Handler(void);
void SystemClock_Config(void);
static void MX_USART2_UART_Init(void);

//! The interrupt handler for the SysTick module
void SysTick_Handler(void)
{
//  HAL_IncTick();

  ms_ticks++;

  tick_1ms_elapsed = 1;

  if (ms_ticks % 1000 == 0)
  {
    tick_1000ms_elapsed = 1;
  }

/***
  // 1 Hz blinking
  if ((HAL_GetTick() % 500) == 0)
  {
    HAL_GPIO_TogglePin(LED_PORT, LED_PIN);

    printf("count= %08ld\n", mycnt1);
    mycnt1++;
//    printf("%5.1f\n", myflt1);
//    myflt1 += 0.1;
  }
***/
}


///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
#define LCD_RST_PIN    GPIO_PIN_0
#define LCD_CE_PIN     GPIO_PIN_1
#define LCD_DC_PIN     GPIO_PIN_5
#define LCD_DIN_PIN    GPIO_PIN_3
#define LCD_CLK_PIN    GPIO_PIN_4
#define LCD_GPIO_PORT  GPIOB

/* Function prototypes */
void LCD_GPIO_Init(void);
void LCD_Delay(uint32_t delay);
void LCD_WriteCommand(uint8_t cmd);
void LCD_WriteData(uint8_t data);
void LCD_Init(void);
void LCD_Clear(void);
void LCD_SetCursor(uint8_t x, uint8_t y);
void LCD_PrintChar(char c);
void LCD_PrintString(char* str);

/* Basic 5x8 font (only characters used in "hello world!" included) */
const uint8_t font5x8[][5] = {
    // ' ' (space)
    {0x00,0x00,0x00,0x00,0x00},
    // '!' (ASCII 33)
    {0x00,0x00,0x5F,0x00,0x00},
    // 'H' (ASCII 72)
    {0x7F,0x08,0x08,0x08,0x7F},
    // 'E' (ASCII 69)
    {0x7F,0x49,0x49,0x49,0x41},
    // 'L' (ASCII 76)
    {0x7F,0x40,0x40,0x40,0x40},
    // 'O' (ASCII 79)
    {0x3E,0x41,0x41,0x41,0x3E},
    // 'W' (ASCII 87)
    {0x7F,0x02,0x0C,0x02,0x7F},
    // 'R' (ASCII 82)
    {0x7F,0x09,0x19,0x29,0x46},
    // 'D' (ASCII 68)
    {0x7F,0x41,0x41,0x22,0x1C},
};

/* Map ASCII characters to font index */
uint8_t CharToFontIndex(char c) {
    switch(c) {
        case ' ': return 0;
        case '!': return 1;
        case 'H': return 2;
        case 'E': return 3;
        case 'L': return 4;
        case 'O': return 5;
        case 'W': return 6;
        case 'R': return 7;
        case 'D': return 8;
        default: return 0; // space for unsupported chars
    }
}

void LCD_GPIO_Init(void)
{
    GPIO_InitTypeDef GPIO_InitStruct = {0};

    /* Enable GPIOB clock */
    __HAL_RCC_GPIOB_CLK_ENABLE();

    /* Configure pins as output */
    GPIO_InitStruct.Pin = LCD_RST_PIN | LCD_CE_PIN | LCD_DC_PIN | LCD_DIN_PIN | LCD_CLK_PIN;
    GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
    GPIO_InitStruct.Pull = GPIO_NOPULL;
    GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
    HAL_GPIO_Init(LCD_GPIO_PORT, &GPIO_InitStruct);

    /* Set default pin states */
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_CE_PIN, GPIO_PIN_SET);   // CE high (inactive)
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_CLK_PIN, GPIO_PIN_RESET);
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_DC_PIN, GPIO_PIN_RESET);
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_DIN_PIN, GPIO_PIN_RESET);
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_RST_PIN, GPIO_PIN_SET);
}

void LCD_Delay(uint32_t delay)
{
    HAL_Delay(delay);
}

void LCD_WriteBit(uint8_t bit)
{
    if(bit)
        HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_DIN_PIN, GPIO_PIN_SET);
    else
        HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_DIN_PIN, GPIO_PIN_RESET);

    /* Clock pulse */
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_CLK_PIN, GPIO_PIN_SET);
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_CLK_PIN, GPIO_PIN_RESET);
}

void LCD_WriteByte(uint8_t data, uint8_t isData)
{
    /* Set DC pin */
    if(isData)
        HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_DC_PIN, GPIO_PIN_SET);
    else
        HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_DC_PIN, GPIO_PIN_RESET);

    /* Enable chip */
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_CE_PIN, GPIO_PIN_RESET);

    /* Send bits MSB first */
    for(int i = 7; i >= 0; i--)
    {
        LCD_WriteBit((data >> i) & 0x01);
    }

    /* Disable chip */
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_CE_PIN, GPIO_PIN_SET);
}

void LCD_WriteCommand(uint8_t cmd)
{
    LCD_WriteByte(cmd, 0);
}

void LCD_WriteData(uint8_t data)
{
    LCD_WriteByte(data, 1);
}

void LCD_Init(void)
{
    /* Reset LCD */
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_RST_PIN, GPIO_PIN_RESET);
    LCD_Delay(10);
    HAL_GPIO_WritePin(LCD_GPIO_PORT, LCD_RST_PIN, GPIO_PIN_SET);

    /* LCD initialization sequence */
    LCD_WriteCommand(0x21); // Extended instruction set
    LCD_WriteCommand(0xBf); // Set Vop (contrast)
    LCD_WriteCommand(0x04); // Set temperature coefficient
    LCD_WriteCommand(0x14); // Set bias mode
    LCD_WriteCommand(0x20); // Basic instruction set
    LCD_WriteCommand(0x0C); // Normal display mode
    LCD_Clear();
}

void LCD_Clear(void)
{
    for(uint16_t i = 0; i < 504; i++) // 84*48 pixels / 8 bits per byte = 504 bytes
    {
        LCD_WriteData(0x00);
    }
    LCD_SetCursor(0,0);
}

void LCD_SetCursor(uint8_t x, uint8_t y)
{
    LCD_WriteCommand(0x80 | x); // Column
    LCD_WriteCommand(0x40 | y); // Row (each row = 8 pixels tall)
}

void LCD_PrintChar(char c)
{
    uint8_t index = CharToFontIndex(c);
    for(int i = 0; i < 5; i++)
    {
        LCD_WriteData(font5x8[index][i]);
    }
    LCD_WriteData(0x00); // 1 pixel space
}

void LCD_PrintString(char* str)
{
    while(*str)
    {
        LCD_PrintChar(*str++);
    }
}


///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////


int main(void)
{
  const char * hello_world = "Hello STM32\r\n";

  HAL_Init();
  SystemClock_Config();

  initGPIO();
  MX_USART2_UART_Init();

  //1kHz ticks
  //HAL_SYSTICK_Config(SystemCoreClock / 1000);
  //HAL_SYSTICK_Config(HAL_RCC_GetHCLKFreq()/1000);
  if (SysTick_Config(SystemCoreClock / 1000))
  {
    while (1) {  /* no error must happen here, otherwise this board is dead */ }
  }
  printf("SystemCoreClock: %ld\n\n", SystemCoreClock);

  HAL_UART_Transmit(&huart2, (uint8_t *)hello_world, strlen(hello_world), HAL_MAX_DELAY);

  printf("Characters: %c %c\n", 'a', 65);
  printf("Decimals: %d %ld\n", 1977, 650000L);
  printf("Preceding with blanks: %10d\n", 1977);
  printf("Preceding with  zeros: %010d\n", 1977);
  printf("Some different radices: %d %x %o %#x %#o\n", 100, 100, 100, 100, 100);
  printf("floats: %4.2f %+.0e %E\n", 3.1416, 3.1416, 3.1416);
  printf("Width trick: %*d\n", 5, 10);
  printf("%s\n", "A string");

///////////////////////////////////////////////////////////////////////////////////
   
  HAL_Init();
  SystemClock_Config();
  LCD_GPIO_Init();
  LCD_Init();
  LCD_SetCursor(0,0);
  LCD_PrintString("HELLO WORLD!");

//////////////////////////////////////////////////////////////////////////////////






  while (1)
  {
    if (tick_1ms_elapsed)
    {
      //... Do something every ms
      tick_1ms_elapsed = 0; // Reset the flag (signal 'handled')
    }

    if (tick_1000ms_elapsed)
    {
      //... Do something every second
      HAL_GPIO_TogglePin(LED_PORT, LED_PIN);

      printf("count= %08ld\n", mycnt1);
      mycnt1++;
//    printf("%5.1f\n", myflt1);
//    myflt1 += 0.1;

      tick_1000ms_elapsed = 0;  // Reset the flag (signal 'handled')
    }
  }

  return 0;
}

/**
    @brief System Clock Configuration
    @retval None
*/
void SystemClock_Config(void)
{
  RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

  /* Initializes the CPU, AHB and APB busses clocks */
  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
  RCC_OscInitStruct.HSIState = RCC_HSI_ON;
  RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
  RCC_OscInitStruct.PLL.PLLState = RCC_PLL_NONE;

  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  {
    Error_Handler();
  }

  /* Initializes the CPU, AHB and APB busses clocks */
  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_SYSCLK
                                | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2;
  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_HSI;
  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_0) != HAL_OK)
  {
    Error_Handler();
  }
}

void initGPIO()
{
  GPIO_InitTypeDef GPIO_Config;

  GPIO_Config.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_Config.Pull = GPIO_NOPULL;
  GPIO_Config.Speed = GPIO_SPEED_FREQ_HIGH;

  GPIO_Config.Pin = LED_PIN;

  LED_PORT_CLK_ENABLE();
  HAL_GPIO_Init(LED_PORT, &GPIO_Config);

//  __HAL_RCC_GPIOA_CLK_ENABLE();
}

/**
    @brief USART2 Initialization Function
    @param None
    @retval None
*/
static void MX_USART2_UART_Init(void)
{
  __HAL_RCC_GPIOA_CLK_ENABLE();
  /**
    USART2 GPIO Configuration
    PA2     ------> USART2_TX
    PA15    ------> USART2_RX
  */
  GPIO_InitTypeDef GPIO_InitStruct = {0};
  GPIO_InitStruct.Pin = GPIO_PIN_2 | GPIO_PIN_15;
  GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
//  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
//  GPIO_InitStruct.Alternate = GPIO_AF4_USART2;
  HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

  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;
//  huart2.Init.OneBitSampling = UART_ONE_BIT_SAMPLE_DISABLE;
//  huart2.AdvancedInit.AdvFeatureInit = UART_ADVFEATURE_NO_INIT;
  if (HAL_UART_Init(&huart2) != HAL_OK)
  {
    Error_Handler();
  }

  __HAL_RCC_USART2_CLK_ENABLE();
}

#define STDOUT_FILENO   1
#define STDERR_FILENO   2

int _write(int file, char *ptr, int len)
{
  switch (file)
  {
    case STDOUT_FILENO: /*stdout*/
      HAL_UART_Transmit(&huart2, ptr, len, HAL_MAX_DELAY);
      // Send the string somewhere
      break;
    case STDERR_FILENO: /* stderr */
      HAL_UART_Transmit(&huart2, ptr, len, HAL_MAX_DELAY);
      // Send the string somewhere
      break;
    default:
      return -1;
  }
  return len;
}

void Error_Handler(void)
{
  /* User can add his own implementation to report the HAL error return state */
}

#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 can add his own implementation to report the file name and line number,
    tex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
}
#endif /* USE_FULL_ASSERT */