[发明专利]轮式移动机器人的模糊滑模驱动控制方法

权利要求书

1.一种轮式移动机器人的模糊滑模驱动控制方法，包括步骤：1）根据车辆地面力学理论，分析轮式移动机器人刚性车轮与地面的接触特性，建立轮式移动机器人行驶动力学模型；2）根据系统特征，确定系统的控制输入和控制输出，建立以车轮滑转率为系统状态变量的轮式移动机器人控制系统模型；3）设计系统中的模糊控制器和滑模控制器，建立轮式移动机器人驱动控制系统。

2.如权利要求1所述轮式移动机器人的模糊滑模驱动控制方法，其特征在于根据步骤1）中的车辆地面力学理论，轮式移动机器人车轮滑转率                                                定义如下：

                      （1）

式中，ω为车轮的转动角速度，为车轮半径，为车轮移动速度，

所建立的六轮轮式移动机器人单侧行走系统的动力学模型：

       （2）

式中，m为轮式移动机器人的质量，为车轮加速度，为车轮编号，为车轮牵引力，为土壤阻力，I_W为轮式移动机器人车轮转动惯量，为车轮角加速度，为车轮驱动电机输出转矩，为轮式移动机器人车轮阻力矩。

3.如权利要求2所述轮式移动机器人的模糊滑模驱动控制方法，其特征在于所述步骤2）中对轮式移动机器人的滑转率和行驶动力模型综合分析可得轮式移动机器人控制模型的状态空间方程：

      （3）

式中状态变量为车轮滑转率，是控制模型的控制输出变量，为车轮驱动电机的输出转矩，在空间状态方程中为控制输入变量，和分别表达为：

          （4）

式中，、、分别为轮1、2、3的滑转率；

         （5）

式中，、、分别为轮1、2、3驱动电机的输出转矩；

为状态空间方程的常量，为控制模型的控制输入变量系数，表达式分别为：

          （6）

式中，、、分别为轮1、2、3的状态空间方程常量；

          （7）

式中，、、分别为轮1、2、3控制模型的控制输入变量系数；

综合式（1）、式（2）并简化得：

         （8）

   （9）

控制模型中，六轮轮式移动机器人单侧三个车轮的滑转率s为状态变量，车轮电机的输出转矩T为控制模型的输入，其余状态变量为输出。

4.如权利要求1所述轮式移动机器人的模糊滑模驱动控制方法，其特征在于所述步骤4）中的设计系统的滑膜控制器：选取切换面函数：

         （10）

    式中，e为轮式移动机器人实际滑转率与期望滑转率的误差,为时间，采取指数趋近律：

   （11）

式中，是指数趋近项，其解为，和为常数；

设计模糊控制器，利用matlab中的模糊逻辑控制模块建立二维模糊控制器，模糊控制器的其中一个输入为车轮的实际滑转率与期望滑转率之间的误差以及误差变化率之和，另外一个输入变量为车轮的实际滑转率与期望滑转率之间的误差以及误差变化率之和的变化率，即，输出为趋近律控制参数，描述输入输出变量值的子集分别为S=[N=负,Z=零,P=正]，其中N、Z、P分别为三个不同的语言变量；=[ N=负,Z=零,P=正]及U=[ N=负,Z=零,P=正]；输入输出的变化范围均为(-3,3)；根据控制经验，采取的控制的规则为：

若S 是 A，且是 B，则 U 是 C；

模糊控制表如表1所示

表1 模糊控制规则表

。