一种新型的两轮自平衡电动车系统控制器的设计方法技术方案

本发明专利技术公开了一种新型的两轮自平衡电动车系统控制器的设计方法。由于两轮自平衡电动车是一种多变量、强耦合、非线性、自然不稳定系统，控制器的设计需要依据准确的数学模型，所以首先要建立两轮自平衡电动车系统的数学模型；其次，由于目前没有一个可以通过计算直接得到最优Q阵和R阵的方法，所以本发明专利技术先用试凑法仿真设计了两轮自平衡电动车系统控制器的雏形；最后运用量子遗传算法优化控制器参数，最终设计出线性二次最优控制器。通过该方法，可以在短时间内设计出符合系统要求的控制器，并能有效地控制两轮车完成各种行驶动作。

【技术实现步骤摘要】

本专利技术涉及系统控制器的优化领域，具体是一种新型的两轮自平衡电动车系统控制器的设计方法。
技术介绍
随着我国城镇化建设的脚步，我国汽车保有量一跃进入世界前列。由此引发了包括环境污染问题、能源问题、交通问题等在内的一系列问题困扰着人们。基于此问题,占用面积小、节能无污染、无转弯半径的两轮自平衡电动车的研发成为各大高科技厂商的研究热点。 对两轮自平衡电动车系统数学模型的建立，常用的方法是牛顿经典力学建模和用拉格朗日方程建模。牛顿经典力学进行系统建模则需对系统的各部分进行受力分析，拉格朗日建模法只考虑系统外部的作用力，而不考虑系统各部分间的相互作用力。针对两轮自平衡车的控制国际上多采用线性二次最优控制、点配置法、自适应神经网络法、模糊控制法等其他混合智能算法。而对已经面世的商品车而言，国外Segway的美国研究人员采用的是模糊PID控制策略；国内乐行体感车采用的是带补偿系数的可变模糊卡尔曼滤波算法。这些研究已取得了很好的成果，但如何进一步地提高效率，以达到更好的效果，还有待于研究。
技术实现思路
专利技术目的：为了进一步提高控制效率，本专利技术提出一种新型的两轮自平衡电动车系统控制器的设计方法，通过该方法，可以在短时间内设计出符合系统控制要求的控制器，使控制系统可以有效控制两轮车完成各种行驶动作。 本专利技术一种新型的两轮自平衡电动车系统控制器的设计方法，包括以下步骤： 1)建立两轮自平衡电动车系统的数学模型，为控制器的设计奠定基础。 2)用试凑法仿真建立两轮自平衡电动车系统的线性二次最优控制器雏形。 3)运用量子遗传算法优化控制器参数。由于加权阵Q和加权阵R的选择会对控制系统的性能指标产生巨大影响。传统的最优控制加权矩阵都是通过经验和多次仿真实验得到的所以控制器的控制效果在一定范围内具有极大的随机性和不定性。为了获得理想的控制性能常常需要反复调整加权阵，反复的试凑不仅影响设计的效率而且不能保证选定的加权阵能提供最优的控制性能。为了解决这一问题，通过量子遗传算法对选取的加权矩阵进行优化，得到优化后的加权矩阵可以更加趋近于系统的最优解。 4)将优化后的控制器参数代入系统，得到更加完善的线性二次最优控制器。 所述的建立两轮自平衡电动车数学模型，使用的方法是用拉格朗日方程建模。 所述的用拉格朗日方程建模，包括以下步骤： (3.1)确定模型的各个物理量，包括：车轮的移动动能T1、转动动能T2、车体的移动动能T3、转动动能T4、车体内的直流减速电动机的转动动能T5，系统总势能V，并得出拉格朗日函数表达式：L＝T-V＝T1+T2+T3+T4+T5-V。其中L为拉格朗日量,T是系统总动能，T＝T1+T2+T3+T4+T5。 (3.2)代入拉格朗日方程得出相应的方程组。 其中，是拉格朗日量，q＝(q1,q2…,qN)是广义坐标的广义变量、F是广义外力、Fθ是车辆前进的主动力、Fφ是车体绕转轴转动的主动力、是车轮的转动主动力。 (3.3)对系统进行线性化，化简方程组。 (3.4)选取车体倾斜角度φ、车体倾斜角速度车轮转过角度θ、车轮转动角速度整车转动角度和整车转角角速度作为系统的状态变量,便可得出车辆的运动状态方程组。 Ul、Ur为驱动两个车轮的两个直流电动机的电枢电压，A、B、C、D为状态方程的系数矩阵。 (3.5)判断系统模型的能控和能观性。 所述步骤(3.5)，具体操作为： (4.1)得到步骤(3.4)的状态方程的系数矩阵A、B、C、D；。 (4.2)利用Matlab命令ctrb、obsv得出两轮自平衡电动车的可控矩阵、可观矩阵。 (4.3)利用Matlab命令rank求得可控和可观矩阵的秩，根据矩阵是否满秩来判断系统是否可控可观。 在所述步骤2)中，包括以下步骤： (5.1)根据二次型性能指标函数，初步确定对角线矩阵加权阵Q和R。 (5.2)用Simulink仿真软件，给系统任意一个输入，得到系统的响应结果曲线。通过反复试凑Q和R阵对角线元素值，选择符合性能指标要求的值。 3)由系统状态方程组中的系数矩阵A,B，以及线性二次型最优控制器加权矩阵Q、R，在Matlab中运用命令K＝lqr(A,B,Q,R)，求取使得二次型性能指标为最小值的全状态反馈增益阵K，由此使用全状态反馈控制器设计实现此闭环控制系统。 在所述步骤3)中运用量子遗传算法优化控制器参数，优化的参数是指Q矩阵和矩阵R。 所述量子遗传算法包括以下步骤： (6.1)初始化种群：采用随机方法通过量子染色体的基因编码对Q矩阵的对角线元素进行初始化,开始多变量单目标迭代优化，每次迭代产生四组数据，即为四个个体，每组数据为四阶Q矩阵对角线元素的值。加权矩阵R为单位矩阵。 (6.2)确定目标函数并计算适应度函数：二次型性能指标函数为： J = 1 2 ∫ 0 ∞ ( X T QX + U T RU ) dt ]]> 其中J为性能指标函数符号，X为系统状态方程中的状态向量，U不受约束，Q和R为常数对称正定阵，XT、UT表示X、U的转置矩阵。 取性能指标函数的相反数作为个体的适应度值Fitness，即Fitness＝-J,则最小化性能指标函数就相当于求个体适应度的最大值。 (6.3)设计选择，交叉，变异的遗传算子；选择运算使用轮盘赌原则选择算子，交叉运算使用“全干扰交叉”算子，变异运算使用量子旋转门； (6.4)得到系统控制器的最优控制参数。 所述步骤(6.1)初始化种群包括以下步骤： (7.1)根据要求的精度测算出染色体的长度 本文档来自技高网...

【技术保护点】
一种新型的两轮自平衡电动车系统控制器的设计方法，其特征在于，包括以下步骤：1)建立两轮自平衡电动车系统的数学模型；2)用试凑法仿真建立两轮自平衡电动车系统的线性二次最优控制器雏形；3)运用量子遗传算法优化控制器参数；4)将优化后的控制器参数代入系统，得到更加完善的线性二次最优控制器。

【技术特征摘要】
1.一种新型的两轮自平衡电动车系统控制器的设计方法，其特征在于，包
括以下步骤：
1)建立两轮自平衡电动车系统的数学模型；
2)用试凑法仿真建立两轮自平衡电动车系统的线性二次最优控制器雏形；
3)运用量子遗传算法优化控制器参数；
4)将优化后的控制器参数代入系统，得到更加完善的线性二次最优控制器。
2.根据权利要求1所述的一种新型的两轮自平衡电动车系统控制器的设计方
法，其特征在于：所述的建立两轮自平衡电动车数学模型，使用的方法是用拉
格朗日方程建模。
3.根据权利要求2所述的一种两轮自平衡电动车系统控制器的设计方法，
其特征在于：所述的用拉格朗日方程建模，包括以下步骤：
(3.1)确定模型的各个物理量，包括：车轮的移动动能T1、转动动能T2、车
体的移动动能T3、转动动能T4、车体内的直流减速电动机的转动动能T5，系统总
势能V，并得出拉格朗日函数表达式：L＝T-V＝T1+T2+T3+T4+T5-V；其中L为
拉格朗日量，T是系统总动能，T＝T1+T2+T3+T4+T5；
(3.2)代入拉格朗日方程得出相应的方程组；
其中，是拉格朗日量，q＝(q1,q2…,qN)是广义坐标的广义变量、F是广
义外力、Fθ是车辆前进的主动力、Fφ是车体绕转轴转动的主动力、是车轮
的转动主动力；
(3.3)对系统进行线性化，化简方程组；
(3.4)选取车体倾斜角度φ、车体倾斜角速度车轮转过角度θ、车轮转动
角速度整车转动角度和整车转角角速度作为系统的状态变量,便可得出车

\t辆的运动状态方程组。
Ul、Ur为驱动两个车轮的两个直流电动机的电枢电压，A、B、C、D为状态方
程的系数矩阵。
(3.5)判断系统模型的能控和能观性。
4.根据权利要求3所述的一种新型的两轮自平衡电动车系统控制器的设计
方法，其特征在于：所述步骤(3.5)的具体操作为：
(4.1)得到步骤(3.4)的状态方程组的系数矩阵A、B、C、D；
(4.2)利用Matlab命令ctrb、obsv得出两轮自平衡电动车的可控矩阵、可
观矩阵；
(4.3)利用Matlab命令rank求得可控和可观矩阵的秩，根据矩阵是否满秩
判断系统是否可控可观的。
5.根据权利要求1所述的一种新型的两轮自平衡电动车系统控制器的设计
方法，其特征在于：在所述步骤2)中，包括以下步骤：
(5.1)根据二次型性能指标函数，初步确定对角线矩阵加权阵Q和R；
(5.2)用Simulink仿真软件，给系统任意一个输入，得到系统的响应结果
曲线。通过反复试凑Q和R阵对角线元素值，选择符合性能指标要求的值；
(5.3)由系统状态方程组中的系数矩阵A,B，以及线性二次型最优控制器加
权矩阵Q、R，在Matlab中运用命令K＝lqr(A,B,Q,R)，求取使得二次型性能指标
为最小值的全状态反馈增益阵K，由此使用全状态反馈控制器设计实现此闭环控

\t制系统。
6.根据权利要求1所述的一种新型的两轮自平衡电动车系统控制器的设计
方法，其特征在于：在所述步骤3)中运用量子遗传算法优化控制器参数，优化
的参数是指Q矩阵和矩阵R，其量子遗传算法包括以下步骤：
(6.1)初始化种群：采用随机方法通过量子染色体的基因编码对Q矩阵的
对角线元素进行初始化，开始多变量单目标迭代优化，每次迭代产生四组数据，
即为四个个体，每组数据为四阶Q矩阵对角线元素的值，加权矩阵R为单位矩
阵；
(6.2)确定目标函数并计算适应度函数：二次型性能指标函数为：
J = 1 2 ∫ 0 ∞ ( X T QX + U T RU ) dt ]]> 其中J为性能指标函数符号，X为系统状态方程中的状态向量，U不受约束，
Q和R为常数对称正定阵，XT、UT表示X、U的转置矩阵；
取性能指标函数的相反数作为个体的适应度值Fitness，即Fitness＝-J,则最小
化性能指标函数就相当于求个体适应度的最大值；
(6.3)设计选择、交叉、变异的遗传算子；选择运算使用轮盘赌原则选择
算子，交叉运算使用“全干扰交叉”算子，变异运算使用量子旋转门；
(6.4)得到系统控制器的最优控制参数。
7.根据权利要求6所述的一种新型的两轮自平衡电动车系统控制器的设计方
法，其特征在于：所述步骤(6.1)初始化种群包括以下步骤：
(7.1)根据要求的精度测算出染色体的长度
根据下面公式进行计算，
其中aj、bj为Q阵中对角线元素值的下限值和上限
值，mj是染色体的长度；
(7.2)随机产生初始种群
采用具有叠加性的量子比特进行编码,即用一对复数定义一个量子比特位。
8.根据权利要求6所述的一种新型的两轮自平衡电动车系统控制器的设计
方法，其特征在于：所述步骤(6.3)中设计选择算子采用适应度比例方法，包
括以下步骤：
(8.1)计算群体的适应度值总和F：
...

【专利技术属性】
技术研发人员：齐本胜，萧旋旋，洪鑫，苗红霞，
申请(专利权)人：河海大学常州校区，
类型：发明
国别省市：江苏;32