CN110412870A - 基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法 - Google Patents

基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法 Download PDF

Info

Publication number
CN110412870A
CN110412870A CN201910601017.5A CN201910601017A CN110412870A CN 110412870 A CN110412870 A CN 110412870A CN 201910601017 A CN201910601017 A CN 201910601017A CN 110412870 A CN110412870 A CN 110412870A
Authority
CN
China
Prior art keywords
transmission device
vertical material
material transmission
observer
disturbance
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
Application number
CN201910601017.5A
Other languages
English (en)
Other versions
CN110412870B (zh
Inventor
钱林方
韩乃玉
邹权
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Tech University
Original Assignee
Nanjing Tech University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing Tech University filed Critical Nanjing Tech University
Priority to CN201910601017.5A priority Critical patent/CN110412870B/zh
Publication of CN110412870A publication Critical patent/CN110412870A/zh
Application granted granted Critical
Publication of CN110412870B publication Critical patent/CN110412870B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
    • 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)

Abstract

本发明公开了一种基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，包括以下步骤：构造立式物料传送装置的数学模型；规划其期望运动轨迹；构造立式物料传送装置扰动观测器；构造立式物料传送装置趋近自适应滑模控制***；构建立式物料传送装置控制律，结合趋近自适应滑模控制***即可实现控制立式物料传送装置的位置沿期望运动轨迹变化。本发明构建的扰动状态观测器能实现对立式物料传送装置中存在的时变性扰动项进行有效估计及控制补偿，在此基础上构建的基于趋近律的滑模控制***能消除扰动估计误差。此外，本发明构建的自适应控制***能削弱控制量的抖振，改善控制效果，实现对立式物料传送装置较为准确的位置控制。

Description

基于扰动观测器与趋近自适应滑模的立式物料传送装置控制 方法
技术领域
本发明涉及物料传送装置控制技术领域，特别是一种基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法。
背景技术
物料传送装置作为一种运输装置被广泛应用在建筑、冶金、码头、机械等需要货物运输的场所。通常按照传动方式的不同将其分为皮带式传动运输装备、齿轮式以及链轮式传动运输装备。立式物料传送装置是一种链式传动物料输送装置，具有较高的可靠性，能够适应各种恶劣的工作环境且占用空间较小。
传统的立式物料传送装置的控制方式多为PID算法，此种算法结构较为简单，在工程中参数调节较为方便，但其不能对立式物料传送装置中存在的时变性扰动进行补偿，导致控制精度不高。对于较高精度的立式物料传送装置的位置控制方法有待进一步探索。
发明内容
本发明的目的在于提供一种能实现时变性扰动估计及补偿，进而实现较高位置控制精度的立式物料传送装置控制方法。
实现本发明目的的技术解决方案为：基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，包括以下步骤：
步骤1、构造立式物料传送装置的数学模型：
式中，J为立式物料传送装置等效转动惯量；B为立式物料传送装置的阻尼系数；为伺服电机转子角速度；为伺服电机转子角加速度；u为***控制力矩；dt为立式物料传送装置所包含的时变性扰动项；
步骤2、规划立式物料传送装置的期望运动轨迹；
步骤3、在所述数学模型的基础上构造立式物料传送装置扰动观测器；
步骤4、在所述数学模型和扰动观测器的基础上构造立式物料传送装置趋近自适应滑模控制***；
步骤5、构建立式物料传送装置控制律，结合所述趋近自适应滑模控制***即可实现控制立式物料传送装置的位置沿期望运动轨迹变化。
本发明与现有技术相比，其显著优点为：1)构造的立式物料传送装置扰动观测器，能成功观测***中的时变性扰动函数，并对扰动进行控制补偿；2)以趋近滑模控制理论为基础构造的趋近滑模控制器能消除扰动观测误差，并能改善滑模趋近运动的动态品质；3)为滑模控制***所设计的控制律能有效改善控制量的抖振现象，实现对立式物料传送装置较高精度的位置控制。
下面结合附图对本发明作进一步详细描述。
附图说明
图1为本发明基于扰动观测器与趋近自适应滑模控制的立式物料传送装置控制方法流程图。
图2为本发明基于扰动观测器与趋近自适应滑模控制的立式物料传送装置控制方法的结构图。
图3为本发明基于扰动观测器与趋近自适应滑模控制的立式物料传送装置控制方法的期望轨迹曲线图。
图4为本发明实施例中控制输出力矩曲线图。
图5为本发明实施例中轨迹跟踪误差曲线图。
图6为本发明实施例中随机扰动函数曲线图。
具体实施方式
结合图1、图2，本发明基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，包括以下步骤：
步骤1、构造立式物料传送装置的数学模型：
式中，J为立式物料传送装置等效转动惯量；B为立式物料传送装置的阻尼系数；为伺服电机转子角速度；为伺服电机转子角加速度；u为***控制力矩；dt为立式物料传送装置所包含的时变性扰动项；
步骤2、规划立式物料传送装置的期望运动轨迹；
步骤3、在所述数学模型的基础上构造立式物料传送装置扰动观测器；
步骤4、在所述数学模型和扰动观测器的基础上构造立式物料传送装置趋近自适应滑模控制***；
步骤5、构建立式物料传送装置控制律，结合所述趋近自适应滑模控制***即可实现控制立式物料传送装置的位置沿期望运动轨迹变化。
进一步优选地，步骤2中规划立式物料传送装置的期望运动轨迹，具体为：规划伺服电机转子角位移变化为S型曲线作为立式物料传送装置期望运动轨迹。
进一步地，步骤3构造立式物料传送装置扰动观测器，具体为：
式中，为***扰动观测估计项；参数参数 为对***角速度的估计项；λ1＞0，λ2＞0，λ1，λ2均为扰动观测器系数。
进一步地，步骤4构造立式物料传送装置趋近自适应滑模控制***，具体包括：
步骤4-1、构造滑模函数：
式中，e＝θd-θ为角速度误差；θ为伺服电机转子角位移；θd为伺服电机转子期望角位移轨迹；c为滑模面参数；
步骤4-2、构造滑模面函数等速趋近律：
即
式中，为伺服电机转子期望角加速度；η为滑模切换系数；sgn()为符号函数，k为反馈系数；
步骤4-3、构建立式物料传送装置趋近自适应滑模控制***自适应律：
式中，μ＞0为自适应参数，为滑模***自适应估计参数。
进一步地，步骤5中构建立式物料传送装置控制律具体为：
下面结合实施例对本发明作进一步详细的描述。
实施例
本实施例以立式物料传送装置为具体对象，伺服电机根据本发明方法输出力矩控制立式物料传送装置按照本发明所规划的轨迹曲线进行位移位置跟踪。
利用MATLAB软件中的Smiulink模块搭载立式物料传送装置位置控制的仿真环境，依据本发明的方法编写控制程序，设置***仿真时间为5s，在scope模块中检测仿真结果曲线。
本发明基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，包括以下内容：
1、构造立式物料传送装置的数学模型为：
式中，J为立式物料传送装置等效转动惯量；B为立式物料传送装置的阻尼系数；为伺服电机转子角速度；为伺服电机转子角加速度；u为***控制力矩；dt为立式物料传送装置所包含的时变性扰动项。本实施例中，设置J＝3.79*10-3；B＝5.96*10-4；不失一般性在***仿真环境中设置随机扰动函数如图6所示。
2、规划立式物料传送装置的期望运动轨迹：
规划伺服电机转子角位移变化为S型曲线作为立式物料传送装置的理想运动轨迹，设计伺服电机转子角位移如图3所示，其中最大角位移为600rad，最大角速度为300rad/s，最大角加速度为600rad/s2。
3、构造立式物料传送装置扰动观测器为：
式中，为***扰动观测估计项；参数参数 为对***角速度的估计项；λ1＞0，λ2＞0，λ1，λ2均为扰动观测器系数。
4、构造立式物料传送装置趋近滑模控制***，包括：
4-1、构造滑模函数：
式中，e＝θd-θ为角速度误差，θd为伺服电机转子期望角位移轨迹；c为滑模面参数；本实施例中设置滑模面参数c＝30。
4-2、构造滑模面函数等速趋近律：
即
式中，为伺服电机转子期望角加速度；η为滑模切换系数；sgn()为符号函数，k为反馈系数，本实施例中取k为30。
4-3、构造立式物料传送装置模控制***自适应律；
式中，μ＞0为自适应参数，为滑模***自适应估计参数；本实施例μ设置为0.5。
5、构建立式物料传送装置控制律：
仿真获得的控制输出力矩曲线如图4所示，由图4可以看出，控制量曲线较为平稳，未出现较大的抖振现象，总体来看基本符合预期效果。
仿真获得的轨迹跟踪误差曲线图如图5所示，由图5可以看出，在立式物料传送装置动态跟踪过程中会有较大的误差但依然满足精度要求，而从结果图中可以看到稳态误差几乎为0，从而验证了本发明方法的有效性。
由以上可知，本发明基于扰动观测器与趋近自适应滑模控制的立式物料传送装置的位置控制方法，具有较好的轨迹跟踪性能，能够实现对立式物料传送装置较为精准的位置控制。

Claims (5)

1.一种基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，其特征在于，包括以下步骤：
步骤1、构造立式物料传送装置的数学模型：
式中，J为立式物料传送装置等效转动惯量；B为立式物料传送装置的阻尼系数；为伺服电机转子角速度；为伺服电机转子角加速度；u为***控制力矩；dt为立式物料传送装置所包含的时变性扰动项；
步骤2、规划立式物料传送装置的期望运动轨迹；
步骤3、在所述数学模型的基础上构造立式物料传送装置扰动观测器；
步骤4、在所述数学模型和扰动观测器的基础上构造立式物料传送装置趋近自适应滑模控制***；
步骤5、构建立式物料传送装置控制律，结合所述趋近自适应滑模控制***即可实现控制立式物料传送装置的位置沿期望运动轨迹变化。
2.根据权利要求1所述的基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，其特征在于，步骤2所述规划立式物料传送装置的期望运动轨迹，具体为：规划伺服电机转子角位移变化为S型曲线作为立式物料传送装置期望运动轨迹。
3.根据权利要求1或2所述的基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，其特征在于，步骤3所述构造立式物料传送装置扰动观测器，具体为：
式中，为***扰动观测估计项；参数参数 为对***角速度的估计项；λ1＞0，λ2＞0，λ1，λ2均为扰动观测器系数。
4.根据权利要求3所述的基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，其特征在于，步骤4所述在数学模型和扰动观测器的基础上构造立式物料传送装置趋近自适应滑模控制***，具体包括：
步骤4-1、构造滑模函数：
式中，e＝θd-θ为角速度误差；θ为伺服电机转子角位移；θd为伺服电机转子期望角位移轨迹；c为滑模面参数；
步骤4-2、构造滑模面函数等速趋近律：
即
式中，为伺服电机转子期望角加速度；η为滑模切换系数；sgn()为符号函数，k为反馈系数；
步骤4-3、构建立式物料传送装置趋近自适应滑模控制***自适应律：
式中，μ＞0为自适应参数，为滑模***自适应估计参数。
5.根据权利要求4所述的基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法，其特征在于，步骤5所述构建立式物料传送装置控制律具体为：
CN201910601017.5A 2019-07-04 2019-07-04 基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法 Active CN110412870B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910601017.5A CN110412870B (zh) 2019-07-04 2019-07-04 基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910601017.5A CN110412870B (zh) 2019-07-04 2019-07-04 基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法

Publications (2)

Publication Number Publication Date
CN110412870A true CN110412870A (zh) 2019-11-05
CN110412870B CN110412870B (zh) 2022-03-22

Family

ID=68360276

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910601017.5A Active CN110412870B (zh) 2019-07-04 2019-07-04 基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法

Country Status (1)

Country Link
CN (1) CN110412870B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113885332A (zh) * 2021-10-27 2022-01-04 中国科学院光电技术研究所 一种正时皮带伺服***中基于速率差的扰动观测器控制方法
CN114721274A (zh) * 2022-04-24 2022-07-08 广东工业大学 一种基于改进fal函数的滑模控制器设计方法及***

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0583476A1 (en) * 1992-02-06 1994-02-23 Fanuc Ltd. Adaptive sliding mode control method for control object including spring system
JP2002318602A (ja) * 2001-02-19 2002-10-31 Komatsu Ltd むだ時間を有するプロセス系に対する離散時間スライディングモード制御装置及び方法
CN105116725A (zh) * 2015-07-17 2015-12-02 浙江工业大学 基于扩张状态观测器的伺服***自适应滑模控制方法
CN106788044A (zh) * 2017-02-16 2017-05-31 江苏大学 一种基于干扰观测器的永磁同步电机自适应非奇异终端滑模控制方法
CN108009324A (zh) * 2017-11-22 2018-05-08 南京理工大学 一种复杂机械***关键参数误差综合评估方法
CN108233781A (zh) * 2018-01-18 2018-06-29 南京理工大学 一种基于非线性干扰观测器的直流无刷电机自适应反演滑模控制方法
CN108614425A (zh) * 2018-06-06 2018-10-02 黄山学院 移动机器人自适应积分滑模控制方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0583476A1 (en) * 1992-02-06 1994-02-23 Fanuc Ltd. Adaptive sliding mode control method for control object including spring system
JP2002318602A (ja) * 2001-02-19 2002-10-31 Komatsu Ltd むだ時間を有するプロセス系に対する離散時間スライディングモード制御装置及び方法
CN105116725A (zh) * 2015-07-17 2015-12-02 浙江工业大学 基于扩张状态观测器的伺服***自适应滑模控制方法
CN106788044A (zh) * 2017-02-16 2017-05-31 江苏大学 一种基于干扰观测器的永磁同步电机自适应非奇异终端滑模控制方法
CN108009324A (zh) * 2017-11-22 2018-05-08 南京理工大学 一种复杂机械***关键参数误差综合评估方法
CN108233781A (zh) * 2018-01-18 2018-06-29 南京理工大学 一种基于非线性干扰观测器的直流无刷电机自适应反演滑模控制方法
CN108614425A (zh) * 2018-06-06 2018-10-02 黄山学院 移动机器人自适应积分滑模控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
陈龙淼: "基于扰动观测器的传弹机械手自适应滑模控制", 《南京理工大学学报》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113885332A (zh) * 2021-10-27 2022-01-04 中国科学院光电技术研究所 一种正时皮带伺服***中基于速率差的扰动观测器控制方法
CN113885332B (zh) * 2021-10-27 2023-10-03 中国科学院光电技术研究所 一种正时皮带伺服***中基于速率差的扰动观测器控制方法
CN114721274A (zh) * 2022-04-24 2022-07-08 广东工业大学 一种基于改进fal函数的滑模控制器设计方法及***
CN114721274B (zh) * 2022-04-24 2022-11-01 广东工业大学 一种基于改进fal函数的滑模控制器设计方法及***

Also Published As

Publication number Publication date
CN110412870B (zh) 2022-03-22

Similar Documents

Publication Publication Date Title
CN107121977B (zh) 基于双层结构的机械臂执行器故障容错控制***及其方法
CN109159151A (zh) 一种机械臂空间轨迹跟踪动态补偿方法和***
CN108942924A (zh) 基于多层神经网络的模型不确定性机械臂运动控制方法
CN108983606A (zh) 一种机械臂***的鲁棒滑模自适应控制方法
CN105773623A (zh) 基于预测型间接迭代学习的scara机器人轨迹跟踪控制方法
CN111258216B (zh) 一种适用于四旋翼飞行器的滑模重复控制器
CN106777475B (zh) 一种有限空间约束的注塑机械臂动力学协同仿真方法
CN104898688A (zh) Uuv四自由度动力定位自适应抗扰滑模控制***及控制方法
CN106393116A (zh) 具有初态学习的机械臂分数阶迭代学习控制方法及***
CN104360596B (zh) 机电伺服***有限时间摩擦参数辨识和自适应滑模控制方法
CN107024863A (zh) 一种避免微分***的uuv轨迹跟踪控制方法
CN103955218A (zh) 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法
CN102497156A (zh) 永磁同步电机速度环的神经网络自校正控制方法
CN110412870A (zh) 基于扰动观测器与趋近自适应滑模的立式物料传送装置控制方法
CN102385342A (zh) 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法
CN105045103A (zh) 一种基于LuGre摩擦模型伺服机械手摩擦补偿控制***及方法
CN109648564A (zh) 一种基于递阶结构mpc的多自由度柔性关节机械臂***的控制方法
Yeon et al. Robust control using recursive design method for flexible joint robot manipulators
CN110262246A (zh) 基于滑模自适应鲁棒控制的立式物料传送装置控制方法
CN107145640A (zh) 中性浮力实验中漂浮基座与机械臂的动态标度规划方法
CN102269971A (zh) 基于模型跟踪的自适应伺服控制器
CN109062039A (zh) 一种三自由度Delta并联机器人的自适应鲁棒控制方法
Faradja et al. Sliding mode control of a Rotary Inverted Pendulum using higher order differential observer
CN108227493A (zh) 一种机器人轨迹跟踪方法
Xiao Modeling and adaptive sliding mode control of the catastrophic course of a high-speed underwater vehicle

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