/*
 * FanControl.cpp
 *
 *  Created on: 27.07.2023
 *      Author: Carst
 */

#include <stm32g0xx_ll_bus.h>
#include <stm32g0xx_ll_gpio.h>
#include <stm32g0xx_ll_tim.h>
#include "FanControl.hpp"

static std::uint32_t fan_speed;

extern "C" void TIM14_IRQHandler(void)
{
  LL_TIM_ClearFlag_UPDATE(TIM14);

  fan_speed = LL_TIM_GetCounter(TIM2) / 2UL;
  LL_TIM_SetCounter(TIM2, 0UL);
}

namespace ElektronischeLast
{
  FanControl::FanControl(void)
  {
    /* TIM3 PWM-Output
     * 25kHz (Vorgabe Intel). Geschwindigkeit wird über Tastverhältnis geregelt.
     */
    LL_TIM_InitTypeDef TIM_InitStruct = {
      .Prescaler = 0UL,
      .CounterMode = LL_TIM_COUNTERMODE_UP,
      .Autoreload = 2559UL,
      .ClockDivision = LL_TIM_CLOCKDIVISION_DIV1,
    };
    LL_TIM_Init(TIM3, &TIM_InitStruct);

    LL_TIM_DisableARRPreload(TIM3);
    LL_TIM_OC_EnablePreload(TIM3, LL_TIM_CHANNEL_CH1);
    LL_TIM_OC_InitTypeDef TIM_OC_InitStruct = {
      .OCMode = LL_TIM_OCMODE_PWM1,
      .OCState = LL_TIM_OCSTATE_ENABLE,
      .OCNState = LL_TIM_OCSTATE_DISABLE,
      .CompareValue = 0UL,
      .OCPolarity = LL_TIM_OCPOLARITY_HIGH,
    };
    LL_TIM_OC_Init(TIM3, LL_TIM_CHANNEL_CH1, &TIM_OC_InitStruct);
    LL_TIM_OC_DisableFast(TIM3, LL_TIM_CHANNEL_CH1);
    LL_TIM_SetTriggerOutput(TIM3, LL_TIM_TRGO_RESET);
    LL_TIM_DisableMasterSlaveMode(TIM3);

    /* TIM2 Input Capture zur Messung der Geschwindigkeit.
     */
    TIM_InitStruct.Prescaler = 0;
    TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
    TIM_InitStruct.Autoreload = 0;
    TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV1;
    LL_TIM_Init(TIM2, &TIM_InitStruct);
    LL_TIM_DisableARRPreload(TIM2);
    LL_TIM_SetClockSource(TIM2, LL_TIM_CLOCKSOURCE_INTERNAL);
    LL_TIM_SetTriggerOutput(TIM2, LL_TIM_TRGO_RESET);
    LL_TIM_DisableMasterSlaveMode(TIM2);
    LL_TIM_IC_SetActiveInput(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ACTIVEINPUT_DIRECTTI);
    LL_TIM_IC_SetPrescaler(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_ICPSC_DIV1);
    LL_TIM_IC_SetFilter(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_FILTER_FDIV1);
    LL_TIM_IC_SetPolarity(TIM2, LL_TIM_CHANNEL_CH1, LL_TIM_IC_POLARITY_RISING);

    /* TIM14 1s ISR */
    TIM_InitStruct.Prescaler = 15999;
    TIM_InitStruct.CounterMode = LL_TIM_COUNTERMODE_UP;
    TIM_InitStruct.Autoreload = 999;
    TIM_InitStruct.ClockDivision = LL_TIM_CLOCKDIVISION_DIV4;
    LL_TIM_Init(TIM14, &TIM_InitStruct);
    LL_TIM_DisableARRPreload(TIM14);

    /* TIM3 GPIO Configuration
     * PC6   ------> TIM3_CH1
     */
    LL_GPIO_InitTypeDef GPIO_InitStruct = {
      .Pin = LL_GPIO_PIN_6,
      .Mode = LL_GPIO_MODE_ALTERNATE,
      .Speed = LL_GPIO_SPEED_FREQ_LOW,
      .OutputType = LL_GPIO_OUTPUT_PUSHPULL,
      .Pull = LL_GPIO_PULL_NO,
      .Alternate = LL_GPIO_AF_1,
    };
    LL_GPIO_Init(GPIOC, &GPIO_InitStruct);
    /*T IM2 GPIO Configuration
     * PA15   ------> TIM2_CH1
     */
    GPIO_InitStruct.Pin = LL_GPIO_PIN_15;
    GPIO_InitStruct.Pull = LL_GPIO_PULL_UP;
    GPIO_InitStruct.Alternate = LL_GPIO_AF_2;
    LL_GPIO_Init(GPIOA, &GPIO_InitStruct);

    LL_TIM_EnableCounter(TIM3);

    this->compare_value = 0UL;

    NVIC_SetPriority(TIM14_IRQn, 0);
    NVIC_EnableIRQ(TIM14_IRQn);
  }

  void FanControl::run(std::uint32_t temp)
  {
    LL_TIM_OC_SetCompareCH1(TIM3, this->compare_value);
  }
}