用上位机给STM32直流驱动板发指令,STM32完成上位机指令后,但由于编码器计数未清零,指令不能连续发送,该怎么办?
s32 pwm;
extern s16 dAngle;
//s16 Now_position;
void Speed_control(s16 set_Position,s16 set_Speed)
{
pwm+=PID(set_Speed,dAngle); //速度环PID控制,输出PWM控制量
if(pwm>10000)
pwm=9000;
if(pwm<0)
pwm=500;
// TIM1->CCR1=pwm;
if(set_Position==TIM2->CNT)
{
TIM1->CCR1=0x0000;
TIM1->CCR2=0x0000;
// delay_ms(1000);
// flag=1;
}
else if(set_Position>TIM2->CNT)
{
TIM1->CCR1=pwm;
TIM1->CCR2=0x0000;
}
else if(set_Position<TIM2->CNT)
{
TIM1->CCR1=0x0000;
TIM1->CCR2=pwm;
}
}
用TIM2进行编码器计数,通过电脑串口设置set_Position(位置),set_Speed(速度)
设置转9000个脉冲,但由于电机惯性,编码器计数显示9231个脉冲,怎么让误差减小?
当驱动板完成指令电机停止后,怎么让编码器的计数清零,为下一次指令接收做好准备?
|