CN109048907B - 消除惯量变化的机器人控制方法 - Google Patents
消除惯量变化的机器人控制方法 Download PDFInfo
- Publication number
- CN109048907B CN109048907B CN201810967539.2A CN201810967539A CN109048907B CN 109048907 B CN109048907 B CN 109048907B CN 201810967539 A CN201810967539 A CN 201810967539A CN 109048907 B CN109048907 B CN 109048907B
- Authority
- CN
- China
- Prior art keywords
- inertia
- joint
- control
- moment
- 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开消除惯量变化的机器人控制方法,首先针对机器人每个关节的闭环控制系统,计算各机械臂的等效转动惯量并分成转动惯量不变量和转动惯量变化量;以当前关节等效转动惯量与转动惯量不变量比值为增益,将当前关节控制系统输出的控制量进行放大;然后根据转速和阻尼计算控制量放大导致的阻尼力变化量,并与控制量和角度一起输入给扩展观测器估计的其余扰动,补偿到放大后的控制量中,获得消除转动惯量影响的控制量;最终机器人的关节控制系统等效为惯量定常系统,最后对控制参数进行整定,获得最优控制性能。本发明将扰动量测和估计结合在一起,避免了高频扰动信号估计带来的噪声干扰,方便地实现机器人等空间机构的高速精密运动控制。
Description
技术领域
本发明涉及机器人控制技术领域,特别涉及消除惯量变化的机器人控制方法。
背景技术
现有的工业中,90%以上的控制系统都是采用PID控制算法,并且机器人也是大部分采用PID控制算法。由于空间机构在运动过程中,关节相互耦合将会导致关节的等效转动惯量随位置姿态发生变化,这样使得固定参数的PID控制性能变差,进而导致模糊、智能、鲁棒控制方法的算法变得更加复杂且难于进行高速精密的运动控制。
自抗扰控制算法(ADRC)是消除扰动的一种有效方法,通过将模型误差和外界扰动进行统一考虑,从而能够在一定程度上抑制扰动。然而由于受限于观测器带宽和控制系统带宽,使得应用比较困难。
发明内容
本发明的主要目的是提出一种消除惯量变化的机器人控制方法,旨在方便地实现机器人等空间机构的高速精密运动控制。
为实现上述目的,本发明提出的消除惯量变化的机器人控制方法,具体包括以下步骤:
S1:按照机器人的运动规划为目标,关节位移和速度为反馈,搭建好机器人每个关节的闭环控制系统;
S2:计算各机械臂的等效转动惯量,并将等效转动惯量分解为转动惯量不变量和转动惯量变化量;
S3:以当前关节的等效转动惯量与转动惯量不变量的比值为增益,将当前关节控制系统输出的控制量进行放大;
S4:将反馈的关节角速度乘于转动阻尼的影响,获得量测扰动;
S5:将S4获得的量测扰动,与控制量和转角信号一起输入扩张状态观测器,估计扰动z2;
S6:将所述S4获得的量测扰动和所述S5获得的估计扰动进行求和,并乘于控制量到转动力矩传递函数的倒数,补偿到所述S3获得的控制量中,获得消除转动惯量影响的控制量;
S7:通过所述S3~S6,机器人的关节控制系统等效为惯量定常系统,最后对控制参数进行整定,获得最优控制性能。
优选地,所述S2中的等效转动惯量分为不变量部分Ji0和变化量部分ΔJi。
优选地,关节的所述转动惯量不变量Ji0包括关节本身的转动惯量Ji+miri 2与关联关节绕各自质心的转动惯量之和,即其中Ji为第个关节绕自身质心的转动惯量,n为关节总数,ri为关节质心到旋转中心的距离。
优选地,通过所述扩展状态观测器,将控制量、转角和转动阻尼的影响,估计其余扰动。
优选地,所述控制方法将非线性时变的转动惯量通过惯量分离,通过增益考虑惯量变化引起的驱动力变化,再通过角速度反馈将阻尼力去除以获取惯量时不变的关节控制效果。
优选地,当所测量的速度信号有噪声时或者无速度测量时,所述的扩展状态观测器采用二阶ESO,估计速度和扰动力;当所测量的速度信号没有噪声信号时,采用降阶ESO,利用速度信息,只估计扰动力。
本发明技术方案相对现有技术具有以下优点:
本发明技术方案基于现有控制方法,通过只增加一个可变参数增益和速度反馈增益,因此而不需要额外控制参数,即可实现关节惯量变化消除,方便地实现机器人等空间机构的高速精密运动控制。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图示出的结构获得其他的附图。
图1为本发明实施例消除惯量变化的机器人控制方法的工作原理图;
图2为本发明实施例的机械臂结构示意图;
图3为本发明实施例未使用自抗扰控制算法的最大跟随误差曲线变化图;
图4为本发明实施例使用自抗扰控制算法的最大跟随误差曲线变化图;
图5为本发明实施例中扩散状态观测器准确估计模型参数偏差导致的扰动结果图;
图6为本发明实施例中量测扰动加上估计扰动得到的总扰动结果图;
图7为本发明实施例中ESO估计扰动结果图。
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明,若本发明实施例中有涉及方向性指示(诸如上、下、左、右、前、后……),则该方向性指示仅用于解释在某一特定姿态(如附图所示)下各部件之间的相对位置关系、运动情况等,如果该特定姿态发生改变时,则该方向性指示也相应地随之改变。
另外,若本发明实施例中有涉及“第一”、“第二”等的描述,则该“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外,各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在,也不在本发明要求的保护范围之内。
请参见图1,为解决现有技术中,机器人关节惯量耦合导致关节控制性能变差的问题,本发明提出一种消除惯量变化的机器人控制方法,从而实现近似时不变系统的控制。
本发明首先按照机器人的运动规划搭好机器人控制系统,然后计算每个关节的等效转动惯量和转动阻尼,其中等效转动惯量分为不变量和变动量,然后通过将控制系统输出的控制量乘以增益,再减去转动阻尼同时与转动惯量变化量以及控制量到力矩的传递函数倒数的乘积再除以转动惯量不变量的结果。通过上述处理后,使机器人的关节控制规律等效为一个惯量时不变系统。
实施例
请参见图2至图4,在本发明实施例的消除惯量变化的机器人控制方法,具体包括以下步骤:
S1:按照机器人的运动规划为目标,关节位移和速度为反馈,搭建好机器人每个关节的闭环控制系统;
S2:计算各机械臂的等效转动惯量,并将等效转动惯量分解为转动惯量不变量和转动惯量变化量;
S3:以当前关节的等效转动惯量与转动惯量不变量的比值为增益,将当前关节控制系统输出的控制量进行放大;
S4:将反馈的关节角速度乘于转动阻尼的影响,获得量测扰动;
S5:将S4获得的量测扰动,与控制量和转角信号一起输入扩张状态观测器,估计扰动z2。
S6:将S4获得的量测扰动和S5获得的估计扰动进行求和,并乘于控制量到转动力矩传递函数的倒数,补偿到S3获得的控制量中,获得消除转动惯量影响的控制量;
S7:通过S3~S6,机器人的关节控制系统等效为惯量定常系统,最后对控制参数进行整定,获得最优控制性能。
其中本实施例的上述步骤S2中的等效转动惯量分为不变量部分Ji0和变化量部分ΔJi,上述步骤S3中的增益为转动惯量不变量Ji0与转动惯量变化量ΔJi之和Ji0+ΔJi,除以转动惯量不变量Ji0得到的数值,即其中关节的转动惯量不变量Ji0包括关节本身的转动惯量Ji+miri 2与关联关节绕各自质心的转动惯量之和,即其中Ji为第个关节绕自身质心的转动惯量,ri为关节质心到旋转中心的距离,而关节的转动惯量变化量部分包括关联关节的质量mi乘以该质心到关节转动中心线的距离的平方ri 2得到的数值之和,即
本实施例中,通过所述扩展状态观测器,将控制量、转角和转动阻尼的影响,估计其余扰动。
本实施例的上述控制方法将非线性时变的转动惯量通过惯量分离,通过增益考虑惯量变化引起的驱动力变化,再通过转动速度反馈将控制量放大对转动阻尼的影响去除以获取惯量时不变的关节控制效果。
本实施例中,当所测量的速度信号有噪声时或者无速度测量时,所述的扩展状态观测器采用二阶ESO,估计速度和扰动力;当所测量的速度信号没有噪声信号时,采用降阶ESO,利用速度信息,只估计扰动力。
本实施例通过上述方法,将非线性时变的转动惯量通过惯量分离,再通过增益将惯量变化一起的驱动力变化考虑进来,再通过转动速度反馈将多算的阻尼力扣除以获取惯量时不变的关节控制效果。本发明实施例还可避免通过转动速度微分获得加速度,乘以转动惯量增量直接反馈带来的高阶微分误差。
请参见图2至图4,具体地,本发明实施例以两自由度机械臂为例,假设控制电压到扭矩的传递函数Ti(s)为其中Li,Ri,Ki分别为关节电机的电感,电阻和力常数,设定第一机械臂和第二机械臂的质量分别为m1和m2;第一机械臂和第二机械臂的长度为L1和L2;第一机械臂和第二机械臂绕各自质心的转动惯量为I1和I2;第一机械臂和第二机械臂的转动阻尼为B1和B2;第一机械臂和第二机械臂的驱动力为T1和T2,则可得到以下动力学平衡方程:
由于编码盘的速度信息质量好,采用降阶ESO,一阶ESO(只估计扰动z2);
最后的控制量为经增益放大的原控制器输出,加上量测扰动和估计扰动。
本实施例通过与现有技术进行对比,得到如以下的两个表:
表1
表2
如图3和图4所示,本实施例采用惯量变化补偿后,双臂机器人的最大跟随误差从19.17um下降为5.26um。
当参数有偏差时,例如实际的参数只有设计值得0.9倍,此时扩张状态观测器准确估计出由于模型参数偏差导致的扰动图5所示。本实施例中,量测扰动(计算值)加上估计扰动(-0.1倍偏差导致),等于总扰动(0.9倍实际值)如图6所示。当参数无变化时,ESO估计的扰动接近于0,如图7所示,然而随着wo增大,噪声增大,因此本发明实施例采用量测先补偿掉主要的扰动,避免了观测器对高频扰动观测带来的噪声。
需要说明的是,本发明技术方案的框图与本发明实施例的公式表达相对应,如果测量信号的方向变化,扩展观测器中的公式表达,是否将观测器的估计进行标准化(除于最高阶次表达式的系数an,用乘于因子b=1/an表示),会引起框图中的符号变化,和比例因子关系(b或1/b),取决于公示表达,但是可以通过公式表达完全等价。
以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是在本发明的构思下,利用本发明说明书及附图内容所作的等效结构变换,或直接/间接运用在其他相关的技术领域均包括在本发明的专利保护范围内。
Claims (8)
1.消除惯量变化的机器人控制方法,其特征在于,具体包括以下步骤:
S1:按照机器人的运动规划为目标,关节位移和速度为反馈,搭建好机器人每个关节的闭环控制系统;
S2:计算各机械臂的等效转动惯量,并将等效转动惯量分解为转动惯量不变量Ji0和转动惯量变化量ΔJi;
S3:以当前关节的等效转动惯量与转动惯量不变量的比值为增益,将当前关节控制系统输出的控制量进行放大;
S4:将反馈的关节角速度乘于转动阻尼的影响,获得量测扰动;
S5:将S4获得的量测扰动,与控制量和转角信号一起输入扩张状态观测器,估计扰动z2;
S6:将所述S4获得的量测扰动和所述S5获得的估计扰动进行求和,并乘于控制量到转动力矩传递函数的倒数,补偿到所述S3获得的控制量中,获得消除转动惯量影响的控制量;
S7:通过所述S3~S6,机器人的关节控制系统等效为惯量定常系统,最后对控制参数进行整定,获得最优控制性能。
5.如权利要求4所述的控制方法,其特征在于,通过所述扩张状态观测器,将控制量、转角和转动阻尼的影响,估计其余扰动。
7.如权利要求1所述的控制方法,其特征在于,所述控制方法将非线性时变的转动惯量通过惯量分离,通过增益考虑惯量变化引起的驱动力变化,再通过角速度反馈将阻尼力去除以获取惯量时不变的关节控制效果。
8.如权利要求1所述的控制方法,其特征在于,当所测量的速度信号有噪声时或者无速度测量时,所述的扩张状态观测器采用二阶ESO,估计速度和扰动力;当所测量的速度信号没有噪声信号时,采用降阶ESO,利用速度信息,只估计扰动力。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810967539.2A CN109048907B (zh) | 2018-08-23 | 2018-08-23 | 消除惯量变化的机器人控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810967539.2A CN109048907B (zh) | 2018-08-23 | 2018-08-23 | 消除惯量变化的机器人控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109048907A CN109048907A (zh) | 2018-12-21 |
CN109048907B true CN109048907B (zh) | 2020-10-16 |
Family
ID=64756667
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810967539.2A Active CN109048907B (zh) | 2018-08-23 | 2018-08-23 | 消除惯量变化的机器人控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109048907B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111546329B (zh) * | 2020-04-10 | 2022-03-04 | 驰驱电气(嘉兴)有限公司 | 一种多关节机器人伺服增益一致性控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001086779A (ja) * | 1999-09-16 | 2001-03-30 | Toyo Electric Mfg Co Ltd | 2慣性ねじれ軸系の構造可変2自由度トルク制御方法 |
CN103530272A (zh) * | 2013-09-26 | 2014-01-22 | 广东工业大学 | 一种用于界定机构运动高速区域的判别方法 |
CN104317299A (zh) * | 2014-11-11 | 2015-01-28 | 东南大学 | 一种基于轮式移动机器人轨迹跟踪的混合控制方法 |
CN105224770A (zh) * | 2015-11-02 | 2016-01-06 | 广东工业大学 | 高速轻载机构非线性动态系统结构拓扑优化方法 |
CN105772917A (zh) * | 2014-12-16 | 2016-07-20 | 苏州继企机电科技有限公司 | 一种三关节点焊机器人轨迹跟踪控制方法 |
-
2018
- 2018-08-23 CN CN201810967539.2A patent/CN109048907B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001086779A (ja) * | 1999-09-16 | 2001-03-30 | Toyo Electric Mfg Co Ltd | 2慣性ねじれ軸系の構造可変2自由度トルク制御方法 |
CN103530272A (zh) * | 2013-09-26 | 2014-01-22 | 广东工业大学 | 一种用于界定机构运动高速区域的判别方法 |
CN104317299A (zh) * | 2014-11-11 | 2015-01-28 | 东南大学 | 一种基于轮式移动机器人轨迹跟踪的混合控制方法 |
CN105772917A (zh) * | 2014-12-16 | 2016-07-20 | 苏州继企机电科技有限公司 | 一种三关节点焊机器人轨迹跟踪控制方法 |
CN105224770A (zh) * | 2015-11-02 | 2016-01-06 | 广东工业大学 | 高速轻载机构非线性动态系统结构拓扑优化方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109048907A (zh) | 2018-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109927032B (zh) | 一种基于高阶滑模观测器的机械臂轨迹跟踪控制方法 | |
CN106994686B (zh) | 关节外力力矩的计算方法及装置、机器人 | |
Kolhe et al. | Robust control of robot manipulators based on uncertainty and disturbance estimation | |
Zhou et al. | Dual-rate-loop control based on disturbance observer of angular acceleration for a three-axis aerial inertially stabilized platform | |
Kang et al. | A solution to the accuracy/robustness dilemma in impedance control | |
JPH0740204B2 (ja) | 多自由度非線形機械システムの制御装置 | |
JPH0683403A (ja) | 適応pi制御方式 | |
CN113325805B (zh) | 一种自抗扰控制器及其设计方法 | |
WO2014091840A1 (ja) | サーボ制御装置 | |
JP2010049599A (ja) | 工作機械 | |
CN109048907B (zh) | 消除惯量变化的机器人控制方法 | |
Zhou et al. | Trajectory tracking control for electro-optical tracking system using ESO based fractional-order sliding mode control | |
JPH10128688A (ja) | ロボットの非干渉化制御方法 | |
Dutta et al. | Adaptive model predictive control design using multiple model second level adaptation for parameter estimation of two‐degree freedom of helicopter model | |
Yuan et al. | Nonlinear robust adaptive precision motion control of motor servo systems with unknown actuator backlash compensation | |
CN114179089A (zh) | 一种机械臂的鲁棒区域跟踪控制方法 | |
JP2004234205A (ja) | 数値制御装置 | |
US11403542B2 (en) | Control method for converting time-varying system into time-invariant system | |
Qu et al. | Modified ADRC for inertial stabilized platform with corrected disturbance compensation and improved speed observer | |
CN104991445B (zh) | 一种全局稳定的电机伺服系统自适应输出反馈鲁棒控制方法 | |
KR101417486B1 (ko) | 착용로봇의 의도토크 추출방법 및 추출시스템 | |
CN114167725A (zh) | 协作机器人轨迹跟踪控制方法及系统 | |
JPH07121239A (ja) | ロボット装置の制御方法 | |
JP2015043122A (ja) | 低周波外乱を同定する位置制御装置 | |
JPH04112690A (ja) | サーボモータの制御方式 |
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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20210913 Address after: 528000 room 103a, building 1, No.28, East 1st block, Jiansha Road, Danzao Town, Nanhai District, Foshan City, Guangdong Province (residence declaration) Patentee after: Foshan Huadao Chaojing Technology Co.,Ltd. Address before: No. 100, Waihuan West Road, University Town, Guangzhou, Guangdong 510062 Patentee before: GUANGDONG University OF TECHNOLOGY |