5e9187bc7c
-Enbale fast detect block -Add support for trip generation Fixes: PINDSW-5510, PINDSW-5523 Signed-off-by: Achala Ram <a-ram@ti.com>
363 lines
14 KiB
C
363 lines
14 KiB
C
/*
|
|
* Copyright (C) 2023 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 <drivers/hw_include/tistdtypes.h>
|
|
#include <drivers/hw_include/hw_types.h>
|
|
#include <current_sense/sdfm/include/sdfm_drv.h>
|
|
#include <current_sense/sdfm/include/sdfm_api.h>
|
|
#include <current_sense/sdfm/firmware/icssg_sdfm.h>
|
|
#include <drivers/hw_include/am64x_am243x/cslr_soc_baseaddress.h>
|
|
#include <drivers/soc.h>
|
|
#include <drivers/gpio.h>
|
|
#include <kernel/dpl/AddrTranslateP.h>
|
|
|
|
|
|
//*****************************************************************************
|
|
//
|
|
// Defines for the API.
|
|
//
|
|
//*****************************************************************************
|
|
//! Macro to get the low threshold
|
|
#define SDFM_GET_LOW_THRESHOLD(C) ((uint16_t)(C))
|
|
|
|
//! Macro to get the high threshold
|
|
#define SDFM_GET_HIGH_THRESHOLD(C) ((uint16_t)((uint32_t)(C) >> 16U))
|
|
|
|
//! Macro to get the high threshold 1 & 2 to be passed as lowThreshold
|
|
//! parameter to SDFM_setCompFilterLowThreshold().
|
|
#define SDFM_GET_LOW_THRESHOLD_BOTH(C1, C2) \
|
|
((((uint32_t)(SDFM_GET_LOW_THRESHOLD(C2))) << 16U) | \
|
|
((uint32_t)(SDFM_GET_LOW_THRESHOLD(C1))))
|
|
|
|
//! Macro to get the high threshold 1 & 2 to be passed as highThreshold
|
|
//! parameter to SDFM_setCompFilterHighThreshold().
|
|
#define SDFM_GET_HIGH_THRESHOLD_BOTH(C1, C2) \
|
|
((((uint32_t)(SDFM_GET_HIGH_THRESHOLD(C2))) << 16U) | \
|
|
((uint32_t)(SDFM_GET_HIGH_THRESHOLD(C1))))
|
|
|
|
//! Macro to convert comparator over sampling ratio to acceptable bit location
|
|
#define SDFM_SET_OSR(X) (((X) - 1) << 8U)
|
|
|
|
//! Macro to convert the data shift bit values to acceptable bit location
|
|
#define SDFM_SHIFT_VALUE(X) ((X) << 2U)
|
|
|
|
//! Macro to combine high threshold and low threshold values
|
|
#define SDFM_THRESHOLD(H, L) ((((uint32_t)(H)) << 16U) | (L))
|
|
|
|
//! Macro to set the FIFO level to acceptable bit location
|
|
#define SDFM_SET_FIFO_LEVEL(X) ((X) << 7U)
|
|
|
|
//! Macro to set and enable the zero cross threshold value.
|
|
#define SDFM_SET_ZERO_CROSS_THRESH_VALUE(X) (0x8000 | (X))
|
|
|
|
//! Macros to enable or disable filter.
|
|
#define SDFM_FILTER_DISABLE (0x0U)
|
|
#define SDFM_FILTER_ENABLE (0x2U)
|
|
|
|
//*****************************************************************************
|
|
//
|
|
//! Values that can be returned from SDFM_getThresholdStatus()
|
|
//
|
|
//*****************************************************************************
|
|
#define SDFM_OUTPUT_WITHIN_THRESHOLD (0) //!< SDFM output is within threshold
|
|
#define SDFM_OUTPUT_ABOVE_THRESHOLD (1) //!< SDFM output is above high threshold
|
|
#define SDFM_OUTPUT_BELOW_THRESHOLD (2) //!< SDFM output is below low threshold
|
|
|
|
//! Filter output is in 16 bits 2's complement format.
|
|
#define SDFM_DATA_FORMAT_16_BIT (0)
|
|
//! Filter output is in 32 bits 2's complement format.
|
|
#define SDFM_DATA_FORMAT_32_BIT (1)
|
|
|
|
//! Mask for Interrupt is generated if Modulator fails.
|
|
//!
|
|
#define SDFM_MODULATOR_FAILURE_INTERRUPT_MASK ( 0 )
|
|
//! Mask for Interrupt on Comparator low-level threshold.
|
|
//!
|
|
#define SDFM_LOW_LEVEL_THRESHOLD_INTERRUPT_MASK ( 1 )
|
|
//! Mask for Interrupt on Comparator high-level threshold.
|
|
//!
|
|
#define SDFM_HIGH_LEVEL_THRESHOLD_INTERRUPT_MASK ( 2 )
|
|
//! Mask for Interrupt on Acknowledge flag
|
|
//!
|
|
#define SDFM_DATA_FILTER_ACKNOWLEDGE_INTERRUPT_MASK ( 3 )
|
|
|
|
/* Internal structure for managing each PRU SD */
|
|
//static sdfm g_sdfm[NUM_PRU] = {
|
|
SDFM g_sdfm[NUM_PRU] = {
|
|
{PRU_ID_0,0,0,0, NULL},
|
|
{PRU_ID_1,0,0,0, NULL},
|
|
};
|
|
// static sdfm g_sdfm[NUM_PRU];
|
|
|
|
/* Initialize SDFM instance */
|
|
sdfm_handle SDFM_init(uint8_t pru_id)
|
|
{
|
|
SDFM *p_sdfm;
|
|
|
|
if (pru_id == PRU_ID_0)
|
|
{
|
|
/* Initialize PRU 0 SD */
|
|
|
|
p_sdfm = &g_sdfm[pru_id];
|
|
|
|
/* Initialize SDFM control address */
|
|
p_sdfm->p_sdfm_interface = (SDFM_Interface *)(PRU_ICSSG_DRAM0_SLV_RAM + 0x0);
|
|
|
|
/* Set FW PRU ID */
|
|
p_sdfm->p_sdfm_interface->sdfm_ctrl.sdfm_pru_id = pru_id;
|
|
}
|
|
else if (pru_id == PRU_ID_1)
|
|
{
|
|
/* Initialize PRU 1 SD */
|
|
|
|
p_sdfm = &g_sdfm[pru_id];
|
|
|
|
/* Initialize SDFM control address */
|
|
p_sdfm->p_sdfm_interface = (SDFM_Interface *)(PRU_ICSSG_DRAM0_SLV_RAM + 0x0);
|
|
|
|
/* Set FW PRU ID */
|
|
p_sdfm->p_sdfm_interface->sdfm_ctrl.sdfm_pru_id = pru_id;
|
|
}
|
|
else
|
|
{
|
|
p_sdfm = NULL;
|
|
}
|
|
|
|
return (sdfm_handle)p_sdfm;
|
|
}
|
|
|
|
/*Configuration of iep & pwm time period */
|
|
void SDFM_configIepCount(sdfm_handle h_sdfm, uint32_t epwm_out_freq)
|
|
{
|
|
/*; IEP0 default increment=1*/
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_iep_ptr.iep_inc_value = h_sdfm->iep_inc;
|
|
/*
|
|
IEP0 CMP0 count to simulate EPWM (FOC loop) period:
|
|
- IEP frequency = 300 MHz
|
|
- IEP Default Increment = 1
|
|
- Simulated EPWM frequency = 8e3
|
|
CMP0 = 300e6/1/8e3 = 37500 = 0x927C
|
|
*/
|
|
uint32_t cnt_epwm_prd = h_sdfm->iep_clock/epwm_out_freq;
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_iep_ptr.cnt_epwm_prd = cnt_epwm_prd;
|
|
|
|
}
|
|
|
|
/*ecap configuration for SD clock*/
|
|
void SDFM_configEcap(sdfm_handle h_sdfm, uint8_t ecap_divider)
|
|
{
|
|
/* SD_PRD_CLOCKS divider = 15; SDFM_CLOCK = IEP freq./SD_PRD_CLOCKS; 300/15 => 20 MHz, SD_CLK_INV==0 => No clock inversion*/
|
|
h_sdfm->p_sdfm_interface->sd_clk.sd_prd_clocks = ecap_divider;
|
|
h_sdfm->p_sdfm_interface->sd_clk.sd_clk_inv = 0;
|
|
}
|
|
|
|
/*sdfm Hw osr configuration */
|
|
void SDFM_setCompFilterOverSamplingRatio(sdfm_handle h_sdfm, uint8_t ch_id, uint16_t osr)
|
|
{
|
|
/*Over current OSR*/
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch_id].osr = osr;
|
|
}
|
|
|
|
/*sdfm high, low threshold config */
|
|
void SDFM_setCompFilterThresholds(sdfm_handle h_sdfm, uint8_t ch_id, SDFM_ThresholdParms thresholdParms)
|
|
{
|
|
/* SD Over current high threshold = (Over current OSR)^(Over current SINC ORDER) = 14^3 = 2744*/
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch_id].sdfm_threshold_parms.high_threshold = thresholdParms.high_threshold;
|
|
/* SD Over current low threshold */
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch_id].sdfm_threshold_parms.low_threshold = thresholdParms.low_threshold;
|
|
|
|
}
|
|
|
|
/*sdfm smapling time configuation */
|
|
void SDFM_setSampleTriggerTime(sdfm_handle h_sdfm, float samp_trig_time)
|
|
{ /*convert sample time into IEP count*/
|
|
/*samp time in us */
|
|
int32_t count = (h_sdfm->iep_clock /1000000)*((float)samp_trig_time);
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_trigger.first_samp_trig_time = count;
|
|
|
|
|
|
|
|
}
|
|
/*Second normal current sampling configuration*/
|
|
void SDFM_enableDoubleSampling(sdfm_handle h_sdfm, float samp_trig_time)
|
|
{
|
|
/*Enable double normal current sampling*/
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_trigger.en_double_nc_sampling = 1;
|
|
/*Second sample point*/
|
|
int32_t count = (h_sdfm->iep_clock /1000000)*((float)samp_trig_time);
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_trigger.second_samp_trig_time = count;
|
|
}
|
|
|
|
/*Disable Double update*/
|
|
void SDFM_disableDoubleSampling(sdfm_handle h_sdfm)
|
|
{
|
|
/*Enable double normal current sampling*/
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_trigger.en_double_nc_sampling = 0;
|
|
}
|
|
/* Enable the channel specified by the channel number parameter*/
|
|
void SDFM_setEnableChannel(sdfm_handle h_sdfm, uint8_t channel_number)
|
|
{
|
|
|
|
if(channel_number == 0)
|
|
{
|
|
h_sdfm->p_sdfm_interface->sdfm_ch_ctrl.sdfm_ch_id |= (channel_number << SDFM_CFG_BF_SD_CH0_ID_SHIFT);
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[channel_number].ch_id = channel_number;
|
|
}
|
|
else if(channel_number == 1)
|
|
{
|
|
h_sdfm->p_sdfm_interface->sdfm_ch_ctrl.sdfm_ch_id |= (channel_number<< SDFM_CFG_BF_SD_CH1_ID_SHIFT);
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[channel_number].ch_id = channel_number;
|
|
}
|
|
else
|
|
{
|
|
h_sdfm->p_sdfm_interface->sdfm_ch_ctrl.sdfm_ch_id |= (channel_number << SDFM_CFG_BF_SD_CH2_ID_SHIFT);
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[channel_number].ch_id = channel_number;
|
|
}
|
|
}
|
|
/* set SDFM channel acc source */
|
|
void SDFM_configDataFilter(sdfm_handle h_sdfm, uint8_t ch_id, uint8_t filter)
|
|
{
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch_id].filter_type = filter;
|
|
}
|
|
|
|
/*set clock source & clock inversion for SDFM channel*/
|
|
void SDFM_selectClockSource(sdfm_handle h_sdfm, uint8_t ch_id, SDFM_ClkSourceParms clkPrams)
|
|
{
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch_id].sdfm_clk_parms.clk_source = clkPrams.clk_source;
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch_id].sdfm_clk_parms.clk_inv = clkPrams.clk_inv;
|
|
}
|
|
|
|
/* Enable the comparator feature for a specified filter/channel */
|
|
void SDFM_enableComparator(sdfm_handle h_sdfm, uint8_t ch)
|
|
{
|
|
/*It is setting bits for enable Over current: 0th bit for Over current enable & from 1st bits to 3rd bits are for ch0 to ch2.*/
|
|
h_sdfm->p_sdfm_interface->sdfm_ch_ctrl.enable_comparator |= ((1 << (ch+1))|(1));
|
|
}
|
|
|
|
/* Disable the comparator feature for a specified filter/channel */
|
|
void SDFM_disableComparator(sdfm_handle h_sdfm, uint8_t ch)
|
|
{
|
|
h_sdfm->p_sdfm_interface->sdfm_ch_ctrl.enable_comparator &= (0xFFFF ^ (1<<ch));
|
|
}
|
|
/*GPIO configuration*/
|
|
void SDFM_configComparatorGpioPins(sdfm_handle h_sdfm, uint8_t ch,uint32_t gpio_base_addr, uint32_t pin_number, uint32_t threshold_type)
|
|
{
|
|
|
|
volatile CSL_GpioRegs* hGpio = (volatile CSL_GpioRegs*)((uintptr_t) gpio_base_addr);
|
|
uint32_t reg_index = GPIO_GET_REG_INDEX(pin_number);
|
|
uint32_t reg_val = GPIO_GET_BIT_MASK(pin_number);
|
|
uint32_t clr_data_addr = (uint32_t)&hGpio->BANK_REGISTERS[reg_index].CLR_DATA;
|
|
uint32_t set_data_addr = (uint32_t)&hGpio->BANK_REGISTERS[reg_index].SET_DATA;
|
|
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].sdfm_gpio_params[threshold_type].write_val = reg_val;
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].sdfm_gpio_params[threshold_type].set_val_addr = set_data_addr;
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].sdfm_gpio_params[threshold_type].clr_val_addr = clr_data_addr;
|
|
}
|
|
|
|
/* Get current (or latest) sample for the specified channel */
|
|
uint32_t SDFM_getFilterData(sdfm_handle h_sdfm, uint8_t ch)
|
|
{
|
|
return h_sdfm->sampleOutputInterface->sampleOutput[ch];
|
|
}
|
|
|
|
/*Configure normal current OSR for data filter*/
|
|
void SDFM_setFilterOverSamplingRatio(sdfm_handle h_sdfm, uint16_t nc_osr)
|
|
{
|
|
|
|
/*IEP0 counts in normal current sampling period*/
|
|
uint16_t count;
|
|
uint32_t iep_freq = h_sdfm->iep_clock;
|
|
uint32_t sd_clock = h_sdfm->sdfm_clock;
|
|
count = (int)((float)nc_osr*((float)iep_freq/(float)sd_clock));
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_trigger.nc_prd_iep_cnt = count;
|
|
}
|
|
/*return firmware version */
|
|
uint64_t SDFM_getFirmwareVersion(sdfm_handle h_sdfm)
|
|
{
|
|
return h_sdfm->p_sdfm_interface->firmwareVersion;
|
|
}
|
|
/*FD block confiuration */
|
|
void SDFM_configFastDetect(sdfm_handle h_sdfm, uint8_t ch, uint8_t *fdParms)
|
|
{
|
|
h_sdfm->p_sdfm_interface->sdfm_ch_ctrl.enFastDetect |= 1<<ch;
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].fd_window = fdParms[0];
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].fd_zero_max = fdParms[1];
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].fd_zero_min = fdParms[2];
|
|
|
|
/*Configure one max to window size + 1 and one min to 0, so they never get set*/
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].fd_one_max = (fdParms[0] + 1) * 4 + 1;
|
|
h_sdfm->p_sdfm_interface->sdfm_cfg_ptr[ch].fd_one_min = 0;
|
|
|
|
}
|
|
|
|
/*return status of Trip status bit*/
|
|
uint32_t SDFM_getPwmTripStatus(sdfm_handle h_sdfm, uint8_t pwmIns)
|
|
{
|
|
void *pruss_cfg = h_sdfm->pruss_cfg;
|
|
uint32_t regval;
|
|
regval = HW_RD_REG32((uint8_t *)pruss_cfg + CSL_ICSSCFG_PWM0 + pwmIns * 4);
|
|
regval = regval & CSL_ICSSCFG_PWM0_PWM0_TRIP_S_MASK;
|
|
return regval>>CSL_ICSSCFG_PWM0_PWM0_TRIP_S_SHIFT;
|
|
}
|
|
|
|
/*Clear Trip status bit*/
|
|
void SDFM_clearPwmTripStatus(sdfm_handle h_sdfm, uint8_t pwmIns)
|
|
{
|
|
void *pruss_cfg = h_sdfm->pruss_cfg;
|
|
uint32_t regval;
|
|
regval = HW_RD_REG32((uint8_t *)pruss_cfg + CSL_ICSSCFG_PWM0 + pwmIns * 4);
|
|
regval = regval | CSL_ICSSCFG_PWM0_PWM0_TRIP_RESET_MASK;
|
|
HW_WR_REG32((uint8_t *)pruss_cfg + CSL_ICSSCFG_PWM0 + pwmIns * 4, regval);
|
|
regval = HW_RD_REG32((uint8_t *)pruss_cfg + CSL_ICSSCFG_PWM0 + pwmIns * 4);
|
|
regval = regval & (~ CSL_ICSSCFG_PWM0_PWM0_TRIP_RESET_MASK);
|
|
HW_WR_REG32((uint8_t *)pruss_cfg + CSL_ICSSCFG_PWM0 + pwmIns * 4, regval);
|
|
|
|
}
|
|
/* SDFM global enable */
|
|
void SDFM_enable(sdfm_handle h_sdfm)
|
|
{
|
|
uint8_t sdfm_en_ack;
|
|
|
|
/*Enable SDFM */
|
|
h_sdfm->p_sdfm_interface->sdfm_ctrl.sdfm_en = 1;
|
|
|
|
/* wait for ACK */
|
|
do {
|
|
sdfm_en_ack = h_sdfm->p_sdfm_interface->sdfm_ctrl.sdfm_en_ack;
|
|
} while (sdfm_en_ack != BF_SDFM_EN_ENABLE);
|
|
|
|
|
|
}
|
|
|
|
|