452 lines
14 KiB
C
452 lines
14 KiB
C
//###########################################################################
|
|
//
|
|
// FILE: sdfm.c
|
|
//
|
|
// TITLE: C28x SDFM Driver
|
|
//
|
|
//###########################################################################
|
|
// $Copyright:
|
|
// Copyright (C) 2022 Texas Instruments Incorporated - http://www.ti.com
|
|
//
|
|
// Redistribution and use in source and binary forms, with or without
|
|
// modification, are permitted provided that the following conditions
|
|
// are met:
|
|
//
|
|
// Redistributions of source code must retain the above copyright
|
|
// notice, this list of conditions and the following disclaimer.
|
|
//
|
|
// Redistributions in binary form must reproduce the above copyright
|
|
// notice, this list of conditions and the following disclaimer in the
|
|
// documentation and/or other materials provided with the
|
|
// distribution.
|
|
//
|
|
// Neither the name of Texas Instruments Incorporated nor the names of
|
|
// its contributors may be used to endorse or promote products derived
|
|
// from this software without specific prior written permission.
|
|
//
|
|
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
// "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
// LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
// A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
// OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
// SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
// LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
// DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
// THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
// (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
// OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
// $
|
|
//###########################################################################
|
|
|
|
#include "sdfm.h"
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// Defines for filter configurations. Not intended for use by application code.
|
|
//
|
|
//*****************************************************************************
|
|
//
|
|
// Get filter oversampling ratio
|
|
//
|
|
#define SDFM_GET_OSR(C) ((C) >> 8U)
|
|
|
|
//
|
|
// Maximum acceptable comparator filter oversampling ratio
|
|
//
|
|
#define SDFM_MAX_COMP_FILTER_OSR 31U
|
|
|
|
//
|
|
// Maximum acceptable data filter oversampling ratio
|
|
//
|
|
#define SDFM_MAX_DATA_FILTER_OSR 255U
|
|
|
|
//
|
|
// Get the filter type
|
|
//
|
|
#define SDFM_GET_FILTER_TYPE(C) ((C) & 0x30U)
|
|
|
|
//
|
|
// Get the filter number
|
|
//
|
|
#define SDFM_GET_FILTER_NUMBER(C) ((C) & 0x3U)
|
|
|
|
//
|
|
// Get the zero-crossing high threshold
|
|
//
|
|
#define SDFM_GET_ZHIGH_THRESHOLD(C) ((C) & 0x7FFFU))
|
|
#define SDFM_ZHIGH_ENABLE_MASK 0x8000U
|
|
|
|
//
|
|
// Get data shift value
|
|
//
|
|
#define SDFM_GET_SHIFT_VALUE(C) (((C) >> 2U) & 0x1FU)
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// SDFM_configComparator
|
|
//
|
|
//*****************************************************************************
|
|
void SDFM_configComparator(uint32_t base, uint16_t config1, uint32_t config2,
|
|
uint16_t config3)
|
|
{
|
|
SDFM_FilterNumber filter;
|
|
uint16_t ratio;
|
|
SDFM_FilterType filterType;
|
|
|
|
filter = (SDFM_FilterNumber)(SDFM_GET_FILTER_NUMBER(config1));
|
|
ratio = SDFM_GET_OSR(config1);
|
|
filterType = (SDFM_FilterType)SDFM_GET_FILTER_TYPE(config1);
|
|
|
|
//
|
|
// Limit the oversampling ratio
|
|
//
|
|
if(ratio > SDFM_MAX_COMP_FILTER_OSR)
|
|
{
|
|
ratio = SDFM_MAX_COMP_FILTER_OSR;
|
|
}
|
|
|
|
//
|
|
// Set the comparator filter type
|
|
//
|
|
SDFM_setComparatorFilterType(base, filter, filterType);
|
|
|
|
//
|
|
// Set the comparator filter over sampling ratio
|
|
//
|
|
SDFM_setCompFilterOverSamplingRatio(base, filter, ratio);
|
|
|
|
//
|
|
// Set the comparator high threshold value
|
|
//
|
|
SDFM_setCompFilterHighThreshold(base, filter,
|
|
SDFM_GET_HIGH_THRESHOLD(config2));
|
|
|
|
//
|
|
// Set the comparator low threshold value
|
|
//
|
|
SDFM_setCompFilterLowThreshold(base, filter,
|
|
SDFM_GET_LOW_THRESHOLD(config2));
|
|
|
|
|
|
//
|
|
// If requested, enable and set the zero-cross high threshold value
|
|
//
|
|
if((config3 & SDFM_ZHIGH_ENABLE_MASK) != 0U)
|
|
{
|
|
SDFM_setCompFilterZeroCrossThreshold(base, filter,
|
|
SDFM_GET_ZHIGH_THRESHOLD(config3);
|
|
SDFM_enableZeroCrossEdgeDetect(base, filter);
|
|
}
|
|
}
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// SDFM_configEnhancedComparator
|
|
//
|
|
//*****************************************************************************
|
|
void SDFM_configEnhancedComparator(uint32_t base, uint16_t filterConfig,
|
|
uint32_t highLowThreshold1,
|
|
uint32_t highLowThreshold2,
|
|
uint16_t zeroCrossThreshold)
|
|
{
|
|
SDFM_FilterNumber filter;
|
|
uint16_t ratio;
|
|
SDFM_FilterType filterType;
|
|
|
|
filter = (SDFM_FilterNumber)(SDFM_GET_FILTER_NUMBER(filterConfig));
|
|
ratio = SDFM_GET_OSR(filterConfig);
|
|
filterType = (SDFM_FilterType)SDFM_GET_FILTER_TYPE(filterConfig);
|
|
|
|
//
|
|
// Limit the oversampling ratio
|
|
//
|
|
if(ratio > SDFM_MAX_COMP_FILTER_OSR)
|
|
{
|
|
ratio = SDFM_MAX_COMP_FILTER_OSR;
|
|
}
|
|
|
|
//
|
|
// Set the comparator filter type
|
|
//
|
|
SDFM_setComparatorFilterType(base, filter, filterType);
|
|
|
|
//
|
|
// Set the comparator filter over sampling ratio
|
|
//
|
|
SDFM_setCompFilterOverSamplingRatio(base, filter, ratio);
|
|
|
|
//
|
|
// Set the comparator high threshold value
|
|
//
|
|
SDFM_setCompFilterHighThreshold(base, filter,
|
|
SDFM_GET_HIGH_THRESHOLD_BOTH(highLowThreshold1,
|
|
highLowThreshold2));
|
|
|
|
//
|
|
// Set the comparator low threshold value
|
|
//
|
|
SDFM_setCompFilterLowThreshold(base, filter,
|
|
SDFM_GET_LOW_THRESHOLD_BOTH(highLowThreshold1,
|
|
highLowThreshold2));
|
|
|
|
//
|
|
// If requested, enable and set the zero-cross high threshold value
|
|
//
|
|
if((zeroCrossThreshold & SDFM_ZHIGH_ENABLE_MASK) != 0U)
|
|
{
|
|
SDFM_setCompFilterZeroCrossThreshold(base, filter,
|
|
SDFM_GET_ZHIGH_THRESHOLD(zeroCrossThreshold);
|
|
SDFM_enableZeroCrossEdgeDetect(base, filter);
|
|
}
|
|
}
|
|
//*****************************************************************************
|
|
//
|
|
// SDFM_configDataFilter
|
|
//
|
|
//*****************************************************************************
|
|
void SDFM_configDataFilter(uint32_t base, uint16_t config1, uint16_t config2)
|
|
{
|
|
SDFM_FilterNumber filter;
|
|
uint16_t ratio;
|
|
SDFM_FilterType filterType;
|
|
|
|
filter = (SDFM_FilterNumber)(SDFM_GET_FILTER_NUMBER(config1));
|
|
ratio = SDFM_GET_OSR(config1);
|
|
filterType = (SDFM_FilterType)SDFM_GET_FILTER_TYPE(config1);
|
|
|
|
//
|
|
// Limit the oversampling ratio
|
|
//
|
|
if(ratio > SDFM_MAX_DATA_FILTER_OSR)
|
|
{
|
|
ratio = SDFM_MAX_DATA_FILTER_OSR;
|
|
}
|
|
|
|
//
|
|
// Set the comparator filter type
|
|
//
|
|
SDFM_setFilterType(base, filter, filterType);
|
|
|
|
//
|
|
// Set the comparator filter over sampling ratio
|
|
//
|
|
SDFM_setFilterOverSamplingRatio(base, filter, ratio);
|
|
|
|
//
|
|
// If filter switch on
|
|
//
|
|
if((config2 & SDFM_FILTER_ENABLE) == SDFM_FILTER_ENABLE)
|
|
{
|
|
SDFM_enableFilter(base, filter);
|
|
}
|
|
else
|
|
{
|
|
SDFM_disableFilter(base, filter);
|
|
}
|
|
|
|
//
|
|
// Set output data format
|
|
//
|
|
SDFM_setOutputDataFormat(base, filter,
|
|
(SDFM_OutputDataFormat)(config2 & 0x1U));
|
|
|
|
//
|
|
// Set the shift value if data is in 16-bit 2's complement format
|
|
//
|
|
if((config2 & 0x1U) == (uint16_t)(SDFM_DATA_FORMAT_16_BIT))
|
|
{
|
|
SDFM_setDataShiftValue(base, filter, SDFM_GET_SHIFT_VALUE(config2));
|
|
}
|
|
}
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// SDFM_configZeroCrossComparator
|
|
//
|
|
//*****************************************************************************
|
|
void SDFM_configZeroCrossComparator(uint32_t base, uint16_t config1,
|
|
uint16_t config2)
|
|
{
|
|
SDFM_FilterNumber filter;
|
|
uint16_t ratio;
|
|
SDFM_FilterType filterType;
|
|
|
|
filter = (SDFM_FilterNumber)(SDFM_GET_FILTER_NUMBER(config1));
|
|
ratio = SDFM_GET_OSR(config1);
|
|
filterType = (SDFM_FilterType)SDFM_GET_FILTER_TYPE(config1);
|
|
|
|
//
|
|
// Limit the oversampling ratio
|
|
//
|
|
if(ratio > SDFM_MAX_COMP_FILTER_OSR)
|
|
{
|
|
ratio = SDFM_MAX_COMP_FILTER_OSR;
|
|
}
|
|
|
|
//
|
|
// Set the comparator filter type
|
|
//
|
|
SDFM_setComparatorFilterType(base, filter, filterType);
|
|
|
|
//
|
|
// Set the comparator filter over sampling ratio
|
|
//
|
|
SDFM_setCompFilterOverSamplingRatio(base, filter, ratio);
|
|
|
|
//
|
|
// Set the zero cross threshold value
|
|
//
|
|
SDFM_setCompFilterZeroCrossThreshold(base, filter, config2);
|
|
}
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// SDFM_configDataFilterFIFO
|
|
//
|
|
//*****************************************************************************
|
|
void SDFM_configDataFilterFIFO(uint32_t base, uint16_t config1,
|
|
uint16_t config2)
|
|
{
|
|
SDFM_FilterNumber filter;
|
|
uint16_t ratio;
|
|
uint16_t fifoLevel;
|
|
SDFM_FilterType filterType;
|
|
|
|
filter = (SDFM_FilterNumber)(SDFM_GET_FILTER_NUMBER(config1));
|
|
fifoLevel = ((config2 >> 7U) & 0x1FU);
|
|
ratio = SDFM_GET_OSR(config1);
|
|
filterType = (SDFM_FilterType)SDFM_GET_FILTER_TYPE(config1);
|
|
|
|
//
|
|
// Limit the oversampling ratio
|
|
//
|
|
if(ratio > SDFM_MAX_DATA_FILTER_OSR)
|
|
{
|
|
ratio = SDFM_MAX_DATA_FILTER_OSR;
|
|
}
|
|
|
|
//
|
|
// Set the comparator filter type
|
|
//
|
|
SDFM_setFilterType(base, filter, filterType);
|
|
|
|
//
|
|
// Set the comparator filter over sampling ratio
|
|
//
|
|
SDFM_setFilterOverSamplingRatio(base, filter, ratio);
|
|
|
|
//
|
|
// If filter switch on
|
|
//
|
|
if((config2 & SDFM_FILTER_ENABLE) == SDFM_FILTER_ENABLE)
|
|
{
|
|
SDFM_enableFilter(base, filter);
|
|
}
|
|
else
|
|
{
|
|
SDFM_disableFilter(base, filter);
|
|
}
|
|
|
|
//
|
|
// Set output data format
|
|
//
|
|
SDFM_setOutputDataFormat(base, filter,
|
|
(SDFM_OutputDataFormat)(config2 & 0x1U));
|
|
|
|
//
|
|
// Set the shift value if data is in 16bit 2's complement format
|
|
//
|
|
if((config2 & 0x1U) == (uint16_t)(SDFM_DATA_FORMAT_16_BIT))
|
|
{
|
|
SDFM_setDataShiftValue(base, filter, SDFM_GET_SHIFT_VALUE(config2));
|
|
}
|
|
|
|
//
|
|
// Set the FIFO level
|
|
//
|
|
SDFM_setFIFOInterruptLevel(base, filter, fifoLevel);
|
|
SDFM_enableFIFOBuffer(base, filter);
|
|
}
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// SDFM_configCompEventLowFilter
|
|
//
|
|
//*****************************************************************************
|
|
void
|
|
SDFM_configCompEventLowFilter(uint32_t base, SDFM_FilterNumber filterNumber,
|
|
const SDFM_CompEventFilterConfig *config)
|
|
{
|
|
uint32_t address;
|
|
ASSERT(SDFM_isBaseValid(base));
|
|
ASSERT(config->clkPrescale <= SDFM_SDCOMP1EVT2FLTCLKCTL_CLKPRESCALE_M);
|
|
ASSERT((config->sampleWindow - 1U) <= (SDFM_SDCOMP1EVT2FLTCTL_SAMPWIN_M >>
|
|
SDFM_SDCOMP1EVT2FLTCTL_SAMPWIN_S));
|
|
ASSERT(config->threshold <= (SDFM_SDCOMP1EVT2FLTCTL_THRESH_M >>
|
|
SDFM_SDCOMP1EVT2FLTCTL_THRESH_S));
|
|
ASSERT(config->threshold > ((config->sampleWindow - 1U) / 2U));
|
|
|
|
address = base + SDFM_O_SDCOMP1EVT2FLTCTL +
|
|
((uint32_t)filterNumber * SDFM_DIGFIL_OFFSET);
|
|
|
|
//
|
|
// Configure sample window & threshold.
|
|
//
|
|
EALLOW;
|
|
HWREGH(address) = (HWREGH(address) & ~(SDFM_COMPEVT_FILTER_CONFIG_M)) |
|
|
(((config->sampleWindow - 1U) << SDFM_SDCOMP1EVT2FLTCTL_SAMPWIN_S) |
|
|
(config->threshold << SDFM_SDCOMP1EVT2FLTCTL_THRESH_S));
|
|
|
|
//
|
|
// Configure clock pre-scale.
|
|
//
|
|
address = base + SDFM_O_SDCOMP1EVT2FLTCLKCTL +
|
|
((uint32_t)filterNumber * SDFM_DIGFIL_OFFSET);
|
|
HWREGH(address) = (HWREGH(address) &
|
|
~(SDFM_SDCOMP1EVT2FLTCLKCTL_CLKPRESCALE_M)) |
|
|
(config->clkPrescale);
|
|
EDIS;
|
|
}
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// SDFM_configCompEventHighFilter
|
|
//
|
|
//*****************************************************************************
|
|
void
|
|
SDFM_configCompEventHighFilter(uint32_t base, SDFM_FilterNumber filterNumber,
|
|
const SDFM_CompEventFilterConfig *config)
|
|
{
|
|
uint32_t address;
|
|
ASSERT(SDFM_isBaseValid(base));
|
|
ASSERT(config->clkPrescale <= SDFM_SDCOMP1EVT1FLTCLKCTL_CLKPRESCALE_M);
|
|
ASSERT((config->sampleWindow - 1U) <= (SDFM_SDCOMP1EVT1FLTCTL_SAMPWIN_M >>
|
|
SDFM_SDCOMP1EVT1FLTCTL_SAMPWIN_S));
|
|
ASSERT(config->threshold <= (SDFM_SDCOMP1EVT1FLTCTL_THRESH_M >>
|
|
SDFM_SDCOMP1EVT1FLTCTL_THRESH_S));
|
|
ASSERT(config->threshold > ((config->sampleWindow - 1U) / 2U));
|
|
|
|
address = base + SDFM_O_SDCOMP1EVT1FLTCTL +
|
|
((uint32_t)filterNumber * SDFM_DIGFIL_OFFSET);
|
|
|
|
//
|
|
// Configure sample window & threshold.
|
|
//
|
|
EALLOW;
|
|
HWREGH(address) = (HWREGH(address) & ~(SDFM_COMPEVT_FILTER_CONFIG_M)) |
|
|
(((config->sampleWindow - 1U) << SDFM_SDCOMP1EVT1FLTCTL_SAMPWIN_S) |
|
|
(config->threshold << SDFM_SDCOMP1EVT1FLTCTL_THRESH_S));
|
|
|
|
//
|
|
// Configure clock pre-scale.
|
|
//
|
|
address = base + SDFM_O_SDCOMP1EVT1FLTCLKCTL +
|
|
((uint32_t)filterNumber * SDFM_DIGFIL_OFFSET);
|
|
HWREGH(address) =
|
|
(HWREGH(address) & ~(SDFM_SDCOMP1EVT1FLTCLKCTL_CLKPRESCALE_M)) |
|
|
(config->clkPrescale);
|
|
EDIS;
|
|
}
|
|
|
|
|