CN104181817A - 一种新型的两轮自平衡电动车系统控制器的设计方法 - Google Patents
一种新型的两轮自平衡电动车系统控制器的设计方法 Download PDFInfo
- Publication number
- CN104181817A CN104181817A CN201410467206.5A CN201410467206A CN104181817A CN 104181817 A CN104181817 A CN 104181817A CN 201410467206 A CN201410467206 A CN 201410467206A CN 104181817 A CN104181817 A CN 104181817A
- Authority
- CN
- China
- Prior art keywords
- mrow
- matrix
- chromosome
- electric vehicle
- balancing electric
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 47
- 238000013461 design Methods 0.000 claims abstract description 29
- 230000002068 genetic effect Effects 0.000 claims abstract description 19
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 16
- 238000004364 calculation method Methods 0.000 claims abstract description 12
- 238000013178 mathematical model Methods 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 60
- 210000000349 chromosome Anatomy 0.000 claims description 52
- 108090000623 proteins and genes Proteins 0.000 claims description 16
- 230000035772 mutation Effects 0.000 claims description 9
- 238000005457 optimization Methods 0.000 claims description 9
- 239000002096 quantum dot Substances 0.000 claims description 9
- 230000003044 adaptive effect Effects 0.000 claims description 6
- 238000003491 array Methods 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 3
- 238000005381 potential energy Methods 0.000 claims description 3
- 230000009467 reduction Effects 0.000 claims description 3
- 230000004044 response Effects 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 abstract 1
- 238000005859 coupling reaction Methods 0.000 abstract 1
- 230000003993 interaction Effects 0.000 description 2
- 101710103508 FK506-binding protein Proteins 0.000 description 1
- 101710104425 FK506-binding protein 2 Proteins 0.000 description 1
- 101710104423 FK506-binding protein 3 Proteins 0.000 description 1
- 101710104333 FK506-binding protein 4 Proteins 0.000 description 1
- 101710104342 FK506-binding protein 5 Proteins 0.000 description 1
- 101710149710 FKBP-type 16 kDa peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 101710121306 FKBP-type 22 kDa peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 101710180800 FKBP-type peptidyl-prolyl cis-trans isomerase FkpA Proteins 0.000 description 1
- 101710104030 Long-type peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 101710114693 Outer membrane protein MIP Proteins 0.000 description 1
- 101710116692 Peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 101710111764 Peptidyl-prolyl cis-trans isomerase FKBP10 Proteins 0.000 description 1
- 101710111749 Peptidyl-prolyl cis-trans isomerase FKBP11 Proteins 0.000 description 1
- 101710111747 Peptidyl-prolyl cis-trans isomerase FKBP12 Proteins 0.000 description 1
- 101710111757 Peptidyl-prolyl cis-trans isomerase FKBP14 Proteins 0.000 description 1
- 101710111682 Peptidyl-prolyl cis-trans isomerase FKBP1A Proteins 0.000 description 1
- 101710111689 Peptidyl-prolyl cis-trans isomerase FKBP1B Proteins 0.000 description 1
- 101710147154 Peptidyl-prolyl cis-trans isomerase FKBP2 Proteins 0.000 description 1
- 101710147149 Peptidyl-prolyl cis-trans isomerase FKBP3 Proteins 0.000 description 1
- 101710147152 Peptidyl-prolyl cis-trans isomerase FKBP4 Proteins 0.000 description 1
- 101710147150 Peptidyl-prolyl cis-trans isomerase FKBP5 Proteins 0.000 description 1
- 101710147138 Peptidyl-prolyl cis-trans isomerase FKBP7 Proteins 0.000 description 1
- 101710147137 Peptidyl-prolyl cis-trans isomerase FKBP8 Proteins 0.000 description 1
- 101710147136 Peptidyl-prolyl cis-trans isomerase FKBP9 Proteins 0.000 description 1
- 102100038809 Peptidyl-prolyl cis-trans isomerase FKBP9 Human genes 0.000 description 1
- 101710174853 Peptidyl-prolyl cis-trans isomerase Mip Proteins 0.000 description 1
- 101710200991 Peptidyl-prolyl cis-trans isomerase, rhodopsin-specific isozyme Proteins 0.000 description 1
- 101710092145 Peptidyl-prolyl cis-trans isomerase-like 1 Proteins 0.000 description 1
- 101710092146 Peptidyl-prolyl cis-trans isomerase-like 2 Proteins 0.000 description 1
- 101710092148 Peptidyl-prolyl cis-trans isomerase-like 3 Proteins 0.000 description 1
- 101710092149 Peptidyl-prolyl cis-trans isomerase-like 4 Proteins 0.000 description 1
- 101710113444 Probable parvulin-type peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 101710090737 Probable peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 101710133309 Putative peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 101710124237 Short-type peptidyl-prolyl cis-trans isomerase Proteins 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000003912 environmental pollution Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000002028 premature Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开了一种新型的两轮自平衡电动车系统控制器的设计方法。由于两轮自平衡电动车是一种多变量、强耦合、非线性、自然不稳定系统,控制器的设计需要依据准确的数学模型,所以首先要建立两轮自平衡电动车系统的数学模型;其次,由于目前没有一个可以通过计算直接得到最优Q阵和R阵的方法,所以本发明先用试凑法仿真设计了两轮自平衡电动车系统控制器的雏形;最后运用量子遗传算法优化控制器参数,最终设计出线性二次最优控制器。通过该方法,可以在短时间内设计出符合系统要求的控制器,并能有效地控制两轮车完成各种行驶动作。
Description
技术领域
本发明涉及系统控制器的优化领域,具体是一种新型的两轮自平衡电动车系统控制器的设计方法。
背景技术
随着我国城镇化建设的脚步,我国汽车保有量一跃进入世界前列。由此引发了包括环境污染问题、能源问题、交通问题等在内的一系列问题困扰着人们。基于此问题,占用面积小、节能无污染、无转弯半径的两轮自平衡电动车的研发成为各大高科技厂商的研究热点。
对两轮自平衡电动车系统数学模型的建立,常用的方法是牛顿经典力学建模和用拉格朗日方程建模。牛顿经典力学进行系统建模则需对系统的各部分进行受力分析,拉格朗日建模法只考虑系统外部的作用力,而不考虑系统各部分间的相互作用力。针对两轮自平衡车的控制国际上多采用线性二次最优控制、点配置法、自适应神经网络法、模糊控制法等其他混合智能算法。而对已经面世的商品车而言,国外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为性能指标函数符号,X为系统状态方程中的状态向量,U不受约束,Q和R为常数对称正定阵,XT、UT表示X、U的转置矩阵。
取性能指标函数的相反数作为个体的适应度值Fitness,即Fitness=-J,则最小化性能指标函数就相当于求个体适应度的最大值。
(6.3)设计选择,交叉,变异的遗传算子;选择运算使用轮盘赌原则选择算子,交叉运算使用“全干扰交叉”算子,变异运算使用量子旋转门;
(6.4)得到系统控制器的最优控制参数。
所述步骤(6.1)初始化种群包括以下步骤:
(7.1)根据要求的精度测算出染色体的长度
根据下面公式进行计算,
其中aj、bj为Q阵中对角线元素值的下限值和上限值,mj是染色体的长度;
(7.2)随机产生初始种群
采用具有叠加性的量子比特进行编码,即用一对复数定义一个量子比特位。
所述步骤(6.3)中设计选择算子即采用适应度比例方法包括以下步骤:
(1)计算群体的适应度值总和F:
其中Uk指第k条染色体,popsize为染色体数目,eval(Uk)为染色体Uk的适应度值。
(2)计算对应于每个染色体Uk的选择概率Pk:
(3)计算每个染色体Uk的累计概率Qk:
具体操作为:生成一个[0,1]间的随机数rand,如果rand≤Q1,就选择染色体U1;否则,选择第k个染色体Uk(2≤k≤popsize),使得Qk-1≤k≤Qk。
所述设计交叉算子使用“全干扰交叉法”。
进行量子全干扰交叉时,首先按照交叉率Pc从种群中选出一定数目的个体形成一个交叉阵列,然后按对角线重新排列,产生新个体。
具体操作为:随机生成[0,1]间数组rc=[1行popsize列];如果rc(i)<Pc,则选择相应的染色体newpop(:,:,i)放入交叉池。
其中染色体newpop(:,:,i)(i=1,…,popsize*Pc)是满足条件选择出来的染色体,即形成一个popsize*Pc行、m列的交叉阵列,然后按对角线重新排列,产生新个体,所述popsize*Pc为选出的参加交叉的染色体个数,m为染色体长度。
该法利用了量子叠加态的相干性,使得参与交叉个体的每一个基因位均进行交叉操作,新形成的子代个体携带多个父代个体的信息,实现了种群信息的充分融合,可以有效地避免种群趋同现象的过早发生。
所述步骤(6.3)中设计变异算子即通过量子门的作用对量子个体进行更新,包括以下步骤:
(1)根据变异概率Pm随机选择出待变异基因位及其所在染色体;
(2)计算待变异染色体的适应值和二进制位;
(3)计算历史最佳个体的适应值,并将个体实值转化为二进制编码;
(4)计算待变异基因xi的二进制值和历史最优个体的第i位bi的二进制值;
(5)对待变异基因所在染色体与历史最优个体的适应度值f(x)和f(b)比较,判断f(x)≥f(b)的真假
(6)计算量子旋转门参数。
对于具有m位量子比特的一个个体,每个量子比特位(αi,βi)的更新公式为:
其中:t表示进化的代数;U(θi)为量子旋转门
使用相位旋转操作算子来加快进化求优的速度,
其中:U(θ)为一幺正矩阵;s(αiβi)为旋转角的方向,θ为变异旋转角度,θ=s(αiβi)·Δθi。
有益效果是:本发明先用拉格朗日方程建立了系统的数学模型,不需要分析系统内部的相互作用力;用量子遗传算法对控制器的加权矩阵Q的参数优化,使用轮盘赌选择算子,全干扰交叉算子和旋转变异门变异算子形成改进的遗传算法进行对系统控制器Q阵的参数进行优化,比传统进化算法具有更快的收敛速度和全局寻优能力,与传统遗传算法相比,在迭代次数更少的情况下,较快得到最优参数,进而设计出更加完善的控制器。
附图说明
图1为系统控制器设计流程图。
具体实施方式
如图1所示,一种新型的两轮自平衡电动车系统控制器的设计方法。
步骤1、建立两轮自平衡电动车系统的数学模型,为控制器的设计奠定基础。
(1.1)确定模型的各个物理量,包括:车轮的移动动能T1、转动动能T2、车体的移动动能T3、转动动能T4、车体内的直流减速电动机的转动动能T5,系统总势能V,并得出拉格朗日函数表达式:L=T-V=T1+T2+T3+T4+T5-V。其中L为拉格朗日量,T是系统总动能,T=T1+T2+T3+T4+T5。
(1.2)代入拉格朗日方程得出相应的方程组。
其中,是拉格朗日量,q=(q1,q2…,qN)是广义坐标的广义变量、F是广义外力、Fθ是车辆前进的主动力、Fφ是车体绕转轴转动的主动力、是车轮的转动主动力。
(1.3)对系统进行线性化,化简方程组。
(1.4)选取车体倾斜角度φ、车体倾斜角速度车轮转过角度θ、车轮转动角速度整车转动角度和整车转角角速度作为系统的状态变量,便可得出车辆的运动状态方程组。
Ul、Ur为驱动两个车轮的两个直流电动机的电枢电压,A、B、C、D为状态方程的系数矩阵。
(1.5)判断系统模型的能控和能观性。
(1.5.1)得到步骤(3.4)的状态方程的系数矩阵A、B、C、D;
(1.5.2)利用Matlab命令ctrb、obsv得出两轮自平衡电动车运动系统的可控矩阵M=ctrb(A,B),可观矩阵N=obsv(A,C)。
(1.5.3)利用Matlab命令rank(M)、rank(N)求得可控矩阵、可观矩阵的秩。
由结果可知矩阵满秩,所以系统模型是能控能观的,此模型可以设计控制器。
步骤2、用试凑法仿真建立两轮自平衡电动车系统的线性二次最优控制器雏形。
(2.1)根据二次型性能指标函数,初步确定对角线矩阵加权阵Q和R。
(2.2)用Simulink仿真软件,给系统一个输入,得到系统的响应结果曲线。通过反复试凑Q和R阵对角线元素值,选择符合性能指标要求的值。
(2.3)由系统状态方程组中的系数矩阵A,B,以及线性二次型最优控制器加权矩阵Q、R,在Matlab中运用命令K=lqr(A,B,Q,R),求取使得二次型性能指标为最小值的全状态反馈增益阵K,由此使用全状态反馈控制器设计实现此闭环控制系统。
步骤3、运用量子遗传算法优化控制器参数,优化的参数是指Q矩阵和矩阵R,其量子遗传算法包括以下步骤:
(3.1)初始化种群
采用随机方法通过量子染色体的基因编码对Q阵的对角线元素进行初始化,开始多变量单目标迭代优化,每次迭代产生四组数据,即为四个个体,每组数据为四阶Q矩阵对角线元素的值,加权矩阵R为单位矩阵;包括两步:
(3.1.1)根据要求的精度测算出染色体的长度
若要求的精度为e=0.000001;优化变量Q阵为一个四行四列矩阵,并且除对角线元素外其余元素都始终为0,所以程序只要处理Q阵对角线元素。设取值范围都为1e3-1e6。
根据公式:来测算,其中aj、bj为Q阵中对角线元素值的下限值和上限值,j=1~4表示共有四个个体,m=m1+m2+m3+m4是染色体的总长度。
(3.1.2)随机产生初始种群
取种群数量为100,交叉率Pc为0.4,变异率Pm为0.8,共进行50代运算。采用具有叠加性的量子比特进行编码,即用一对复数定义一个量子比特位。
(3.2)确定目标函数并设计适应度函数
二次型性能指标函数为:
其中J为性能指标函数符号,X为系统状态方程中的状态向量,U不受约束,Q和R为常数对称正定阵,XT、UT表示X、U的转置矩阵。
取性能指标函数的相反数作为个体的适应度值Fitness,即Fitness=-J,则最小化性能指标函数就相当于求个体适应度的最大值。
(3.3)设计选择、交叉、变异的遗传算子;选择运算使用轮盘赌原则选择算子,交叉运算使用“全干扰交叉”算子,变异运算使用量子旋转门。
(3.3.1)设计选择遗传算子
设计选择算子即采用适应度比例方法包括以下步骤:
(a)计算群体的适应度值总和:
其中Uk指第k条染色体,popsize为染色体数目,eval(Uk)为染色体Uk的适应度值。
(b)计算对应于每个染色体Uk的选择概率Pk:
(c)计算每个染色体Uk的累计概率Qk:
具体操作为:生成一个[0,1]间的随机数rand,如果rand≤Q1,就选择染色体U1;否则,选择第k个染色体Uk(2≤k≤popsize),使得Qk-1≤k≤Qk。
(3.3.2)设计全干扰交叉遗传算子
具体操作为:随机生成[0,1]间数组rc=[1行popsize列];如果rc(i)<Pc,则选择相应的染色体newpop(:,:,i)放入交叉池。
其中染色体newpop(:,:,i)(i=1,…,popsize*Pc)是满足条件选择出来的染色体,即形成一个popsize*Pc行、m列的交叉阵列,然后按对角线重新排列,产生新个体,所述popsize*Pc为选出的参加交叉的染色体个数,m为染色体长度。
(3.3.3)设计旋转量子门变异遗传算子
(1)根据变异概率Pm随机选择出待变异基因位及其所在染色体;
(2)计算待变异染色体的适应值和二进制位;
(3)计算历史最佳个体的适应值,并将个体实值转化为二进制编码;
(4)计算待变异基因xi的二进制值和历史最优个体的第i位bi的二进制值;
(5)对待变异基因所在染色体与历史最优个体的适应度值f(x)和f(b)比较,判断f(x)≥f(b)的真假
(6)计算量子旋转门参数。
对于具有m位量子比特的一个个体,每个量子比特位(αi,βi)的更新公式为:
其中:t表示进化的代数;U(θi)为量子旋转门
本发明中使用相位旋转操作算子来加快进化求优的速度,
其中:U(θ)为一幺正矩阵;s(αiβi)为旋转角的方向,θ为变异旋转角度,θ=s(αiβi)·Δθi,θ的值通过表1可查询得到。
表1量子旋转门的旋转角
步骤4、将优化后的控制器参数代入系统,得到更加完善的线性二次最优控制器。
Claims (10)
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)选取车体倾斜角度φ、车体倾斜角速度车轮转过角度θ、车轮转动角速度整车转动角度和整车转角角速度作为系统的状态变量,便可得出车辆的运动状态方程组。
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,由此使用全状态反馈控制器设计实现此闭环控制系统。
6.根据权利要求1所述的一种新型的两轮自平衡电动车系统控制器的设计方法,其特征在于:在所述步骤3)中运用量子遗传算法优化控制器参数,优化的参数是指Q矩阵和矩阵R,其量子遗传算法包括以下步骤:
(6.1)初始化种群:采用随机方法通过量子染色体的基因编码对Q矩阵的对角线元素进行初始化,开始多变量单目标迭代优化,每次迭代产生四组数据,即为四个个体,每组数据为四阶Q矩阵对角线元素的值,加权矩阵R为单位矩阵;
(6.2)确定目标函数并计算适应度函数:二次型性能指标函数为:
其中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:
其中Uk指第k条染色体,popsize为染色体数目,eval(Uk)为染色体Uk的适应度值;
(8.2)计算对应于每个染色体Uk的选择概率Pk:
(8.3)计算每个染色体Uk的累计概率Qk:
生成一个[0,1]间的随机数rand,如果rand≤Q1,就选择染色体U1;否则,选择第k个染色体Uk(2≤k≤popsize),使得Qk-1≤k≤Qk。
9.根据权利要求6所述的一种新型的两轮自平衡电动车系统控制器的设计方法,其特征在于:所述步骤(6.3)中设计交叉算子使用全干扰交叉法;
进行量子全干扰交叉时,首先按照交叉率Pc从种群中选出一定数目的个体形成一个交叉阵列,然后按对角线重新排列,产生新个体;
随机生成[0,1]间数组rc=[1行popsize列];如果rc(i)<Pc,则选择相应的染色体newpop(:,:,i)放入交叉池。
其中染色体newpop(:,:,i)(i=1,…,popsize*Pc)是满足条件选择出来的染色体,即形成一个popsize*Pc行、m列的交叉阵列,然后按对角线重新排列,产生新个体,所述popsize*Pc为选出的参加交叉的染色体个数,m为染色体长度。
10.根据权利要求6所述的一种新型的两轮自平衡电动车系统控制器的设计方法,其特征在于:所述步骤(6.3)中设计变异算子通过量子门的作用对量子个体进行更新,包括以下步骤:
(10.1)根据变异概率Pm随机选择出待变异基因位及其所在染色体;
(10.2)计算待变异染色体的适应值和二进制位;
(10.3)计算历史最佳个体的适应值,并将个体实值转化为二进制编码;
(10.4)计算待变异基因xi的二进制值和历史最优个体的第i位bi的二进制值;
(10.5)对待变异基因所在染色体与历史最优个体的适应度值f(x)和f(b)比较,判断f(x)≥f(b)的真假;
(10.6)计算量子旋转门参数;
对于具有m位量子比特的一个个体,每个量子比特位(αi,βi)的更新公式为:
其中:t表示进化的代数,U(θi)为量子旋转门
使用相位旋转操作算子来加快进化求优的速度,
其中:U(θ)为一幺正矩阵;s(αiβi)为旋转角的方向,θ为变异旋转角度,θ=s(αiβi)·Δθi。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410467206.5A CN104181817B (zh) | 2014-09-12 | 2014-09-12 | 一种两轮自平衡电动车系统控制器的设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410467206.5A CN104181817B (zh) | 2014-09-12 | 2014-09-12 | 一种两轮自平衡电动车系统控制器的设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104181817A true CN104181817A (zh) | 2014-12-03 |
CN104181817B CN104181817B (zh) | 2017-02-15 |
Family
ID=51962955
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410467206.5A Active CN104181817B (zh) | 2014-09-12 | 2014-09-12 | 一种两轮自平衡电动车系统控制器的设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104181817B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105573115A (zh) * | 2015-12-09 | 2016-05-11 | 中山大学 | 基于量子遗传算法的污水处理过程节能优化控制方法 |
CN105867127A (zh) * | 2016-04-15 | 2016-08-17 | 广东省自动化研究所 | 一种精密气悬浮系统的同步最优控制方法 |
CN106919041A (zh) * | 2017-01-23 | 2017-07-04 | 长春工业大学 | 一种基于改进的量子遗传算法的扇形磨片排序方法 |
CN107825984A (zh) * | 2017-11-11 | 2018-03-23 | 成都海逸机电设备有限公司 | 一种悬挂式单轨交通轨道梁巡检小车控制装置及控制方法 |
CN112965509A (zh) * | 2021-02-09 | 2021-06-15 | 内蒙古大学 | 一种两轮自平衡机器人的控制方法及系统 |
CN117555287A (zh) * | 2024-01-12 | 2024-02-13 | 中国机械总院集团云南分院有限公司 | 一种基于cae的数控机床加工动态性能监控方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6212466B1 (en) * | 2000-01-18 | 2001-04-03 | Yamaha Hatsudoki Kabushiki Kaisha | Optimization control method for shock absorber |
US6687554B1 (en) * | 1999-05-28 | 2004-02-03 | Yamaha Hatsudoki Kabushiki Kaisha | Method and device for controlling optimization of a control subject |
CN1885217A (zh) * | 2006-06-13 | 2006-12-27 | 重庆大学 | 欠驱动双摆系统摆杆杂技动作控制方法 |
CN1952996A (zh) * | 2005-10-18 | 2007-04-25 | 中国科学技术大学 | 两轮遥控小车倒立摆及其平衡控制方法 |
CN101564840A (zh) * | 2009-01-21 | 2009-10-28 | 上海广茂达伙伴机器人有限公司 | 基于并联机构的机器人构件、优化设计方法及机器人 |
CN103472724A (zh) * | 2013-09-16 | 2013-12-25 | 江苏大学 | 一种用于多自由度并联机构的实时控制动力学建模方法 |
CN103676650A (zh) * | 2013-11-29 | 2014-03-26 | 上海交通大学 | 两轮自平衡智能车的带死区的pid优化控制方法 |
-
2014
- 2014-09-12 CN CN201410467206.5A patent/CN104181817B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6687554B1 (en) * | 1999-05-28 | 2004-02-03 | Yamaha Hatsudoki Kabushiki Kaisha | Method and device for controlling optimization of a control subject |
US6212466B1 (en) * | 2000-01-18 | 2001-04-03 | Yamaha Hatsudoki Kabushiki Kaisha | Optimization control method for shock absorber |
CN1952996A (zh) * | 2005-10-18 | 2007-04-25 | 中国科学技术大学 | 两轮遥控小车倒立摆及其平衡控制方法 |
CN1885217A (zh) * | 2006-06-13 | 2006-12-27 | 重庆大学 | 欠驱动双摆系统摆杆杂技动作控制方法 |
CN101564840A (zh) * | 2009-01-21 | 2009-10-28 | 上海广茂达伙伴机器人有限公司 | 基于并联机构的机器人构件、优化设计方法及机器人 |
CN103472724A (zh) * | 2013-09-16 | 2013-12-25 | 江苏大学 | 一种用于多自由度并联机构的实时控制动力学建模方法 |
CN103676650A (zh) * | 2013-11-29 | 2014-03-26 | 上海交通大学 | 两轮自平衡智能车的带死区的pid优化控制方法 |
Non-Patent Citations (5)
Title |
---|
张继段: "基于遗传算法的自平衡两轮机器人稳定控制研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
强明辉 等: "利用遗传算法优化线性二次型调节器(LQR)", 《甘肃工业大学学报》 * |
胡桂红: "基于遗传算法的倒立摆控制策略研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
赵建伟 等: "柔性两轮直立式自平衡仿人机器人的建模及控制", 《机器人》 * |
阮晓钢 等: "两轮自平衡机器人动力学建模及其平衡控制", 《计算机应用研究》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105573115A (zh) * | 2015-12-09 | 2016-05-11 | 中山大学 | 基于量子遗传算法的污水处理过程节能优化控制方法 |
CN105573115B (zh) * | 2015-12-09 | 2018-05-11 | 中山大学 | 基于量子遗传算法的污水处理过程节能优化控制方法 |
CN105867127A (zh) * | 2016-04-15 | 2016-08-17 | 广东省自动化研究所 | 一种精密气悬浮系统的同步最优控制方法 |
CN105867127B (zh) * | 2016-04-15 | 2018-11-23 | 广东省智能制造研究所 | 一种精密气悬浮系统的同步最优控制方法 |
CN106919041A (zh) * | 2017-01-23 | 2017-07-04 | 长春工业大学 | 一种基于改进的量子遗传算法的扇形磨片排序方法 |
CN107825984A (zh) * | 2017-11-11 | 2018-03-23 | 成都海逸机电设备有限公司 | 一种悬挂式单轨交通轨道梁巡检小车控制装置及控制方法 |
CN112965509A (zh) * | 2021-02-09 | 2021-06-15 | 内蒙古大学 | 一种两轮自平衡机器人的控制方法及系统 |
CN117555287A (zh) * | 2024-01-12 | 2024-02-13 | 中国机械总院集团云南分院有限公司 | 一种基于cae的数控机床加工动态性能监控方法及系统 |
CN117555287B (zh) * | 2024-01-12 | 2024-04-09 | 中国机械总院集团云南分院有限公司 | 一种基于cae的数控机床加工动态性能监控方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN104181817B (zh) | 2017-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104181817B (zh) | 一种两轮自平衡电动车系统控制器的设计方法 | |
CN103105774B (zh) | 基于改进的量子进化算法的分数阶pid控制器整定方法 | |
CN109932903A (zh) | 多父代优化网络和遗传算法的风机控制多目标优化方法 | |
CN101520857B (zh) | 一种基于神经网络的永磁球形电动机逆运动学求解方法 | |
Sun et al. | Type-1/type-2 fuzzy logic systems optimization with RNA genetic algorithm for double inverted pendulum | |
CN107186713B (zh) | 一种过路径点的机械臂多轴运动规划优化方法 | |
Anh et al. | Parameter identification using adaptive differential evolution algorithm applied to robust control of uncertain nonlinear systems | |
CN103019099B (zh) | 一种卫星姿态模糊控制器参数优化方法 | |
CN104156560A (zh) | 一种基于SaE-ELM的煤矿多等级突水预测方法 | |
CN109934351B (zh) | 一种量子教与学算法以及基于量子教与学算法的模糊滑模控制方法 | |
CN105608295B (zh) | 焦化炉压力的多目标遗传算法与rbf神经网络优化建模方法 | |
Zhao et al. | Aspw-drl: assembly sequence planning for workpieces via a deep reinforcement learning approach | |
Mohammed et al. | Balancing a Segway robot using LQR controller based on genetic and bacteria foraging optimization algorithms | |
CN106842959A (zh) | 一种Nao机器人步态规划遗传算法 | |
CN105511267B (zh) | 一种仿蛇搜救机器人多步态控制方法 | |
Hu et al. | Learning a faster locomotion gait for a quadruped robot with model-free deep reinforcement learning | |
CN101866144A (zh) | 一种基于ITAE的Furuta摆智能控制方法 | |
Hu et al. | Estimating biped gait using spline-based probability distribution function with Q-learning | |
Serrano-Pérez et al. | Offline robust tuning of the motion control for omnidirectional mobile robots | |
CN109408896B (zh) | 一种污水厌氧处理产气量多元智能实时监控方法 | |
CN103473599A (zh) | 一种基于遗传算法和卡尔曼滤波的rbfn组合训练方法 | |
Zhang et al. | Evolutionary-based quantum architecture search | |
Thangavelusamy et al. | Comparison of PI controller tuning using GA and PSO for a Multivariable Experimental Four Tank System | |
CN116047904A (zh) | 面向机器人操作技能学习的人员仿真现实混合训练方法 | |
CN113722853B (zh) | 一种面向智能计算的群智能进化式工程设计约束优化方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |