|
@@ -245,7 +245,7 @@ static __INLINE void PMSM_FOC_Update_Hardware(void) {
|
|
|
SinCos_Lut(_gFOC_Ctrl.in.s_motAngle, &_gFOC_Ctrl.out.sin, &_gFOC_Ctrl.out.cos);
|
|
SinCos_Lut(_gFOC_Ctrl.in.s_motAngle, &_gFOC_Ctrl.out.sin, &_gFOC_Ctrl.out.cos);
|
|
|
|
|
|
|
|
_gFOC_Ctrl.in.s_motRPM = motor_encoder_get_speed();
|
|
_gFOC_Ctrl.in.s_motRPM = motor_encoder_get_speed();
|
|
|
- _gFOC_Ctrl.in.s_vDC = get_vbus_int();
|
|
|
|
|
|
|
+ _gFOC_Ctrl.in.s_vDC = get_vbus_float();
|
|
|
//sample current
|
|
//sample current
|
|
|
phase_current_get(_gFOC_Ctrl.in.s_iABC);
|
|
phase_current_get(_gFOC_Ctrl.in.s_iABC);
|
|
|
get_phase_vols(_gFOC_Ctrl.in.s_vABC);
|
|
get_phase_vols(_gFOC_Ctrl.in.s_vABC);
|
|
@@ -297,7 +297,7 @@ static __INLINE void PMSM_FOC_Update_PI_Idq(void) {
|
|
|
|
|
|
|
|
static u32 PMSM_FOC_Debug_Task(void *p) {
|
|
static u32 PMSM_FOC_Debug_Task(void *p) {
|
|
|
if (_gFOC_Ctrl.in.b_motEnable) {
|
|
if (_gFOC_Ctrl.in.b_motEnable) {
|
|
|
- //plot_3data16(FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[0]), FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[1]), FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[2]));
|
|
|
|
|
|
|
+ plot_3data16(FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[0]), FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[1]), FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[2]));
|
|
|
//plot_3data16(FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[0]), FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[1]), _gFOC_Ctrl.in.s_motRPM);
|
|
//plot_3data16(FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[0]), FtoS16x10(_gFOC_Ctrl.in.s_iABCFilter[1]), _gFOC_Ctrl.in.s_motRPM);
|
|
|
//plot_3data16(FtoS16x10(_gFOC_Ctrl.out.s_RealIdq.d), FtoS16x10(_gFOC_Ctrl.out.s_RealIdq.q), FtoS16x10(_gFOC_Ctrl.idq_ctl[1].s_FinalTgt));
|
|
//plot_3data16(FtoS16x10(_gFOC_Ctrl.out.s_RealIdq.d), FtoS16x10(_gFOC_Ctrl.out.s_RealIdq.q), FtoS16x10(_gFOC_Ctrl.idq_ctl[1].s_FinalTgt));
|
|
|
//plot_3data16( _gFOC_Ctrl.in.s_motRPM, speed_td.target, speed_td.diff);
|
|
//plot_3data16( _gFOC_Ctrl.in.s_motRPM, speed_td.target, speed_td.diff);
|