// Copyright 2020 Rob Riggs <rob@mobilinkd.com>
// All rights reserved.

#include "AFSKModulator.hpp"

namespace mobilinkd { namespace tnc {

void AFSKModulator::init(const kiss::Hardware& hw)
{
    set_twist(hw.tx_twist);

    SysClock48();

#ifndef NUCLEOTNC
    // Configure 48MHz clock for 26.4ksps.
    htim7.Init.Period = 1817;
#else
    // Using an 80MHz clock on NucleoTNC.
    htim7.Init.Period = 3029;
#endif
    if (HAL_TIM_Base_Init(&htim7) != HAL_OK)
    {
        ERROR("htim7 init failed");
        CxxErrorHandler();
    }

    DAC_ChannelConfTypeDef sConfig;

    sConfig.DAC_SampleAndHold = DAC_SAMPLEANDHOLD_DISABLE;
    sConfig.DAC_Trigger = DAC_TRIGGER_NONE;
    sConfig.DAC_OutputBuffer = DAC_OUTPUTBUFFER_ENABLE;
    sConfig.DAC_ConnectOnChipPeripheral = DAC_CHIPCONNECT_ENABLE;
    sConfig.DAC_UserTrimming = DAC_TRIMMING_FACTORY;
    if (HAL_DAC_ConfigChannel(&hdac1, &sConfig, DAC_CHANNEL_1) != HAL_OK)
    {
      CxxErrorHandler();
    }

    if (HAL_DAC_SetValue(&hdac1, DAC_CHANNEL_1, DAC_ALIGN_12B_R, 2048) != HAL_OK) CxxErrorHandler();
    if (HAL_DAC_Start(&hdac1, DAC_CHANNEL_1) != HAL_OK) CxxErrorHandler();
}

}} // mobilinkd::tnc