CN113419433A - 一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 - Google Patents
一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 Download PDFInfo
- Publication number
- CN113419433A CN113419433A CN202110837420.5A CN202110837420A CN113419433A CN 113419433 A CN113419433 A CN 113419433A CN 202110837420 A CN202110837420 A CN 202110837420A CN 113419433 A CN113419433 A CN 113419433A
- Authority
- CN
- China
- Prior art keywords
- self
- equation
- under
- electric wheelchair
- 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 27
- 238000013461 design Methods 0.000 title claims abstract description 16
- 230000003044 adaptive effect Effects 0.000 claims abstract description 26
- 238000006243 chemical reaction Methods 0.000 claims abstract description 16
- 238000004088 simulation Methods 0.000 claims abstract description 12
- 230000000694 effects Effects 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 39
- 230000006870 function Effects 0.000 claims description 34
- 230000007704 transition Effects 0.000 claims description 26
- 230000001133 acceleration Effects 0.000 claims description 23
- 230000005484 gravity Effects 0.000 claims description 15
- 239000013598 vector Substances 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 238000000354 decomposition reaction Methods 0.000 claims description 3
- 238000005381 potential energy Methods 0.000 claims description 3
- 230000002441 reversible effect Effects 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000012549 training Methods 0.000 abstract description 2
- 230000008901 benefit Effects 0.000 description 5
- 238000004458 analytical method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000002146 bilateral effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明涉及一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法,包括:建立具有不确定参数的自平衡电动轮椅欠驱动***的动力学模型;通过状态转换函数,将自平衡电动轮椅欠驱动***输出由有界状态转换为无界状态,得到状态转换后的动力学方程;设计一种自适应鲁棒控制器;利用李雅普诺夫方法对自适应鲁棒控制器的一致有界性和最终有界性进行验证;根据自平衡电动轮椅欠驱动***进行数值仿真,并对所设计自适应鲁棒控制器的主要参数进行调节;最后对鲁棒控制器的控制效果进行分析,并给出结论。本发明能够保证***的一致有界性和一致最终有界性,算例的数值仿真结果表明,能够很好地跟踪预定的训练轨迹并补偿不确定性。
Description
技术领域
本发明涉及自平衡电动轮椅技术领域,尤其是一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法。
背景技术
随着现代社会的不断进步,轮椅成为残疾人和体弱老年人必不可少的行走工具.但由于残疾人和老年人身体相对较弱,且较多无工作能力,经济来源有限,而且当他们不使用轮椅时,又需要轮椅便于包装和移动。因此,要求轮椅轻便小巧、结构紧凑、功能人性化、简单易用、价格低廉,轮椅是康复的重要工具,它不仅是肢体伤残者的代步工具,更重要的是便他们借助于轮椅进行身体锻练和参与社会活动,因此如何设计和制造一个功能强大、人性化的轮椅成为了当今残疾人士最为关心的问题。
自平衡电动轮椅不同于一股市面上的电动轮椅,自平衡电动轮椅拥有转弯半径小,机械结构简单,成本更低,***灵活性好,具有良好的越障和操作性能的优点,但自平衡电动轮椅由于输入少于需要控制的量,故其是一类高度非线性的欠驱动***,这类操作***具有一定的复杂性,但其可以起到容错控制的功能,研究这类操作***对非完整***的研究具有促进作用。
欠驱动的难点在于耦合,这种耦合造成了对不能直接控制部分的不确定性,针对欠驱动***不确定性的问题,目前的控制方法主要有Udwadia控制,它是不需要执行某种线性化和/或非线性抵消来控制一股的、非线性的、结构的和机械的***,这与大多数其他控制方法不同,但是Udwadia控制没有考虑机械***中存在的不确定性,其他的控制方法如滑模控制、LQR控制、H2/H∞控制、反步控制等没有Udwadia控制的优势,因此需要设计一款新的控制器来解决上述问题。
发明内容
本发明的目的在于提供一种建立在Udwadia控制框架上,既能很好地解决机械***中的不确定性问题,同时兼顾了Udwadia控制的优势的自平衡电动轮椅欠驱动***跟踪控制器的设计方法。
为实现上述目的,本发明采用了以下技术方案:一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法,包括:
(1)建立具有不确定参数的自平衡电动轮椅欠驱动***的动力学模型,其公式如下:
并写成二阶微分的形式,以满足伺服约束的要求;
(2)通过状态转换函数,将自平衡电动轮椅欠驱动***输出由有界状态转换为无界状态,得到状态转换后的动力学方程为:
保证自平衡电动轮椅欠驱动***输出控制在所设定的期望范围内,并保证控制自平衡电动轮椅欠驱动***的一致有界性和最终有界性;
(3)针对经过状态转换后的自平衡电动轮椅欠驱动***中存在的不确定性,设计一种自适应鲁棒控制器;
(4)利用李雅普诺夫方法对自适应鲁棒控制器的一致有界性和最终有界性进行验证;
(5)根据自平衡电动轮椅欠驱动***进行数值仿真,并对所设计自适应鲁棒控制器的主要参数进行调节;
(6)最后对鲁棒控制器的控制效果进行分析,并给出结论。
所述步骤(1)具体是指:
自平衡电动轮椅欠驱动***的动力学模型的公式如下:
其中,t是时间,t∈Rn;q是角位移,q∈Rn;是角速度,是角加速度,Rn表示维数为n的自然数集;σ是不确定参数, 代表σ的可能界限是未知有界的;τ为控制输入,τ∈Rm,m<n,m和n表示矩阵维数,m为行,n为列;S是控制系数的矩阵,S∈Rn×m;Rn×m表示n行、m列的自然数矩阵;M(q,σ,t)是惯性矩阵,M(q,σ,t)∈Rn×n;Rn ×n表示n行、n列的自然数矩阵;是科氏项和离心项的矩阵,G(q,σ,t)是重力项,G(q,σ,t)∈Rn×n;表示摩擦力和其他外部扰动,矩阵或者向量M(q,σ,t),G(q,σ,t)和具有适当的维数;
假设函数M(.),C(.),G(.)都是连续的,给出如下伺服约束形式:
其中q是位置,t是时间,Bli(·)和dl(·)都是列向量,把约束条件写成矩阵形式:
B(q,t)=d(q,t) (3)
B=[Bli]m×n,d=[d1,d2,...,dm]T,这是零阶形式的约束;
将公式(2)的伺服约束形式对t进行微分,得到:
其中:
将公式(4)的约束条件写成矩阵形式:
这里A=[Ali]m×n,c=[c1,c2,...,cm]T这是一阶形式约束;
对公式(4)的一阶形式对t进行微分,得到:
其中:
写成矩阵形式:
其中b=[b1,b2,...,bm]T为二阶形式约束。
所述步骤(2)具体是指:
基于自平衡电动轮椅欠驱动***的动力学模型的公式(1),假定当t→+∞时q(t)→qd,不等式约束为qm<q(t)<qM,这里qd是q期望的值,qm和qM分别是q的最大值和最小值,然后,通过选择合适的函数α(q),应用状态转换将状态q无限制地转换为一个新的状态p;
函数p=α(q)满足当q→qd时p→pd以及当q∈(qm,qM)时p∈(-∞,+∞);由于p=α(q),有:
q=α-1(p) (11)
对公式(11)求一阶导数:
上式写成:
对公式(11)求二阶导数:
上式写成:
将公式(13)和公式(15)代入公式(1),将动力***转化为p:
将式(16)写成
得到状态转换后的动力学方程为:
其中,t是时间,t∈Rn;p是状态转换后的坐标,p∈Rn;状态转换后的速度,是状态转换后的加速度,M′(p,σ,t)是状态转换后的惯性矩阵,M′(p,σ,t)∈Rn×n;是状态转换后的科氏项和离心项的矩阵,G′(p,σ,t)是状态转换后的重力项,G′(p,σ,t)∈Rn×n;表示状态转换后的摩擦力和其他外部扰动,
所述步骤(3)具体是指:
假设公式(18)中的矩阵/向量M′、C′、G′、F′分解为:
所述控制器有以下性能要求:
(3b)基于性能要求(3a),对于给定p∈Rm×R,p>0,设
这里λ>0;
(3d)存在一个未知常数向量α∈(0,∞)k和一个已知函数∏(·)
综上,设计一种自适应鲁棒控制器:
其中:
这里:
所述步骤(4)具体是指:
给出李雅普诺夫候选函数:
对公式(30)进行计算得到:
最终,得出受控欠驱动机械***的解满足一致有界性的结论;
一致最终有界性由下式表示:
所述步骤(5)具体是指:
针对自平衡电动轮椅欠驱动***,其动力学具体描述如下:
***动能为:
***势能为:
V=mglcos(θ(t)) (35)
由拉格朗日动力学方程推导出:
要计算出车体的倾角,通过重力加速度在其他轴上产生的分量来计算出角度,即测量X轴或Y轴某一轴向的加速度计算出倾角,在传感器静止水平时,X轴与Y轴不会有输出,而在其产生一定的倾角时才会使重力加速度g在X轴或Y轴上产生分量,而且该轴倾斜的角度和重力分量的大小相关;利用C语言中的atan2(x,y)函数,计算X轴与Z轴平面或者Y轴与Z轴平面的当前方位角,同时将其值转化为角度值,计算方法如下:
Angle_X=atan2(Accel_Y,Accel_Z)*180/PI (38)
Angle_Y=atan2(Accel_X,Accel_Z)*180/PI (39)
假设测得倾角为θ,则加速度大小为:
a=sinθ×g+cosθ×a′ (40)
其中,a′代表了线加速度与角加速度的和;
假设约束为θm<θ<θM,所选转换函数为:
将公式(42)代到公式(37)中,得到:
由状态转换方程得到:
***伺服跟踪控制率如下:
其中:
这里:
将得到的转矩τ作为电流输入,控制电机转速,根据所求参数表达以及求得控制率进行数值仿真,对所设计自适应鲁棒控制器里面主要参数进行调节,主要包括控制参数和自适应率参数,对控制效果进行分析,最后给出结论。
由上述技术方案可知,本发明的有益效果为:本发明同时考虑了非线性不确定***控制输入和输出的不等式约束,首先,利用状态变换将有界状态转换为新的无界状态,通过选择合适的的函数处理单边和双边不等式约束;其次,通过微分同态将控制输入视为一个边界函数,解决了机械***中存在的由欠驱动导致的不确定性问题;最后,它是建立在Udwadia控制框架上的,既能很好的解决机械***中的不确定性问题,同时兼顾了Udwadia控制的优势,可以满足伺服跟踪控制的精度要求。
附图说明
图1为本发明的设计方法流程图;
图2为本发明中自适应鲁棒控制器的结构框图;
图3为本发明的自平衡电动轮椅的整体外观示意图;
图4为本发明的自平衡电动轮椅欠驱动***的稳定性仿真示意图。
具体实施方式
如图1所示,一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法,包括:
(1)建立具有不确定参数的自平衡电动轮椅欠驱动***的动力学模型,其公式如下:
并写成二阶微分的形式,以满足伺服约束的要求;
(2)通过状态转换函数,将自平衡电动轮椅欠驱动***输出由有界状态转换为无界状态,得到状态转换后的动力学方程为:
保证自平衡电动轮椅欠驱动***输出控制在所设定的期望范围内,并保证控制自平衡电动轮椅欠驱动***的一致有界性和最终有界性;
(3)针对经过状态转换后的自平衡电动轮椅欠驱动***中存在的不确定性,设计一种自适应鲁棒控制器;
(4)利用李雅普诺夫方法对自适应鲁棒控制器的一致有界性和最终有界性进行验证;
(5)根据自平衡电动轮椅欠驱动***进行数值仿真,并对所设计自适应鲁棒控制器的主要参数进行调节;
(6)最后对鲁棒控制器的控制效果进行分析,并给出结论。
所述步骤(1)具体是指:
自平衡电动轮椅欠驱动***的动力学模型的公式如下:
其中,t是时间,t∈Rn;q是角位移,q∈Rn;是角速度,是角加速度,Rn表示维数为n的自然数集;σ是不确定参数, 代表σ的可能界限是未知有界的;τ为控制输入,τ∈Rm,m<n,m和n表示矩阵维数,m为行,n为列;S是控制系数的矩阵,S∈Rn×m;Rn×m表示n行、m列的自然数矩阵;M(q,σ,t)是惯性矩阵,M(q,σ,t)∈Rn×n;Rn ×n表示n行、n列的自然数矩阵;是科氏项和离心项的矩阵,G(q,σ,t)是重力项,G(q,σ,t)∈Rn×n;表示摩擦力和其他外部扰动,矩阵或者向量M(q,σ,t),G(q,σ,t)和具有适当的维数;
假设函数M(.),C(.),G(.)都是连续的,给出如下伺服约束形式:
其中q是位置,t是时间,Bli(·)和dl(·)都是列向量,把约束条件写成矩阵形式:
B(q,t)=d(q,t) (3)
B=[Bli]m×n,d=[d1,d2,...,dm]T,这是零阶形式的约束;
将公式(2)的伺服约束形式对t进行微分,得到:
其中:
将公式(4)的约束条件写成矩阵形式:
这里A=[Ali]m×n,c=[c1,c2,...,cm]T这是一阶形式约束;
对公式(4)的一阶形式对t进行微分,得到:
其中:
写成矩阵形式:
其中b=[b1,b2,...,bm]T为二阶形式约束。
所述步骤(2)具体是指:
基于自平衡电动轮椅欠驱动***的动力学模型的公式(1),假定当t→+∞时q(t)→qd,不等式约束为qm<q(t)<qM,这里qd是q期望的值,qm和qM分别是q的最大值和最小值,然后,通过选择合适的函数α(q),应用状态转换将状态q无限制地转换为一个新的状态p;
函数p=α(q)满足当q→qd时p→pd以及当q∈(qm,qM)时p∈(-∞,+∞);由于p=α(q),有:
q=α-1(p) (11)
对公式(11)求一阶导数:
上式写成:
对公式(11)求二阶导数:
上式写成:
将公式(13)和公式(15)代入公式(1),将动力***转化为p:
将式(16)写成
得到状态转换后的动力学方程为:
其中,t是时间,t∈Rn;p是状态转换后的坐标,p∈Rn;状态转换后的速度,是状态转换后的加速度,M′(p,σ,t)是状态转换后的惯性矩阵,M′(p,σ,t)∈Rn×n;是状态转换后的科氏项和离心项的矩阵,G′(p,σ,t)是状态转换后的重力项,G′(p,σ,t)∈Rn×n;表示状态转换后的摩擦力和其他外部扰动,
所述步骤(3)具体是指:
假设公式(18)中的矩阵/向量M′、C′、G′、F′分解为:
所述控制器有以下性能要求:
(3b)基于性能要求(3a),对于给定p∈Rm×R,p>0,设
这里λ>0;
(3d)存在一个未知常数向量α∈(0,∞)k和一个已知函数∏(·)
综上,设计一种自适应鲁棒控制器:
其中:
这里:
所述步骤(4)具体是指:
给出李雅普诺夫候选函数:
对公式(30)进行计算得到:
最终,得出受控欠驱动机械***的解满足一致有界性的结论;
一致最终有界性由下式表示:
所述步骤(5)具体是指:
针对自平衡电动轮椅欠驱动***,其动力学具体描述如下:
***动能为:
***势能为:
V=mglcos(θ(t)) (35)
由拉格朗日动力学方程推导出:
要计算出车体的倾角,通过重力加速度在其他轴上产生的分量来计算出角度,即测量X轴或Y轴某一轴向的加速度计算出倾角,在传感器静止水平时,X轴与Y轴不会有输出,而在其产生一定的倾角时才会使重力加速度g在X轴或Y轴上产生分量,而且该轴倾斜的角度和重力分量的大小相关;利用C语言中的atan2(x,y)函数,计算X轴与Z轴平面或者Y轴与Z轴平面的当前方位角,同时将其值转化为角度值,计算方法如下:
Angle_X=atan2(Accel_Y,Accel_Z)*180/PI (38)
Angle_Y=atan2(Accel_X,Accel_Z)*180/PI (39)
假设测得倾角为θ,则加速度大小为:
a=sinθ×g+cosθ×a′ (40)
其中,a′代表了线加速度与角加速度的和;
假设约束为θm<θ<θM,所选转换函数为:
将公式(42)代到公式(37)中,得到:
由状态转换方程得到:
***伺服跟踪控制率如下:
其中:
这里:
将得到的转矩τ作为电流输入,控制电机转速,根据所求参数表达以及求得控制率进行数值仿真,对所设计自适应鲁棒控制器里面主要参数进行调节,主要包括控制参数和自适应率参数,对控制效果进行分析,最后给出结论。在这里,给出结论是指所设计鲁棒控制器能够很好地跟踪预定的轨迹并对自平衡电动轮椅欠驱动***中的不确定性进行补偿。
分析控制器参数改变对伺服跟踪效果的影响,验证所设计控制器是否满足伺服跟踪精度要求。
具体分析效果如下:
用李雅普诺夫方法验证了***的一致有界性和一致最终有界性。分析结果,选择控制参数κ>0,自适应律参数k1>0,k2>0,常数则***是稳定的。但这些参数的取值会影响***性能。当时,均匀最终有界区域随着的κ,k1增大和k2的减小而逐渐减小。当时,均匀最终有界区域随着k2的增大和κ,k1的减小而逐渐减小。注意,当时,κ不影响一致最终有界区域。因此,这些参数的选择是根据具体的机械***和实际工程要求。
如图2所示,首先,由状态转换后的动力学方程、目标约束、以及假设要求写出***的名义控制器P1,然后根据***的误差提出补偿初始条件不相容问题的控制器P2,再根据通过设计自适应律提出补偿***不确定性的控制器p3。
如图3所示,用两个平衡轮进行驱动,拥有结构简单,成本低,转弯半径小,操控灵活等优点。
如图4所示,通过仿真示意图可以看出实际的轨迹近似于期望的轨迹。由于初始条件偏离轨迹约束,导致跟踪误差较大。一段时间后,通过所提出的控制,跟踪误差变小并收敛到零,验证了本发明所设计控制器的优越性。
综上所述,为了解决所提欠驱动***中存在的不确定性问题,本发明从约束跟随的角度提出了一种新的自适应鲁棒控制方法。这些不确定性通常是(可能是快速的)时变的,它们是未知的,但有限的;然而,边界是已知的,通过状态不等式转换将有界状态转换为新的无界状态,理论分析和数值仿真验证了补偿控制不确定性的有效性。理论分析表明,该控制能够保证***的一致有界性和一致最终有界性,算例的数值仿真结果表明,该控制能够很好地跟踪预定的训练轨迹并补偿不确定性。
Claims (6)
1.一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法,其特征在于:包括:
(1)建立具有不确定参数的自平衡电动轮椅欠驱动***的动力学模型,其公式如下:
并写成二阶微分的形式,以满足伺服约束的要求;
(2)通过状态转换函数,将自平衡电动轮椅欠驱动***输出由有界状态转换为无界状态,得到状态转换后的动力学方程为:
保证自平衡电动轮椅欠驱动***输出控制在所设定的期望范围内,并保证控制自平衡电动轮椅欠驱动***的一致有界性和最终有界性;
(3)针对经过状态转换后的自平衡电动轮椅欠驱动***中存在的不确定性,设计一种自适应鲁棒控制器;
(4)利用李雅普诺夫方法对自适应鲁棒控制器的一致有界性和最终有界性进行验证;
(5)根据自平衡电动轮椅欠驱动***进行数值仿真,并对所设计自适应鲁棒控制器的主要参数进行调节;
(6)最后对鲁棒控制器的控制效果进行分析,并给出结论。
2.根据权利要求1所述的自平衡电动轮椅欠驱动***跟踪控制器的设计方法,其特征在于:所述步骤(1)具体是指:
自平衡电动轮椅欠驱动***的动力学模型的公式如下:
其中,t是时间,t∈Rn;q是角位移,q∈Rn;是角速度, 是角加速度,Rn表示维数为n的自然数集;σ是不确定参数,代表σ的可能界限是未知有界的;τ为控制输入,τ∈Rm,m<n,m和n表示矩阵维数,m为行,n为列;S是控制系数的矩阵,S∈Rn×m;Rn×m表示n行、m列的自然数矩阵;M(q,σ,t)是惯性矩阵,M(q,σ,t)∈Rn×n;Rn×n表示n行、n列的自然数矩阵;是科氏项和离心项的矩阵,G(q,σ,t)是重力项,表示摩擦力和其他外部扰动,矩阵或者向量M(q,σ,t),G(q,σ,t)和具有适当的维数;
假设函数M(.),C(.),G(.)都是连续的,给出如下伺服约束形式:
其中q是位置,t是时间,Bli(·)和dl(·)都是列向量,把约束条件写成矩阵形式:
B(q,t)=d(q,t) (3)
B=[Bli]m×n,d=[d1,d2,...,dm]T,这是零阶形式的约束;
将公式(2)的伺服约束形式对t进行微分,得到:
其中:
将公式(4)的约束条件写成矩阵形式:
这里A=[Ali]m×n,c=[c1,c2,...,cm]T这是一阶形式约束;
对公式(4)的一阶形式对t进行微分,得到:
其中:
写成矩阵形式:
其中b=[b1,b2,...,bm]T为二阶形式约束。
3.根据权利要求1所述的自平衡电动轮椅欠驱动***跟踪控制器的设计方法,其特征在于:所述步骤(2)具体是指:
基于自平衡电动轮椅欠驱动***的动力学模型的公式(1),假定当t→+∞时q(t)→qd,不等式约束为qm<q(t)<qM,这里qd是q期望的值,qm和qM分别是q的最大值和最小值,然后,通过选择合适的函数α(q),应用状态转换将状态q无限制地转换为一个新的状态p;
函数p=α(q)满足当q→qd时p→pd以及当q∈(qm,qM)时p∈(-∞,+∞);由于p=α(q),有:
q=α-1(p) (11)
对公式(11)求一阶导数:
上式写成:
对公式(11)求二阶导数:
上式写成:
将公式(13)和公式(15)代入公式(1),将动力***转化为p:
将式(16)写成
得到状态转换后的动力学方程为:
4.根据权利要求1所述的自平衡电动轮椅欠驱动***跟踪控制器的设计方法,其特征在于:所述步骤(3)具体是指:
假设公式(18)中的矩阵/向量M′、C′、G′、F′分解为:
所述控制器有以下性能要求:
(3b)基于性能要求(3a),对于给定p∈Rm×R,p>0,设
这里λ>0;
综上,设计一种自适应鲁棒控制器:
其中:
这里:
6.根据权利要求1所述的自平衡电动轮倚欠驱动***跟踪控制器的设计方法,其特征在于:所述步骤(5)具体是指:
针对自平衡电动轮椅欠驱动***,其动力学具体描述如下:
***动能为:
***势能为:
V=mglcos(θ(t))
(35)
由拉格朗日动力学方程推导出:
要计算出车体的倾角,通过重力加速度在其他轴上产生的分量来计算出角度,即测量X轴或Y轴某一轴向的加速度计算出倾角,在传感器静止水平时,X轴与Y轴不会有输出,而在其产生一定的倾角时才会使重力加速度g在X轴或Y轴上产生分量,而且该轴倾斜的角度和重力分量的大小相关;利用C语言中的atan2(x,y)函数,计算X轴与Z轴平面或者Y轴与Z轴平面的当前方位角,同时将其值转化为角度值,计算方法如下:
Angle_X=atan2(Accel_Y,Accel_Z)*180/PI (38)
Angle_Y=atan2(Accel_X,Accel_Z)*180/PI (39)
假设测得倾角为θ,则加速度大小为:
a=sinθ×g+cosθ×a′ (40)
其中,a′代表了线加速度与角加速度的和;
假设约束为θm<θ<θM,所选转换函数为:
将公式(42)代到公式(37)中,得到:
由状态转换方程得到:
***伺服跟踪控制率如下:
其中:
这里:
将得到的转矩τ作为电流输入,控制电机转速,根据所求参数表达以及求得控制率进行数值仿真,对所设计自适应鲁棒控制器里面主要参数进行调节,主要包括控制参数和自适应率参数,对控制效果进行分析,最后给出结论。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110837420.5A CN113419433B (zh) | 2021-07-23 | 2021-07-23 | 一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110837420.5A CN113419433B (zh) | 2021-07-23 | 2021-07-23 | 一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113419433A true CN113419433A (zh) | 2021-09-21 |
CN113419433B CN113419433B (zh) | 2022-07-05 |
Family
ID=77719593
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110837420.5A Active CN113419433B (zh) | 2021-07-23 | 2021-07-23 | 一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113419433B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114115252A (zh) * | 2021-11-15 | 2022-03-01 | 合肥中科深谷科技发展有限公司 | 一种基于不等式约束的关节模组鲁棒控制方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10133703A (ja) * | 1996-10-31 | 1998-05-22 | Fujitsu Ltd | 適応的ロバスト制御装置 |
CN107368081A (zh) * | 2015-08-17 | 2017-11-21 | 杭州电子科技大学 | 一种两轮自平衡机器人自适应滑模变结构控制*** |
CN107479556A (zh) * | 2017-09-15 | 2017-12-15 | 大连理工大学 | 两轮自平衡车主动避障轨迹规划与稳定跟踪控制方法 |
CN108459605A (zh) * | 2018-03-22 | 2018-08-28 | 合肥工业大学 | 基于agv***的轨迹跟踪控制方法 |
CN108693776A (zh) * | 2018-07-25 | 2018-10-23 | 长安大学 | 一种三自由度Delta并联机器人的鲁棒控制方法 |
CN108942928A (zh) * | 2018-07-06 | 2018-12-07 | 合肥工业大学 | 一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂*** |
CN110244561A (zh) * | 2019-06-11 | 2019-09-17 | 湘潭大学 | 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 |
CN110376902A (zh) * | 2019-08-19 | 2019-10-25 | 合肥工业大学 | 一种欠驱动机械***伺服约束跟踪控制器的设计方法 |
CN111596545A (zh) * | 2020-04-27 | 2020-08-28 | 江苏建筑职业技术学院 | 一种多输入多输出机械***自适应容错预设性能控制方法 |
-
2021
- 2021-07-23 CN CN202110837420.5A patent/CN113419433B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10133703A (ja) * | 1996-10-31 | 1998-05-22 | Fujitsu Ltd | 適応的ロバスト制御装置 |
CN107368081A (zh) * | 2015-08-17 | 2017-11-21 | 杭州电子科技大学 | 一种两轮自平衡机器人自适应滑模变结构控制*** |
CN107479556A (zh) * | 2017-09-15 | 2017-12-15 | 大连理工大学 | 两轮自平衡车主动避障轨迹规划与稳定跟踪控制方法 |
CN108459605A (zh) * | 2018-03-22 | 2018-08-28 | 合肥工业大学 | 基于agv***的轨迹跟踪控制方法 |
CN108942928A (zh) * | 2018-07-06 | 2018-12-07 | 合肥工业大学 | 一种基于约束力鲁棒伺服控制的欠驱动柔性机械臂*** |
CN108693776A (zh) * | 2018-07-25 | 2018-10-23 | 长安大学 | 一种三自由度Delta并联机器人的鲁棒控制方法 |
CN110244561A (zh) * | 2019-06-11 | 2019-09-17 | 湘潭大学 | 一种基于干扰观测器的二级倒立摆自适应滑模控制方法 |
CN110376902A (zh) * | 2019-08-19 | 2019-10-25 | 合肥工业大学 | 一种欠驱动机械***伺服约束跟踪控制器的设计方法 |
CN111596545A (zh) * | 2020-04-27 | 2020-08-28 | 江苏建筑职业技术学院 | 一种多输入多输出机械***自适应容错预设性能控制方法 |
Non-Patent Citations (1)
Title |
---|
XIAOLONG CHEN: "A novel adaptive robust control approach for underactuated mobile robot", 《JOURNAL OF THE FRANKLIN INSTITUTE》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114115252A (zh) * | 2021-11-15 | 2022-03-01 | 合肥中科深谷科技发展有限公司 | 一种基于不等式约束的关节模组鲁棒控制方法 |
CN114115252B (zh) * | 2021-11-15 | 2024-03-15 | 合肥中科深谷科技发展有限公司 | 一种基于不等式约束的关节模组鲁棒控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113419433B (zh) | 2022-07-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111546315B (zh) | 一种基于人机协作的机器人柔顺示教及再现方法 | |
Nawawi et al. | Real-time control of a two-wheeled inverted pendulum mobile robot | |
Guo et al. | Design of automatic steering controller for trajectory tracking of unmanned vehicles using genetic algorithms | |
Qazani et al. | Adaptive washout filter based on fuzzy logic for a motion simulation platform with consideration of joints’ limitations | |
CN109465825A (zh) | 机械臂柔性关节的rbf神经网络自适应动态面控制方法 | |
Liu et al. | Adaptive finite-time control for half-vehicle active suspension systems with uncertain dynamics | |
US20210162589A1 (en) | Systems and methods for learning agile locomotion for multiped robots | |
Naude et al. | Optimisation of road vehicle passive suspension systems. Part 1. Optimisation algorithm and vehicle model | |
CN112077839B (zh) | 一种机械臂的运动控制方法及装置 | |
Gritli et al. | LMI-based synthesis of a robust saturated controller for an underactuated mechanical system subject to motion constraints | |
CN115586724B (zh) | 一种齿轮巡检机器人***自适应分数阶全局滑模控制方法 | |
CN114510063B (zh) | 一种无人履带车辆及其轨迹跟踪控制方法和*** | |
Asali et al. | Modeling, simulation, and optimal control for two-wheeled self-balancing robot | |
Nikpour et al. | Stability and direction control of a two-wheeled robotic wheelchair through a movable mechanism | |
CN113419433B (zh) | 一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 | |
Goher et al. | Bacterial foraging-optimized PID control of a two-wheeled machine with a two-directional handling mechanism | |
Pham et al. | Balancing and tracking control of ballbot mobile robots using a novel synchronization controller along with online system identification | |
Mohan et al. | Coupled dynamic control of unicycle robot using integral linear quadratic regulator and sliding mode controller | |
Transeth | Modelling and control of snake robots | |
Kanarachos | Design of an intelligent feed forward controller system for vehicle obstacle avoidance using neural networks | |
CN116551669A (zh) | 仿人机器人动态跳跃与平衡控制方法、电子设备、介质 | |
CN112975965B (zh) | 仿人机器人的解耦控制方法、装置和仿人机器人 | |
Guan et al. | Kinematic modeling, analysis, and verification of an Essboard-like robot | |
CN114690626A (zh) | 自平衡设备的平衡控制方法、装置、设备及存储介质 | |
Hoang et al. | Adaptive Fuzzy Hierarchical Sliding Mode Control for Ball Segway |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |