#include <stdio.h>
#include <stdlib.h>
#include "main.h"
#include "usart.h"
#include "thread.h"

void SystemClock_Config(void)
{
    RCC_OscInitTypeDef RCC_OscInitStruct = { 0 };
    RCC_ClkInitTypeDef RCC_ClkInitStruct = { 0 };
    RCC_PeriphCLKInitTypeDef PeriphClkInit = { 0 };

    /** Initializes the RCC Oscillators according to the specified parameters
  * in the RCC_OscInitTypeDef structure.
  */
    RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
    RCC_OscInitStruct.HSEState = RCC_HSE_ON;
    RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
    RCC_OscInitStruct.HSIState = RCC_HSI_ON;
    RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
    RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
    RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL6;
    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_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
    RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
    RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
    RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

    if(HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_1) != HAL_OK)
    {
        Error_Handler();
    }
    PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_USB;
    PeriphClkInit.UsbClockSelection = RCC_USBCLKSOURCE_PLL;
    if(HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
    {
        Error_Handler();
    }
}

void Error_Handler(void)
{
    __disable_irq();
    while(1)
    {
    }
}

void prosee1(void *data)
{
	tcb_t *self = (tcb_t *)data;
    while(1)
    {	
		__disable_irq();
		printf("prosee_%d\r\n", self->task_id);
		__enable_irq();
		HAL_Delay(1000);
    }
}

void prosee2(void *data)
{
	tcb_t *self = (tcb_t *)data;
    while(1)
    {	
		__disable_irq();
		printf("prosee_%d\r\n", self->task_id);
		__enable_irq();
		HAL_Delay(1000);
    }
}

tcb_t tcb1;
tcb_t tcb2;
uint8_t statck[STACK_SIZE];
uint8_t statck2[STACK_SIZE];

int main(void)
{
	__disable_irq();
	HAL_Init();
	SystemClock_Config();
	MX_USART1_UART_Init();
	printf("Init tasks\r\n");
	init_task(&tcb1, prosee1, statck, (void *)&tcb1);
	init_task(&tcb2, prosee2, statck2, (void *)&tcb2);
	
	/* run the first task */
	start_first_task();
	__enable_irq();
	while(1)
	{
		printf("idle\r\n");
	};
}