|
@@ -201,29 +201,6 @@ void torsensor_voTorSensorCof(void)
|
|
|
// }
|
|
|
}
|
|
|
|
|
|
-/***************************************************************
|
|
|
- Function: torsensor_voTorSensorInit;
|
|
|
- Description: Torque initialization
|
|
|
- Call by: functions in main loop;
|
|
|
- Input Variables: N/A
|
|
|
- Output/Return Variables: N/A
|
|
|
- Subroutine Call: N/A;
|
|
|
- Reference: N/A
|
|
|
-****************************************************************/
|
|
|
-static LPF_OUT tst_dynOffsetLpf;
|
|
|
-static UWORD tsttorqCadCnt,tsttorqMin=4096,tstdynOffset;
|
|
|
-void torsensor_voTorSensorInit(void)
|
|
|
-{
|
|
|
- torsensor_stTorSensorOut.uwTorqueReg = 0;
|
|
|
- torsensor_stTorSensorOut.uwTorquePu = 0;
|
|
|
- torsensor_stTorSensorOut.uwTorqueLPFPu = 0;
|
|
|
- torsensor_stTorSensorOut.uwTorqueErrorCnt = 0;
|
|
|
- torsensor_stTorSensorOut.blTorqueCaliFlg = FALSE;
|
|
|
- torsensor_stTorSensorOut.blTorqueErrorFlg = FALSE;
|
|
|
- mth_voLPFilterCoef(1000000 / 1, EVENT_1MS_HZ, &tst_dynOffsetLpf.uwKx); //25Hz
|
|
|
- tstdynOffset= iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
|
|
|
- tst_dynOffsetLpf.slY.sw.hi = (SWORD)iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
|
|
|
-}
|
|
|
|
|
|
/*************************************************************************
|
|
|
Local Functions (N/A)
|
|
@@ -539,6 +516,36 @@ void torsensor_voTorADC(void) // need to match ADC_StartConversion(ADC1);
|
|
|
//
|
|
|
//}
|
|
|
|
|
|
+/***************************************************************
|
|
|
+ Function: torsensor_voTorSensorInit;
|
|
|
+ Description: Torque initialization
|
|
|
+ Call by: functions in main loop;
|
|
|
+ Input Variables: N/A
|
|
|
+ Output/Return Variables: N/A
|
|
|
+ Subroutine Call: N/A;
|
|
|
+ Reference: N/A
|
|
|
+****************************************************************/
|
|
|
+static LPF_OUT tst_dynOffsetLpf;
|
|
|
+static UWORD tsttorqCadCnt,tsttorqMin=4096,tstdynOffset;
|
|
|
+void torsensor_voTorSensorInit(void)
|
|
|
+{
|
|
|
+ torsensor_stTorSensorOut.uwTorqueReg = 0;
|
|
|
+ torsensor_stTorSensorOut.uwTorquePu = 0;
|
|
|
+ torsensor_stTorSensorOut.uwTorqueLPFPu = 0;
|
|
|
+ torsensor_stTorSensorOut.uwTorqueErrorCnt = 0;
|
|
|
+ torsensor_stTorSensorOut.blTorqueCaliFlg = FALSE;
|
|
|
+ torsensor_stTorSensorOut.blTorqueErrorFlg = FALSE;
|
|
|
+ mth_voLPFilterCoef(1000000 / 1, EVENT_1MS_HZ, &tst_dynOffsetLpf.uwKx); //25Hz
|
|
|
+ tstdynOffset= iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
|
|
|
+ tst_dynOffsetLpf.slY.sw.hi = (SWORD)iAdc_GetResultPointer(0)[HW_ADC_TORQ_CH];
|
|
|
+
|
|
|
+ tor_pvt_uwOffsetTarget = 0;
|
|
|
+ tor_pvt_uwOffsetMax = 0;
|
|
|
+ tor_pvt_uwOffsetMin = 4096;
|
|
|
+ tor_pvt_ulCnt = 0;
|
|
|
+ tor_pvt_ulCnt2 = 0;
|
|
|
+}
|
|
|
+
|
|
|
|
|
|
/*************************************************************************
|
|
|
Local Functions (N/A)
|