CN112947079B - 一种板球***的轨迹跟踪控制方法 - Google Patents
一种板球***的轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN112947079B CN112947079B CN202110154835.2A CN202110154835A CN112947079B CN 112947079 B CN112947079 B CN 112947079B CN 202110154835 A CN202110154835 A CN 202110154835A CN 112947079 B CN112947079 B CN 112947079B
- Authority
- CN
- China
- Prior art keywords
- cricket
- follows
- nonlinear
- axis
- order
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000013178 mathematical model Methods 0.000 claims abstract description 10
- 230000033228 biological regulation Effects 0.000 claims abstract description 8
- 238000006073 displacement reaction Methods 0.000 claims description 18
- 230000001133 acceleration Effects 0.000 claims description 10
- 239000011159 matrix material Substances 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000005484 gravity Effects 0.000 claims description 4
- 150000001875 compounds Chemical class 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 6
- 239000008188 pellet Substances 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 238000012795 verification 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
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)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开了一种板球***的轨迹跟踪控制方法,该方法包括以下步骤:步骤1,建立板球***的非线性数学模型;步骤2,将板球***的轨迹跟踪控制问题描述成一个非线性伺服控制问题;步骤3,基于非线性输出调节理论,采用3阶多项式逼近调节器方程的解,设计3阶状态反馈控制器。本发明基于板球***的非线性数学模型设计反馈控制器,解决了该***在时变参考信号下的轨迹跟踪控制问题,具有较高精度的跟踪性能。
Description
技术领域
本发明涉及非线性***控制领域,尤其涉及一种板球***的轨迹跟踪控制方法。
背景技术
近几十年来,非线性输出调节理论得到了控制界的广泛关注,其显著的优点在于能够实现轨迹跟踪、干扰抑制和鲁棒性等多种控制目标。常用的控制策略包括反馈控制和内模控制。板球***是一个具有非线性、强耦合、多变量的多输入多输出***,常常被用来检验各种先进控制算法。板球***的轨迹跟踪控制问题可以被描述成一个非线性伺服控制问题。尽管一些文献采用了滑模控制等先进控制算法来解决板球***的轨迹跟踪问题,但往往基于简化的板球***模型,难以达到满意的控制效果。如何基于未简化的非线性数学模型设计反馈控制器实现板球***在时变参考信号下的轨迹跟踪控制有待于进一步研究。
发明内容
基于背景技术存在的技术问题,本发明提出了一种板球***的轨迹跟踪控制方法。针对板球***,基于非线性输出调节理论,采用3阶多项式逼近调节器方程的解,设计3阶状态反馈控制器来实现板球***在时变参考信号下的轨迹跟踪目标。
本发明采用的技术方案是:
一种板球***的轨迹跟踪控制方法,包括以下步骤:
步骤1,建立板球***的非线性数学模型;
步骤2,将板球***的轨迹跟踪控制问题描述成一个非线性伺服控制问题;
步骤3,基于非线性输出调节理论,采用3阶多项式逼近调节器方程的解,设计3阶状态反馈控制器。
进一步地,所述的一种板球***的轨迹跟踪控制方法,其特征在于,步骤1中,假设小球一直与平板接触,板球之间的滑动摩擦力忽略不计,则所述板球***的数学模型描述如下:
其中,分别表示小球在平板上x轴与y轴方向的位移,速度,加速度,分别表示平板在x轴与y轴方向的偏转角,偏转角速度,偏转角加速度,m表示小球的质量,(Ip,Ib)分别表示平板与小球的转动惯量,(τx,τy)分别表示施加在平板上的x轴方向的力矩与y轴方向的力矩,g表示重力加速度;
令
则***(1)可写为如下形式:
其中
η3=-mx1x5(-2mx4x5x6-mx2x4x5-mx1x4x6-mgx1cosx8)
η4=-mx1x5(-2mx1x2x4-mx2x5x8-mx1x6x8-mgx1cosx3)
进一步地,所述的一种板球***的轨迹跟踪控制方法,步骤2中,将板球***的轨迹跟踪控制问题描述成一个非线性伺服控制问题,其过程如下:
2.1,假设板球***中小球在x轴与y轴方向的位移参考轨迹为两个正弦信号yd1=F1sin(ω1t+θ1),yd2=F2sin(ω2t+θ2),此位移参考轨迹可由如下形式的外部***产生:
其中v=[v1,v2,v3,v4]T,输出为yd1=v1,yd2=v3;
2.2,定义跟踪误差为
2.3,板球***(2)、外部***(3)和误差函数(4)可以被写为如下的紧凑形式:
其中F(x(t),u(t),v(t))描述如下:
此时板球***的小球位移轨迹跟踪控制问题已被描述成一个非线性伺服控制问题,其控制目标是在保证闭环***稳定的前提下设计控制器u使得小球位移轨迹跟踪上参考信号且稳态跟踪误差足够小。
进一步地,所述的一种板球***的轨迹跟踪控制方法,其特征在于,步骤3中,基于非线性输出调节理论,采用3阶多项式逼近调节器方程的解,设计3阶状态反馈控制器,过程如下:
3.1,求板球***的雅克比矩阵如下:
通过计算可以证明:
由2.1和3.1可知板球***的3阶非线性输出调节问题是可解的,并且因为输入维数等于输出维数,调节器方程的解唯一;
3.2,求板球***调节器方程的解,过程如下:
板球***调节器方程具有如下形式:
其中
η3(v)=-mx1(v)x5(v)[-2mx4(v)x5(v)x6(v)-mx2(v)x4(v)x5(v)-mx1(v)x4(v)x6(v)-mgx1(v)cos x8(v)]
η4(v)=-mx1(v)x5(v)[-2mx1(v)x2(v)x4(v)-mx2(v)x5(v)x8(v-mx1(v)x6(v)x8(v)-mgx1(v)cos x3(v)]
通过简单的计算可以得到调节器方程的部分解如下:
x1(v)=v1
x2(v)=ω1v2
x5(v)=v3
x6(v)=ω2v4
因为调节器方程的其他解的精确值不可得,因此采用多项式逼近法来获得其近似解,通过数学计算,可以得到其他的3阶近似解如下:
这里
d1000=gm
3.3,设计3阶状态反馈控制器如下:
u=y(3)(v)+Kx(x-x(3)(v)) (7)
其中
Kx=[K1,K2]T
本发明的优点是:
本发明基于板球***的非线性数学模型设计反馈控制器,解决了该***在时变参考信号下的轨迹跟踪控制问题,具有较高精度的跟踪性能。
附图说明
图1为3阶状态反馈控制方法图。
图2为小球x轴与y轴位移轨迹跟踪效果图。
图3为小球实际轨迹图。
图4为1阶和3阶控制器作用下的小球位移跟踪误差对比图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。
一种板球***的轨迹跟踪控制方法,包括以下步骤:
步骤1,建立板球***的非线性数学模型,过程如下:
假设小球一直与平板接触,板球之间的滑动摩擦力忽略不计,则所述板球***的数学模型描述如下:
其中,分别表示小球在平板上x轴与y轴方向的位移,速度,加速度,分别表示平板在x轴与y轴方向的偏转角,偏转角速度,偏转角加速度,m表示小球的质量,(Ip,Ib)分别表示平板与小球的转动惯量,(τx,τy)分别表示施加在平板上的x轴方向的力矩与y轴方向的力矩,g表示重力加速度;
令
则***(1)可写为如下形式:
其中
η3=-mx1x5(-2mx4x5x6-mx2x4x5-mx1x4x6-mgx1cos x8)
η4=-mx1x5(-2mx1x2x4-mx2x5x8-mx1x6x8-mgx1cos x3)
步骤2,将板球***的轨迹跟踪控制问题描述成一个非线性伺服控制问题,过程如下:
2.1,假设板球***中小球在x轴与y轴方向的位移参考轨迹为两个正弦信号yd1=F1sin(ω1t+θ1),yd2=F2sin(ω2t+θ2),此位移参考轨迹可由如下形式的外部***产生:
其中v=[v1,v2,v3,v4]T,输出为yd1=v1,yd2=v3;
2.2,定义跟踪误差为
2.3,板球***(2)、外部***(3)和误差函数(4)可以被写为如下的紧凑形式:
其中F(x(t),u(t),v(t))描述如下:
此时板球***的小球位移轨迹跟踪控制问题已被描述成一个非线性伺服控制问题,其控制目标是在保证闭环***稳定的前提下设计控制器u使得小球位移轨迹跟踪上参考信号且稳态跟踪误差足够小。
步骤3,基于非线性输出调节理论,采用3阶多项式逼近调节器方程的解,设计3阶状态反馈控制器,过程如下:
3.1,求板球***的雅克比矩阵如下:
通过计算可以证明:
由2.1和3.1可知板球***的3阶非线性输出调节问题是可解的,并且因为输入维数等于输出维数,调节器方程的解唯一;
3.2,求板球***调节器方程的解,过程如下:
板球***调节器方程具有如下形式:
其中
η3(v)=-mx1(v)x5(v)[-2mx4(v)x5(v)x6(v)-mx2(v)x4(v)x5(v-mx1(v)x4(v)x6(v)-mgx1(v)cos x8(v)]
η4(v)=-mx1(v)x5(v)[-2mx1(v)x2(v)x4(v)-mx2(v)x5(v)x8(v-mx1(v)x6(v)x8(v)-mgx1(v)cos x3(v)]
通过简单的计算可以得到调节器方程的部分解如下:
x1(v)=v1
x2(v)=ω1v2
x5(v)=v3
x6(v)=ω2v4
因为调节器方程的其他解的精确值不可得,因此采用多顶式逼近法来获得其近似解,通过数学计算,可以得到其他的3阶近似解如下:
这里
d1000=gm
3.4,设计3阶状态反馈控制器如下:
u=u(3)(v)+Kx(x-x(3)(v)) (7)
其中
Kx=[K1,K2]T
为了验证所提方法的有效性,本发明对3阶状态反馈控制器(7)及形式为u=u(1)(v)+Kx(x-x(1)(v))的1阶状态反馈控制器的控制效果进行仿真验证,其中
u(1)(v)=[c1000v1,d1000v1+d0010v3]T
x(1)(v)=[x1(v),x2(v),a1000v1,a1000ω1v2,x5(v),x6(v),v0010v3,v0010ω2v4]T
仿真验证的具体参数如下:
重力加速度g=9.8m/s2,小球的质量m=0.038kg,小球的转动惯量Ib=4.2×10- 6kg·m2,小球的半径rb=0.015m,平板的转动惯量Ip=1.1kg·m2。
状态反馈控制增益矩阵设置为:
本实施例跟踪幅值F1=F2=Am的正弦参考信号yd1=Amsin2t和在图2-图4中,Am=0.5。图2和图3分别为3阶控制器作用下小球x轴与y轴跟踪效果图和小球实际轨迹图,图4为1阶和3阶控制器作用下的小球位移跟踪误差对比图。
同时为了说明阶次越高,控制器精度越高,跟踪效果越好,本实施例列出了Am取不同数值时,小球在1阶和3阶控制器作用下的最大稳态跟踪误差结果,如表1所示:
表1 1阶和3阶控制器作用下的最大稳态跟踪误差
从图2-图4的仿真结果可以看出:在3阶状态反馈控制器作用下,小球的位移能够快速地跟踪上参考信号,且稳态跟踪误差非常小;从图4和表1可以看出3阶状态反馈控制器的最大稳态跟踪误差小于1阶,跟踪效果更好。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。
Claims (1)
1.一种板球***的轨迹跟踪控制方法,其特征在于,包括以下步骤:
步骤1,建立板球***的非线性数学模型;
步骤2,将板球***的轨迹跟踪控制问题描述成一个非线性伺服控制问题;
步骤3,基于非线性输出调节理论,采用3阶多项式逼近调节器方程的解,设计3阶状态反馈控制器;
步骤1中,假设小球一直与平板接触,板球之间的滑动摩擦力忽略不计,则所述板球***的非线性数学模型描述如下:
其中,(x,y),分别表示小球在平板上x轴与y轴方向的位移,速度,加速度,(α,β),分别表示平板在x轴与y轴方向的偏转角,偏转角速度,偏转角加速度,m表示小球的质量,(Ip,Ib)分别表示平板与小球的转动惯量,(τx,τy)分别表示施加在平板上的x轴方向的力矩与y轴方向的力矩,g表示重力加速度;
令
则***(1)可写为如下形式
其中
η3=-mx1x5(-2mx4x5x6-mx2x4x5-mx1x4x6-mgx1cosx8)
η4=-mx1x5(-2mx1x2x4-mx2x5x8-mx1x6x8-mgx1cosx3)
步骤2中,将板球***的轨迹跟踪控制问题描述成一个非线性伺服控制问题,其过程如下:
2.1,假设板球***中小球在x轴与y轴方向的位移参考轨迹为两个正弦信号yd1=F1sin(ω1t+θ1),yd2=F2sin(ω2t+θ2),此位移参考轨迹可由如下形式的外部***产生:
其中v=[v1,v2,v3,v4]T,输出为yd1=v1,yd2=v3;
2.2,定义跟踪误差为
2.3,板球***(2)、外部***(3)和误差函数(4)可以被写为如下的紧凑形式:
其中F(x(t),u(t),v(t))描述如下:
此时板球***的轨迹跟踪控制问题已被描述成一个非线性伺服控制问题,其控制目标是在保证闭环***稳定的前提下设计控制器u使得小球位移跟踪上参考信号且稳态跟踪误差充分小;
步骤3中,基于非线性输出调节理论,采用3阶多项式逼近调节器方程的解,设计3阶状态反馈控制器,过程如下:
3.1,求板球***的雅克比矩阵如下:
通过计算可以证明:
由2.1和3.1可知板球***的3阶非线性输出调节问题是可解的,并且因为输入维数等于输出维数,调节器方程的解唯一;
3.2,求板球***调节器方程的解,过程如下:
板球***调节器方程具有如下形式:
其中
η3(v)=-mx1(v)x5(v)[-2mx4(v)x5(v)x6(v)-mx2(v)x4(v)x5(v)-mx1(v)x4(v)x6(v)-mgx1(v)cosx8(v)]
η4(v)=-mx1(v)x5(v)[-2mx1(v)x2(v)x4(v)-mx2(v)x5(v)x8(v)-mx1(v)x6(v)x8(v)-mgx1(v)cosx3(v)]
通过简单的计算可以得到调节器方程的部分解如下:
x1(v)=v1
x2(v)=ω1v2
x5(v)=v3
x6(v)=ω2v4
因为调节器方程的其他解的精确值不可得,因此采用多项式逼近法来获得其近似解,通过数学计算,可以得到其他的3阶近似解如下:
这里
d1000=gm
3.3,设计3阶状态反馈控制器如下:
u=u(3)(v)+Kx(x-x(3)(v)) (7)
其中
Kx=[K1,K2]T
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110154835.2A CN112947079B (zh) | 2021-02-04 | 2021-02-04 | 一种板球***的轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110154835.2A CN112947079B (zh) | 2021-02-04 | 2021-02-04 | 一种板球***的轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112947079A CN112947079A (zh) | 2021-06-11 |
CN112947079B true CN112947079B (zh) | 2022-03-29 |
Family
ID=76243856
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110154835.2A Active CN112947079B (zh) | 2021-02-04 | 2021-02-04 | 一种板球***的轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947079B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114114903B (zh) * | 2021-10-19 | 2023-08-22 | 昆明理工大学 | 一种基于变指数幂次趋近律的板球***积分终端滑模控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6013997A (en) * | 1998-08-07 | 2000-01-11 | Tower Automotive, Inc. | Three dimensional tactile seam tracing device |
CN109976188A (zh) * | 2019-03-12 | 2019-07-05 | 广东省智能制造研究所 | 一种基于时间自动机的板球控制方法及*** |
CN110161848A (zh) * | 2019-03-12 | 2019-08-23 | 广东省智能制造研究所 | 一种基于时间自动机的一阶直线倒立摆控制方法及*** |
CN111538274A (zh) * | 2020-05-22 | 2020-08-14 | 滨州学院 | 一种视觉控制的板球控制*** |
-
2021
- 2021-02-04 CN CN202110154835.2A patent/CN112947079B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6013997A (en) * | 1998-08-07 | 2000-01-11 | Tower Automotive, Inc. | Three dimensional tactile seam tracing device |
CN109976188A (zh) * | 2019-03-12 | 2019-07-05 | 广东省智能制造研究所 | 一种基于时间自动机的板球控制方法及*** |
CN110161848A (zh) * | 2019-03-12 | 2019-08-23 | 广东省智能制造研究所 | 一种基于时间自动机的一阶直线倒立摆控制方法及*** |
CN111538274A (zh) * | 2020-05-22 | 2020-08-14 | 滨州学院 | 一种视觉控制的板球控制*** |
Non-Patent Citations (3)
Title |
---|
Hongwei Liu ; Yanyang Liang.Trajectory tracking sliding mode control of ball and plate system.《2010 2nd International Asia Conference on Informatics in Control, Automation and Robotics (CAR 2010)》.2010,第142-145页. * |
基于LM-RBF-PID的板球***轨迹控制;黄文杰 等;《计算机工程与科学》;20200831;第42卷(第8期);全文 * |
板球***的定点与轨迹跟踪控制器设计;高多;《CNKI中国优秀硕士学位论文全文数据库(电子期刊)信息科技辑》;20190630;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112947079A (zh) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111618858B (zh) | 一种基于自适应模糊滑模的机械手鲁棒跟踪控制算法 | |
CN108983606B (zh) | 一种机械臂***的鲁棒滑模自适应控制方法 | |
CN108319144B (zh) | 一种机器人轨迹跟踪控制方法及*** | |
CN106249602B (zh) | 桥式吊车有限时间轨迹跟踪控制器及其设计方法 | |
CN106094530B (zh) | 倒立摆的非线性控制器设计方法 | |
CN107263483B (zh) | 二自由度关节机器人轨迹的协调控制方法 | |
Yu | Nonlinear PD regulation for ball and beam system | |
CN105045103B (zh) | 一种基于LuGre摩擦模型伺服机械手摩擦补偿控制***及方法 | |
CN111258216B (zh) | 一种适用于四旋翼飞行器的滑模重复控制器 | |
CN107132761B (zh) | 一种采用纯模糊与模糊pid复合控制的电动舵机设计方法 | |
CN105171758B (zh) | 一种机器人的自适应有限时间收敛滑模控制方法 | |
CN107621783B (zh) | 基于摩擦补偿的发射平台自适应鲁棒控制方法 | |
CN110936374B (zh) | 一种柔性双关节机械臂命令滤波反步控制方法 | |
CN110842913B (zh) | 一种单关节机械臂的自适应滑模迭代学习控制方法 | |
CN115256386B (zh) | 考虑跟踪误差约束的不确定机械臂神经自适应控制方法 | |
CN112947079B (zh) | 一种板球***的轨迹跟踪控制方法 | |
CN115202216A (zh) | 考虑输入约束的机械臂抗干扰有限时间控制方法 | |
CN111897223B (zh) | 一种考虑自动驾驶仪动态特性的速度追踪制导方法 | |
CN108062024B (zh) | 一种考虑阻力的移动机器人反演滑模控制方法 | |
CN115502986A (zh) | 基于状态观测器的多关节机械臂事件驱动控制方法 | |
CN116679571A (zh) | 基于双反馈循环神经网络的多轴车辆跟踪控制方法 | |
CN114939869A (zh) | 一种基于非奇异快速终端滑模的机械臂轨迹跟踪方法 | |
CN114114903B (zh) | 一种基于变指数幂次趋近律的板球***积分终端滑模控制方法 | |
CN116500908B (zh) | 一种双扰动观测器的机械臂抗干扰约束控制方法 | |
CN110625616B (zh) | 一种考虑机械臂参数不确定和干扰的固定时间控制方法 |
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 |