#include "ad7606.h"

//Брой цикли:
uint32_t cycles;
//Скорост на контролерчето:
uint32_t sysclk;
uint32_t forI;

double oneCyclePeriod;


void A7606Reset (uint64_t RSTtime){
      //Замерване на системната скорост:
   sysclk = HAL_RCC_GetSysClockFreq();

      // Активирам DWT
   CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;

      // Пускане на брояча
   DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;

      // Нулиране
   DWT->CYCCNT = 0;

     //Нулирам Порт B пин 6
   HAL_GPIO_WritePin(GPIOB, GPIO_PIN_6, GPIO_PIN_RESET);

     //Изчаквам малко за да се види в анализатора
   HAL_Delay(500);


        //Замерване на броя тикове
        uint32_t start = DWT->CYCCNT;
        {
        for (volatile uint8_t i=0; i<2; i++){}
        }
        uint32_t end = DWT->CYCCNT;

     //Минус 1 защото първия цикъл винаги е с един тик повече от останалите
     //Делено на 3 за броят цикли, така че cycles да приеме стойност на времето
     //Нужно за извършване на един цикъл.
   cycles = ((end - start)-1)/3;

    HAL_GPIO_WritePin(GPIOB, GPIO_PIN_6, 0);

    //Определяне времето за един цикъл
    oneCyclePeriod=(double)cycles/(double)sysclk;

    //Определяне броя цикли нужни за да се достигне RST Time
    forI=(uint32_t)(RSTtime/(oneCyclePeriod*1000000000.0));

     //Активирам Порт B пин 6
   HAL_GPIO_WritePin(GPIOB, GPIO_PIN_6, 1);

   //Измервам необходимото време
   for (volatile uint32_t i=0; i<=forI; i++){}

     //Отново нулирам Порт B пин 6
   HAL_GPIO_WritePin(GPIOB, GPIO_PIN_6, 0);
}