一种基于低通滤波的倒立摆控制方法、装置及系统
摘要:
本发明公开了一种基于低通滤波的倒立摆控制方法、装置及系统,获取倒立摆摆杆角度信息和旋转臂位置信息;根据倒立摆摆杆角度信息,判断当前运动状态;基于当前运动状态,根据得到的倒立摆摆杆角度信息和旋转臂位置信息,结合预设的旋摆杆目标角度、旋转臂目标位置,通过双环低通滤波PID算法计算电机PWM输出值;根据计算得到的电机PWM输出值,发出指令控制电机转速。控制器中直接加入低通滤波器,预测摆杆运动姿态,减小倒立摆惯性与干扰影响,保持摆杆稳定。该装置具有较高的可靠性和稳定度,可实现系统的多样化控制,且整个装置结构简单,成本较低。
0/0