嵌入式案例使用RT-Thread和STM32实现机器人驱动控制模型算法
时间:
概述机器人运动系统是一组非线性系统,其复杂度高,耦合度高且驱动力小于人体的物理自由度。为了实现机器人在太空中的稳定运动姿态控制,本设计采用了机器人运动系统在太空中的运动。
该形式等效于旋转倒立摆模型。根据模型的运动特性,分别设计了速度闭环控制算法和角度闭环控制算法。
双闭环控制算法用于实现对空间中旋转倒立摆的稳定控制。开发环境硬件:设计硬件依赖于ART-PI开发平台。
主控芯片采用STM32H750高性能单片机,TB6612芯片用作旋转倒立摆的核心动力驱动。霍尔传感器用作速度采集,高精度电位计使用。
作为摆臂角度采集传感器,OLED屏幕用于参数显示和实时调整。 RT-Thread版本:RT-Thread版本使用4.0.2开发工具和版本:mdk5.32版本RT-Thread使用概述本设计使用rt-thread4.0.2master版本,使用操作系统的完整内核FinSH控制平台交互,SPI驱动器,ADC驱动器,编码器驱动器,PWM驱动器和其他相关系统驱动器,并编写双闭环PID控制算法。
软件框架表明,该设计的硬件平台基于ART-PI,并且核心部分已修复。对于旋转倒立摆的机械部分,其结构如下图所示:软件模块显示,此设计的最关键部分是针对倒立摆的PID算法的实现。
运动特性已得到优化和调整。 PID算法的实现基于经典控制理论中线性控制的理论基础:在工程实践中,最广泛使用的调节器控制律是比例,积分和微分控制,称为PID控制,称为PID调节[ 6]。
自问世以来,PID控制器已有近70年的历史。它具有结构简单,稳定性好,工作可靠,调整方便等特点,已成为工业控制的主要技术之一。
当无法完全掌握受控对象的结构和参数,或者无法获得准确的数学模型,并且难以采用其他控制理论技术时,必须根据经验和现场经验确定系统控制器的结构和参数。现场调试。
在积分控制中,其中,控制器的输出与输入误差信号的积分成比例。对于自动控制系统,如果在进入稳态后存在稳态误差,则称该控制系统具有稳态误差或简称差的系统。
为了消除稳态误差,使用“积分项”来表示稳态误差。必须在控制器中引入。
积分项的误差取决于时间的积分。随着时间的增加,积分项将增加。
这样,即使误差很小,积分项也会随着时间的增加而增加,这会促使控制器的输出增加,从而使稳态误差进一步减小,直到它等于零为止。因此,比例加积分(PI)控制器可使系统在进入稳态后不会出现稳态误差。
微分(D)控制在微分控制中,控制器的输出与输入误差信号的微分(即误差变化率)成比例。在调整过程中,自动控制系统可能会振荡甚至失去稳定性,以克服该错误。
原因是存在较大的惯性分量(链接)或磁滞分量,它们具有抑制误差的作用,并且它们的变化始终滞后于误差的变化。解决方案是改变抑制误差的作用“超前”,即,当误差接近零时,抑制误差的作用应为零。
也就是说,仅在控制器中引入“比例”一词通常是不够的。比例项的作用仅仅是放大误差的大小。
目前,需要增加“微分项”,以预测误差变化趋势。这样,具有比例微分的控制器可以预先使抑制误差为零或什至为负的控制效果,从而避免了控制量的严重过冲。
因此,对于具有较大惯性或滞后的受控对象,比例微分(PD)控制器可以改善惯性或滞后。
产品资料
行业信息