CN114115252A - 一种基于不等式约束的关节模组鲁棒控制方法 - Google Patents
一种基于不等式约束的关节模组鲁棒控制方法 Download PDFInfo
- Publication number
- CN114115252A CN114115252A CN202111346334.0A CN202111346334A CN114115252A CN 114115252 A CN114115252 A CN 114115252A CN 202111346334 A CN202111346334 A CN 202111346334A CN 114115252 A CN114115252 A CN 114115252A
- Authority
- CN
- China
- Prior art keywords
- joint module
- robust
- angular displacement
- angular
- controller
- 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 17
- 230000009466 transformation Effects 0.000 claims abstract description 10
- 238000006073 displacement reaction Methods 0.000 claims description 51
- 230000001133 acceleration Effects 0.000 claims description 21
- 239000000126 substance Substances 0.000 claims description 10
- 230000005540 biological transmission Effects 0.000 claims description 6
- 239000003638 chemical reducing agent Substances 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 2
- 238000004088 simulation Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Feedback Control In General (AREA)
Abstract
Description
技术领域
本发明涉及协作机器人关节模组控制技术领域,尤其是一种基于不等式约束的关节模组鲁棒控制方法。
背景技术
协作机器人作为机器人领域最热门的技术之一,近年来越来越受到人们的关注。协作机器人主要由关节模组和连杆串联组成。关节模组***作为协作机器人各关节的动力源,是典型的电机齿轮***,关节模组的动态性能对协作机器人的整体动态性能有着非常重要的影响。在传统的控制方法中,高性能的控制要求精确的***参数,但是,由于温度变化引起的惯性矩、粘滞摩擦系数等***参数的变化等结构不确定性,***建模不充分,以及负载转矩扰动、电磁干扰、控制目标变化等非结构不确定性,会对联合模块***的动态性能产生负面影响。
因此,关节模组***实际上是复杂的、易受不确定性影响的,对于关节模组这样的多变量、高度耦合、时变非线性***,实现高性能轨迹跟踪是一项具有挑战性的任务。并且,针对现有关节模组驱动控制平台的功能单一、体积庞大、数据无法可视化、控制代码编写难等问题,设计一种基于不等式约束的鲁棒控制方法是有广泛的实际意义的。
发明内容
本发明的目的在于提供一种能够实现高性能的轨迹跟踪控制的基于不等式约束的关节模组鲁棒控制方法。
为实现上述目的,本发明采用了以下技术方案:一种基于不等式约束的关节模组鲁棒控制方法,该方法包括下列顺序的步骤:
(1)建立协作机器人一体化关节模组的动力学方程;
(3)设计一种鲁棒控制器;
(4)对所述鲁棒控制器进行仿真,对鲁棒控制器中的参数进行调节,并得到结论。
在步骤(1)中,所述协作机器人一体化关节模组的动力学方程为:
其中,τ表示电机的电磁转矩,η为谐波齿轮减速器的传递效率,λ为传动比,Tl表示关节模组输出轴上的负载转矩,Tf表示谐波减速器的中的摩擦力,B表示粘滞摩擦系数,J表示转动惯量,使用x、和分别表示电机转子角位移、角速度和角加速度。
所述步骤(2)具体是指:利用正切函数对电机转子角位移x进行状态变换,状态变换公式如下:
其中,xd是转子的期望角位移,xm和xM是电机转子角位移的上、下界;x为电机转子角位移,x∈[xm xM];y为转换后的关节模组中的实际角位移,yd为转换后的关节模组中的期望角位移;
通过公式(2)式进行反解,得到电机转子角位移x:
将式(7)写成机械***动力学的拉格朗日方程形式,得到如下表达式:
式中,t代表角位移时间;
e(t)=y(t)-yd(t) (9)
e(t)是期望角位移与实际角位移的误差,是期望角速度和实际角速度的误差,为转换后的关节模组中的实际角速度,为转换后的关节模组中的期望角速度,是期望角加速度与实际角加速度的误差,为转换后的关节模组中的实际角加速度,为转换后的关节模组中的期望角加速度;
公式(8)重写为下面的形式:
其中,函数M(*),C(*)和G(*)分解为如下形式:
使用函数ρ来估计函数φ的不确定性的上界,对于给定的S>0,S是鲁棒项控制参数,选择如下形式的标量函数ρ:
其中,
ΔM、ΔC、ΔG是不确定项,σ是不确定系数,φ是包含关节模组不确定性的函数;
设计一个鲁棒控制器τ(t),对于给定的ε>0和P、D>0,则设计的鲁棒控制器形式如下:
在公式(16)中,
其中,γ、δ是正定的设计参数,γ>0,δ>0。
附图说明
图1为本发明的方法流程图;
图2为本发明的控制方法框图;
图3为本发明实例提供的关节模组仿真示意图。
具体实施方式
如图1、2所示,一种基于不等式约束的关节模组鲁棒控制方法,该方法包括下列顺序的步骤:
(1)建立协作机器人一体化关节模组的动力学方程;
(3)设计一种鲁棒控制器;
(4)对所述鲁棒控制器进行仿真,对鲁棒控制器中的参数进行调节,并得到结论。
在步骤(1)中,所述协作机器人一体化关节模组的动力学方程为:
其中,τ表示电机的电磁转矩,η为谐波齿轮减速器的传递效率,λ为传动比,Tl表示关节模组输出轴上的负载转矩,Tf表示谐波减速器的中的摩擦力,B表示粘滞摩擦系数,J表示转动惯量,使用x、和分别表示电机转子角位移、角速度和角加速度。
所述步骤(2)具体是指:利用正切函数对电机转子角位移x进行状态变换,状态变换公式如下:
其中,xd是转子的期望角位移,xm和xM是电机转子角位移的上、下界;x为电机转子角位移,x∈[xm xM];y为转换后的关节模组中的实际角位移,yd为转换后的关节模组中的期望角位移;
通过公式(2)式进行反解,得到电机转子角位移x:
将式(7)写成机械***动力学的拉格朗日方程形式,得到如下表达式:
式中,t代表角位移时间;
e(t)=y(t)-yd(t) (9)
e(t)是期望角位移与实际角位移的误差,是期望角速度和实际角速度的误差,为转换后的关节模组中的实际角速度,为转换后的关节模组中的期望角速度,是期望角加速度与实际角加速度的误差,为转换后的关节模组中的实际角加速度,为转换后的关节模组中的期望角加速度;
公式(8)重写为下面的形式:
其中,函数M(*),C(*)和G(*)分解为如下形式:
使用函数ρ来估计函数φ的不确定性的上界,对于给定的S>0,S是鲁棒项控制参数,选择如下形式的标量函数ρ:
其中,
ΔM、ΔC、ΔG是不确定项,σ是不确定系数,φ是包含关节模组不确定性的函数;
设计一个鲁棒控制器τ(t),对于给定的ε>0和P、D>0,则设计的鲁棒控制器形式如下:
在公式(16)中,
其中,γ、δ是正定的设计参数,γ>0,δ>0。
为证明控制器的稳定性,选择如下形式的李雅普诺夫函数:
V是李雅普诺夫函数。
将V对时间t求导可以得到,
将公式(16)带入公式(22),可以得到:
因为
并且
现在将(24)和(25)代入到(22),结合(21)可得:
可以保证有:
并且,
如图3所示,在仿真中采用正弦信号,图中具有不等式约束的角位移曲线,是运用专利所提出的鲁棒控制器进行控制得到的角位移曲线,没有不等式约束的角位移曲线是运用传统的鲁棒控制器进行控制得到的角位移曲线。取角位移上界xM=101mm,角位移下界xm=-101mm,期望角位移曲线xd=100sint mm。通过仿真结果可以看出具有不等式约束的角位移曲线不会出现超调并且误差更小,表现出良好的动态位置跟踪性能。
Claims (4)
4.根据权利要求1所述的基于不等式约束的关节模组鲁棒控制方法,其特征在于:所述步骤(3)具体是指:将步骤(2)得到的角速度和角加速度代入到协作机器人一体化关节模组的动力学方程中,得到以y为控制变量的动力学方程:
将式(7)写成机械***动力学的拉格朗日方程形式,得到如下表达式:
式中,t代表角位移时间;
e(t)=y(t)-yd(t) (9)
e(t)是期望角位移与实际角位移的误差,是期望角速度和实际角速度的误差,为转换后的关节模组中的实际角速度,为转换后的关节模组中的期望角速度,是期望角加速度与实际角加速度的误差,为转换后的关节模组中的实际角加速度,为转换后的关节模组中的期望角加速度;
公式(8)重写为下面的形式:
其中,函数M(*),C(*)和G(*)分解为如下形式:
使用函数ρ来估计函数φ的不确定性的上界,对于给定的S>0,S是鲁棒项控制参数,选择如下形式的标量函数ρ:
其中,
ΔM、ΔC、ΔG是不确定项,σ是不确定系数,φ是包含关节模组不确定性的函数;
设计一个鲁棒控制器τ(t),对于给定的ε>0和P、D>0,则设计的鲁棒控制器形式如下:
在公式(16)中,
其中,γ、δ是正定的设计参数,γ>0,δ>0。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111346334.0A CN114115252B (zh) | 2021-11-15 | 2021-11-15 | 一种基于不等式约束的关节模组鲁棒控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111346334.0A CN114115252B (zh) | 2021-11-15 | 2021-11-15 | 一种基于不等式约束的关节模组鲁棒控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114115252A true CN114115252A (zh) | 2022-03-01 |
CN114115252B CN114115252B (zh) | 2024-03-15 |
Family
ID=80395225
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111346334.0A Active CN114115252B (zh) | 2021-11-15 | 2021-11-15 | 一种基于不等式约束的关节模组鲁棒控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114115252B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115236982A (zh) * | 2022-07-15 | 2022-10-25 | 合肥中科深谷科技发展有限公司 | 面向非同长二级倒立摆自起摆及其平衡控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113050653A (zh) * | 2021-03-26 | 2021-06-29 | 合肥工业大学 | 一种处理状态不等式约束的线控转向***建模控制方法 |
CN113419433A (zh) * | 2021-07-23 | 2021-09-21 | 合肥中科深谷科技发展有限公司 | 一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 |
CN113489404A (zh) * | 2021-07-09 | 2021-10-08 | 合肥工业大学 | 一种具有不等式约束的永磁直线电机鲁棒有界控制方法 |
-
2021
- 2021-11-15 CN CN202111346334.0A patent/CN114115252B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113050653A (zh) * | 2021-03-26 | 2021-06-29 | 合肥工业大学 | 一种处理状态不等式约束的线控转向***建模控制方法 |
CN113489404A (zh) * | 2021-07-09 | 2021-10-08 | 合肥工业大学 | 一种具有不等式约束的永磁直线电机鲁棒有界控制方法 |
CN113419433A (zh) * | 2021-07-23 | 2021-09-21 | 合肥中科深谷科技发展有限公司 | 一种自平衡电动轮椅欠驱动***跟踪控制器的设计方法 |
Non-Patent Citations (1)
Title |
---|
SHENG CHAOZHEN等: "A new PD based robust control method for the robot joint module", 《MECHANICAL SYSTEMS AND SIGNAL PROCESSING》, vol. 161, pages 1 - 14 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115236982A (zh) * | 2022-07-15 | 2022-10-25 | 合肥中科深谷科技发展有限公司 | 面向非同长二级倒立摆自起摆及其平衡控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114115252B (zh) | 2024-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109240086B (zh) | 一种非线性双边遥操作***的自适应鲁棒控制方法 | |
CN104238361B (zh) | 电机伺服***自适应鲁棒位置控制方法与*** | |
CN104142627B (zh) | 一种采用自抗扰控制技术的网络化无刷直流电机时延补偿和控制方法 | |
CN101846975B (zh) | 带有动态摩擦补偿的伺服***自适应鲁棒控制器 | |
CN107121932B (zh) | 电机伺服***误差符号积分鲁棒自适应控制方法 | |
CN112904728A (zh) | 一种基于改进型趋近律的机械臂滑模控制轨迹跟踪方法 | |
Duchaine et al. | Computationally efficient predictive robot control | |
CN104201967B (zh) | 一种采用自抗扰控制技术的网络化永磁同步电机时延补偿和控制方法 | |
Deng et al. | Adaptive inverse control for gripper rotating system in heavy-duty manipulators with unknown dead zones | |
CN1925310B (zh) | 利用逆算模型的马达速度控制***和负载惯量估测方法 | |
CN109656139B (zh) | 机器人驱控一体***的自适应建模方法 | |
CN112696319A (zh) | 利用准确在线模型的基于风力涡轮模型的控制和估计 | |
CN114115252A (zh) | 一种基于不等式约束的关节模组鲁棒控制方法 | |
CN108762066B (zh) | 一种直升机电动尾部减速器***的控制方法 | |
CN105093935A (zh) | 直驱电机***的模型不确定性补偿的滑模控制方法 | |
CN116638544A (zh) | 一种基于超局部模型的关节模组协同控制方法 | |
Zhu et al. | Speed control of permanent magnet synchronous motor drives based on model predictive control | |
Guzey et al. | Optimal synchronizing speed control of multiple DC motors | |
CN110488608B (zh) | 用于驱控一体化控制***的智能化动力学参数辩识方法及模块 | |
CN101776865A (zh) | 一种采用微分包含对机械***进行统一控制的方法 | |
Liu et al. | Research on pressure control of an electro-hydraulic servo system based on sliding-mode variable-structure direct torque control | |
Li et al. | Nonsingular fast terminal sliding mode control with extended state observer and disturbance compensation for position tracking of electric cylinder | |
Mei et al. | Nonlinear friction compensation in mechatronic servo systems | |
Zouari et al. | Comparative study between PI and sliding mode controllers for flexible joint manipulator driving by brushless DC motor | |
CN102647130A (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 |