112 lines
3.7 KiB
C
112 lines
3.7 KiB
C
//
|
|
// Created by cfif on 07.09.22.
|
|
//
|
|
#include <SystemDelayInterface.h>
|
|
#include "PwmCaptureFlagchip.h"
|
|
#include "PwmFlagchip.h"
|
|
|
|
void Get_Set_Tpu_PwmCaptureCallback(tPwmCaptureFlagchip *env) {
|
|
if (env->etpu_captureconfig_tbl.eMeasureMode == TPU_PeriodMeasurement) {
|
|
TPU_CaptureMeasPeriodServiceReq(env->TPU_CAPTURE_CHANNEL, &env->etpu_captureconfig_tbl);
|
|
} else {
|
|
TPU_CaptureMeasActivePeriodServiceReq(env->TPU_CAPTURE_CHANNEL, &env->etpu_captureconfig_tbl);
|
|
}
|
|
|
|
tPwmCaptureData data;
|
|
data.ActiveTime = env->etpu_captureconfig_tbl.u32ActiveTime;
|
|
data.PeriodTime = env->etpu_captureconfig_tbl.u32PeriodTime;
|
|
|
|
osMessageQueuePut(env->q_u32PeriodActiveTime, &data, 0, 0);
|
|
}
|
|
|
|
void PWM_Capture_Initial(
|
|
tPwmCaptureFlagchip *env,
|
|
bool isDeInit,
|
|
uint8_t TPU_CAPTURE_CHANNEL,
|
|
uint8 TPU_PRIORITY,
|
|
TPU_EventCallbackType Bsp_Tpu_PwmCallback,
|
|
TPU_TCR1OverflowCallbackType Bsp_Tpu_OverflowCallBack) {
|
|
|
|
env->q_u32PeriodActiveTime = osMessageQueueNew(1, sizeof(tPwmCaptureData), NULL);
|
|
|
|
env->etpu_captureconfig_tbl.u32PeriodTime = 0u;
|
|
env->etpu_captureconfig_tbl.eMeasureMode = TPU_DutyMeasurementActiveHigh;
|
|
env->etpu_captureconfig_tbl.eInputType = TPUE_DETECT_FALLING_EDGE_ONLY;
|
|
env->etpu_captureconfig_tbl.u32SampleTime = PERIOD_TICKS * 4;//80000; // Ensure sample time > period
|
|
env->etpu_captureconfig_tbl.u32ActiveTime = 0;
|
|
env->etpu_captureconfig_tbl.LastTime = 0;
|
|
env->etpu_captureconfig_tbl.StartTime = 0;
|
|
|
|
env->etpu_Int_config_tbl.bEventIntEn = (bool) true;
|
|
env->etpu_Int_config_tbl.bTCR1OverFlowEventIntEn = (bool) true;
|
|
env->etpu_Int_config_tbl.bTCR2OverFlowEventIntEn = (bool) false;
|
|
env->etpu_Int_config_tbl.pEventNotify = Bsp_Tpu_PwmCallback;
|
|
env->etpu_Int_config_tbl.pHSANotify = NULL;
|
|
env->etpu_Int_config_tbl.pTCR1OverflowNotify = Bsp_Tpu_OverflowCallBack;
|
|
env->etpu_Int_config_tbl.pTCR2OverflowNotify = NULL;
|
|
env->etpu_Int_config_tbl.eChTrigType = TPUH_TDL1_OR_TDL2_EVENT_NOT_GATED_BY_TSR;
|
|
|
|
env->TPU_CAPTURE_CHANNEL = TPU_CAPTURE_CHANNEL;
|
|
|
|
if (isDeInit) {
|
|
TPU_DeInit();
|
|
}
|
|
TPU_Init();
|
|
TPU_CaptureModeInit(TPU_CAPTURE_CHANNEL, &env->etpu_captureconfig_tbl);
|
|
TPU_InitChannelInterrupt(TPU_CAPTURE_CHANNEL, &env->etpu_Int_config_tbl);
|
|
|
|
if (TPU_CAPTURE_CHANNEL <= 7) {
|
|
NVIC_SetPriority(TPU0_CH0_7_IRQn, TPU_PRIORITY);
|
|
NVIC_EnableIRQ(TPU0_CH0_7_IRQn);
|
|
} else if (TPU_CAPTURE_CHANNEL <= 15) {
|
|
NVIC_SetPriority(TPU0_CH8_15_IRQn, TPU_PRIORITY);
|
|
NVIC_EnableIRQ(TPU0_CH8_15_IRQn);
|
|
} else if (TPU_CAPTURE_CHANNEL <= 23) {
|
|
NVIC_SetPriority(TPU0_CH16_23_IRQn, TPU_PRIORITY);
|
|
NVIC_EnableIRQ(TPU0_CH16_23_IRQn);
|
|
} else if (TPU_CAPTURE_CHANNEL <= 31) {
|
|
NVIC_SetPriority(TPU0_CH24_31_IRQn, TPU_PRIORITY);
|
|
NVIC_EnableIRQ(TPU0_CH24_31_IRQn);
|
|
}
|
|
|
|
}
|
|
|
|
static uint8_t vGetPwm(tPwmCaptureFlagchip *env) {
|
|
|
|
uint8_t percent = 0;
|
|
|
|
tPwmCaptureData data;
|
|
|
|
osStatus_t cPeriodActiveTime = osMessageQueueGet(env->q_u32PeriodActiveTime, &data, 0, 1000);
|
|
|
|
if (cPeriodActiveTime == osOK) {
|
|
|
|
if ((data.ActiveTime == 0) || (data.PeriodTime == 0)) {
|
|
|
|
cPeriodActiveTime = osMessageQueueGet(env->q_u32PeriodActiveTime, &data, 0, 1000);
|
|
|
|
if (cPeriodActiveTime == osOK) {
|
|
percent = data.ActiveTime * 100 / data.PeriodTime;
|
|
}
|
|
|
|
} else {
|
|
percent = data.ActiveTime * 100 / data.PeriodTime;
|
|
}
|
|
|
|
} else {
|
|
|
|
}
|
|
|
|
return percent;
|
|
}
|
|
|
|
tPwmCaptureIO vPwmCaptureGetIo(tPwmCaptureFlagchip *env) {
|
|
|
|
tPwmCaptureIO io = {
|
|
.env = env,
|
|
.getPwm = (PwmIOCaptureTransaction) vGetPwm,
|
|
};
|
|
|
|
return io;
|
|
}
|