1. 引言
近些年来,两轮自平衡机器人在世界各地的多个控制和机器人研究中心引起了足够的重视[1]。两轮平衡机器人是研究控制系统中各种控制器效果的良好平台[2]。基于倒立摆模型,两轮平衡机器人需要控制作用使自己处于直立位置。目前,两轮平衡机器人的研究者研制了各种类型的控制器,例如线性二次调节器[3] [4]、极点配置控制器[5] [6]、模糊逻辑控制器[7] [8]、比例积分微分控制器[9] [10]。本文旨在设计一种具有在平坦地形上自我平衡能力的两轮平衡机器人的控制器,并研究该控制器在平衡系统中的适用性和性能。利用两个通用测距传感器来检测机器人的当前位置和倾斜角度。整个控制器算法将被编译到C程序中,并存储在微控制器中。机器人的导航由操作员使用RC遥控器进行控制。该机器人能够在平坦的地形上移动和转弯时保持自身平衡。
在控制器设计方面,文献[11]采用PID控制设计了两轮自平衡机器人的控制器,但两轮自平衡机器人具有欠驱动性和较强的耦合性,使得控制效果并不理想。文献[12] [13] [14]采用鲁棒控制与卡尔曼滤波相结合的方法,设计了两轮自平衡车的控制器,该控制器可以随实际情况的变化自适应调节控制参数,在外界干扰较小时取得了较好的控制效果。文献[15] [16]设计了滑模变结构控制器,结合神经网络切换控制,该控制器可以有效克服传统的控制器带来的抖震问题,在两轮自平衡机器人的点镇定,轨迹跟踪等问题上得到了广泛应用。文献[17] [18] [19]设计了一种含有鲁棒项的滑模控制系统,选取机器人的移动位形空间作为积分滑模流形,设计了一种状态反馈积分滑模控制器;文献[20] [21]采用backstepping设计策略,针对滑二轮自平衡移动机器人的自动泊车问题,设计滑模变结构控制器,该控制器把电机电压作为控制输入,使速度可以渐进收敛到期望值。
本文的内容安排如下:第一部分引言介绍了两轮子平衡车的研究现状及其应用场景。第二部分应用拉格朗日力学理论建立了两轮自平衡机器人的动力学模型,第三部分介绍了带有干扰估计的控制器设计方法。第四部分对设定条件下的机器人运行情况进行仿真实验。第五部分对实验结论结果进行了分析。
2. 拉格朗日运动学模型
机器人的框架容纳机器人的两个直流电机、传感器、电路和电池。框架的设计决定了机器人在静止位置或运动时的稳定性和重心。机器人的框架是由原材料铝制成的。使用铝是因为铝材料重量轻、刚性强、坚固耐用,最适合用于平衡机器人。此外,为了使机器人的重心变高,机器人的电池位置将分配在机器人结构的顶部和中心。机器人的轮子是由PE制成的,因为它是一种坚硬而轻便的材料。基于惯性测量获得的测量数据单元(MPU 6050 IMU) IMU提供倾角、当前角速度和加速度读数数据。如图1所示。本文采用文献[16]中所建立的运动学模型。
Figure 1. Two wheeled-self balancing robot coordinate system
图1. 两轮自平衡机器人坐标系
由平衡车的非线性性,本文采用拉格朗日动力学模型建立如式(1)所示的方程
(1)
(1)式中,
为纵向速度,
为横向速度,
为和水平方向倾斜角,
为自平衡机器人转向速度,
,
为机器人的固有参数,
为外界扰动引起的干扰项。各参数值由下式表示:
由力学原理,有
上式中,
为机器人电动机转矩常数,
为机器人电动机电枢电阻。数值代入,可得
(2)
把(2)式代入(1)式,有
(3)
(3)式可看成由两个系统构成,变量
为前向运动控制系统,用于机器人的速度控制,
为转向系统。这样,(3)式可以分解为
(4)
(5)
3. 控制器设计策略
该控制器的设计方法分为两个步骤。
第一步,设计运动子系统和转向子系统的分层滑模控制器,分层滑模控制策略解决内在耦合性控制输入少于控制输出的欠驱动系统是一种行之有效的控制方法,近年来在飞行控制、水下机器人控制等多个领域具有广泛的应用。
第二步,针对非线性因素无法精确建模的情况,利用在线干扰估计技术来估计系统中的干扰项,作为前馈补偿项对滑模控制器进行前馈补偿,只需要计算干扰项和其估计误差的上界,这样系统的精度和鲁棒性都可以提高。
考虑(4)式所代表的运动系统,该系统可分为如下两个子系统:
(6)
(7)
令
表示各量的期望值,跟踪误差定义为:
(8)
针对系统(6)和(7),定义如下滑模面
(9)
然后定义第二层滑模面:
(10)
沿滑模面
求导,可得
令
,可以得到
(11)
同理可得
(12)
设
由式(3)和(4)可知,
,
作为系统中的不确定性干扰项很难通过计算来确定,这里通过在线干扰估计
和
。
为采样时刻控制电压值,
和
的估计值为
和
,T为离散系统采样周期。T取值应尽可能小。把
和
作为前馈补偿加入到之前设计的分层滑模控制器中。前馈补偿控制器可以设计为
,
,令
则所设计的基于干扰的滑模控制器为
下面证明所设计的控制器的稳定性:
令
,则
令
,则有
故系统为渐近稳定的。
4. 仿真结果
假设小车的初始位置为0 m,初始速度为0 m/s,初始倾斜角度为0.10,初始角速度为0,小车由静止状态起步,期望信号为
,干扰为
,
,根据本文所设计的控制器仿真,结果如下图2:
Figure 2. Two wheeled-self balancing robot position tracking curve over time
图2. 两轮自平衡机器人位置跟踪随时间变化曲线
5. 结论
在所设计的带有估计的滑模控制器作用下,在t = 2 s时,系统达到稳定状态,和水平面的夹角保持在0度左右,响应速度较快,在仿真过程中,所加入的干扰也符合实际情形,两轮自平衡机器人能够较好的跟踪所给定的信号,说明所设计的控制器具有良好的效果。