王 鑫 刘怡明 王明明* 孙晓云
1(石家庄铁道大学电气与电子工程学院 河北 石家庄 050043)2(苏州大学机电工程学院 江苏 苏州 215137)
轮式机器人具有速度快、效率高的优点,广泛应用于矿山检测、市政检测等领域[1-2]。针对轮式机器人无刷直流电机(Brushless Direct Current Motor,BLDCM)驱动系统,传统PID控制策略,速度响应慢、抗干扰能力差、过度依赖精确的数学模型,文献[3-4]将模糊控制与PID结合,虽然不需要精确的数学模型,但隶属度函数的选取需要大量的经验,难达到最好的效果。文献[5-6]将滑模控制应用于BLDCM调速系统,使系统参数变化时不受影响,在内外扰动下系统具有良好的鲁棒性,但滑模控制易出现系统抖振。文献[7]采用指数趋近律滑模算法对BLDCM进行调速控制,但在原点处存在带状高频抖动。文献[8]将神经网络与滑模控制结合,抑制了系统抖振,但未考虑调节时间。文献[9]将分数阶滑模控制应用于消除永磁同步电机系统抖振,同时使系统具有较少的响应时间。文献[10]将内模控制应用于消除内环干扰,使整个系统具有干扰抑制特性。
本文在深入研究轮式机器人运动方式与BLDCM调速的基础上,结合分数阶滑模控制与内模控制提出一种轮式机器人分数阶滑模内模调速新方法。为了验证算法的有效性,通过搭建MATLAB/Simulink与Carsim 联合仿真平台,在不同路面扰动的情况下进行启动加速与速度突变的仿真实验。实验结果表明,分数阶滑模内模速度控制器可以有效地降低速度响应时间,消除干扰,提高系统的鲁棒性。
Carsim是用于车辆动力学的专用仿真软件,可以模拟道路和空气动力输入的响应,并且主要用于预测和模拟总体车辆操纵稳定性。本文借助Carsim的路面输入响应,进行轮式机器人在不同路面下的仿真实验,用于轮式机器人速度控制器的开发。
针对BLDCM为两相导通星形三相六状态的情形,在理想状态下,三相绕组的电压平衡方程式为:
(1)
式中:Ua、Ub、Uc为三相绕组的相电压;ea、eb、ec为三相绕组的反电动势;ia、ib、ic为三相绕组的相电流;M为各相绕组之间的互感;r为各相绕组的电阻;L为各相绕组的自感。BLDCM定子绕组产生的电磁转矩可表示为:
(2)
式中:Te为电磁转矩;ω为电机机械角速度。运动方程为:
(3)
式中:TL为负载转矩;J为电机转动惯量;B为阻尼系数。
为了轮式机器人更加灵活、转弯半径更小、适应更多的路况,建立前后四轮差速控制模型,将轮式机器人抽象成前、后两个转向模型进行分析,前后轮差速转向模型的转矩分配状态直接由转向模型进行确立。模型中内外轮的转矩比为:
(4)
式中:W为轮距;H为轮式机器人质心到地面的高度;w为电机机械角速度;V为轮式机器人速度;g为重心加速度;θ为转向角度。在转向过程中,内外侧轮的转矩差为ΔTp:
(5)
轮式机器人内外侧轮在转向过程中所需的实际转矩分别为:
Tin=Te-ΔTp
(6)
Tout=Te+ΔTp
(7)
根据轮式机器人运动方式,利用MATLAB/Simulink与Carsim建立四轮差速运动模型,通过Simulink和Carsim的接口设置来完成轮式检测机器人的驱动系统与整车模型之间的信号传递, 实现将电机转矩直接加载到车轮上。每一个车轮由一个BLDCM进行控制。Carsim系统输入输出如表1所示。
表1 Carsim系统输入输出
Simulink和Carsim控制结构如图1所示。
图1 控制结构
分数阶滑模控制是由分数阶算子与滑模控制结合而成的。一般将分数阶微积分的基本操作算子定义为aDta,具体形式为:
(8)
式中:a为阶次,Re(a)为其实部;α是操作算子的下限,t为上限;τ为积分的导数。
随着对分数阶的认知与分析,常用的为Grünwald-Letnikov(GL型)、Caputo(C型)和Riemann-Liouville(RL型)。
其中RL型分数阶微积分定义为:
(9)