CN112681443A - 一种挖掘机器人关节轨迹控制方法及控制*** - Google Patents
一种挖掘机器人关节轨迹控制方法及控制*** Download PDFInfo
- Publication number
- CN112681443A CN112681443A CN202110067252.6A CN202110067252A CN112681443A CN 112681443 A CN112681443 A CN 112681443A CN 202110067252 A CN202110067252 A CN 202110067252A CN 112681443 A CN112681443 A CN 112681443A
- Authority
- CN
- China
- Prior art keywords
- joint
- robot
- neural network
- module
- harmony
- 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 22
- 238000006073 displacement reaction Methods 0.000 claims abstract description 37
- 230000005540 biological transmission Effects 0.000 claims abstract description 18
- 238000006243 chemical reaction Methods 0.000 claims abstract description 18
- 238000013528 artificial neural network Methods 0.000 claims description 82
- 230000006870 function Effects 0.000 claims description 41
- 239000013598 vector Substances 0.000 claims description 34
- 238000005065 mining Methods 0.000 claims description 21
- 238000005457 optimization Methods 0.000 claims description 21
- 238000009412 basement excavation Methods 0.000 claims description 20
- 239000011159 matrix material Substances 0.000 claims description 19
- 238000011156 evaluation Methods 0.000 claims description 13
- 238000012545 processing Methods 0.000 claims description 9
- 238000012549 training Methods 0.000 claims description 8
- 238000009966 trimming Methods 0.000 claims description 7
- 101100177269 Arabidopsis thaliana HCAR gene Proteins 0.000 claims description 6
- 238000013459 approach Methods 0.000 claims description 5
- 238000011160 research Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 3
- 230000004044 response Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 241000252229 Carassius auratus Species 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000004913 activation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000001537 neural effect Effects 0.000 description 1
- 238000012805 post-processing Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明涉及工程机械技术领域,更具体而言,涉及一种挖掘机器人关节轨迹控制方法及控制***。包括用于规划出挖掘机器人期望的关节轨迹的轨迹规划模块,用于将规划出的挖掘机器人期望关节轨迹求解为挖掘机器人期望的关节角位移的逆方程解析模块,用于根据挖掘机器人实际关节转动数据和期望关节角位移运用挖掘机器人关节轨迹控制方法不断修正关节角位移的偏差量至最小值,并将修正后的关节角位移信号传输给控制指令转换传输模块的关节控制算法模块,用于将修正后的关节角位移转换为挖掘机器人可以识别的控制信号的控制指令转换传输模块;本发明实现了挖掘机器人精确跟踪轨迹规划模块所规划期望轨迹的能力,响应快、鲁棒性强、智能化程度高。
Description
技术领域
本发明涉及工程机械技术领域,更具体而言,涉及一种挖掘机器人关节轨迹控制方法及控制***。
背景技术
挖掘机器人是一种典型的多用途工程机械,在国家的基础建设、采矿、房地产开发、水利等方面发挥着重要的作用,因而在现代工业中应用广泛。由于挖掘机器人的***具有时变性、工作时的强动力学耦合和流量耦合、多输入和多输出的非线性、***参数可能在大范围内变化等特性,所以以实现挖掘机器人的高精度、强鲁棒性的关节轨迹控制研究已经成为挖掘机器人控制领域的热点。
挖掘机器人关节轨迹控制***其实质就是一种电液比例控制***,挖掘机器人的电液比例控制有着多种控制方式,非线性控制、滑模控制、自适应控制、反馈控制等。实际应用中根据工作情况的不同可以使用不同的控制方式。滑模变结构控制作为一种非线性控制方式,对于外部扰动和***参数变化具有很强的自适应性和鲁棒性,而且还对***所建立的模型表现出不敏感性。为了减弱挖掘机器人电液比例***的非线性、外部负载的不确定性、***数学模型建立的不精确性对***控制效果造成的影响,提出将滑模变结构控制应用于挖掘机器人电液比例控制***中,对挖掘机器人的关节轨迹进行控制。但是现有的滑模变结构控制其效果并不是很理想,主要是因为滑模变结构控制有容易产生抖振的问题。
因此,有必要对现有技术进行改进。
发明内容
为了克服现有技术中存在的不足,提供一种通过引入智能神经网络来抑制滑模变结构的抖振、通过智能神经网络算法与滑模变结构的结合来对挖掘机器人关节轨迹进行控制的挖掘机器人关节轨迹控制方法及控制***。
为了解决上述技术问题,本发明采用的技术方案为:
一种挖掘机器人关节轨迹控制方法,包括
S1、建立挖掘机器人工作装置的拉格朗日动力学方程,以挖掘机器人动臂和斗杆为研究对象,铲斗全程处于锁止状态,将挖掘机器人的工作装置简化为二自由度的机械臂,由数据采集装置采集动臂和斗杆的关节角度,则挖掘机器人工作装置的拉格朗日动力学方程为:
S2、定义挖掘机器人关节轨迹控制误差,根据挖掘机器人的期望关节角位移和信号采集装置采集到的实际关节角位移定义挖掘机器人关节轨迹控制误差为:
e(t)=θd(t)-θ(t);
S3、定义滑模变结构的滑模面为:
进一步得出:
S4、计算RBF神经网络实际输出与理想输出之间的差值:
取RBF神经网络的输入为:
则根据RBF神经网络的结构原理可以得到其理想状态下的输出为:
由于在实际情况下RBF神经网络在逼近不确定函数时会产生误差ε,则RBF神经网络的实际输出为:
则RBF神经网络实际输出与理想输出之间的差值表示为:
S5、设计RBF神经网络滑模变结构的控制律为:
将上式带入S3可得:
S6、定义鲁棒控制项q,取τd和ε的上界分别为τdb和εb,则:
q=-(τdb+εb)sgn(s);
S7、对挖掘机器人关节轨迹控制***进行稳定性分析:
定义Lyapunov函数为:
将上式进行求导并将S5的结果带入得:
进一步由S6和上式可得:
sT(ε+τd+q)=sT(ε+τd)+sTq=sT(ε+τd)-||s||εb+τdb)≤0,
进一步的,包括:
S8、在滑模变结构控制中为了尽量减小因鲁棒项引起的***抖振,将鲁棒项中的符号函数用饱和函数sat(·)代替,得到新的基于RBF神经网络滑模变结构的控制律为:
S9、利用改进的和声搜索优化算法对RBF神经网络的结构参数w、c和b进行优化,根据和声搜索优化算法输出的最优和声向量(c,b,w)即可得到RBF神经网络的最优结构参数c、b和w,将得到的最优参数应用于RBF神经网络,使RBF神经网络无限逼近于不确定项b。
进一步的,所述S9中包括:
S91、根据挖掘机器人的关节角位移输入范围估计RBF神经网络的置信域中心c和置信域宽度b的初始值,神经网络隐含层与输出层的连接权值w由计算机随机产生;
S92、定义和声搜索优化算法的评价函数为:
S93、利用足够数量的训练样本对RBF神经网络进行训练得到K个和声向量(c,b,w),并且由这K个和声向量组成和声记忆库;
S94、初始化和声搜索优化算法的参数的有关参数,最大以及最小和声记忆库取值概率HMCRmax、HMCRmin,最大以及最小音调微调概率PARmax、PARmin,最大以及最小音调微调宽度bwmax、bwmin;
S95、分别运用动态调整公式调整和声记忆库取值概率HMCR、音调微调概率PAR和音调微调宽度bw;
S96、根据新和声产生条件生成新的和声向量,比较和声记忆库中最差的和声向量和新和声向量的评价函数值,如果新和声向量的评价函数值优于和声记忆库中最差和声向量的评价函数值,则以新和声向量代替和声记忆库中最差的和声向量,否则保持原和声记忆库不变;
S97、进一步检查和声搜索优化算法是否达到最大迭代次数,若迭代次数大于最大迭代次数则停止搜索,否则返回S25继续进行循环运算,直到满足算法终止条件为止;
一种挖掘机器人关节轨迹控制***,包括数据采集模块、数据处理模块以及依次连接的轨迹规划模块、逆方程解析模块、关节轨迹控制算法模块和控制指令转换传输模块,所述数据采集模块与关节轨迹控制算法模块相连接,所述数据采集模块、轨迹规划模块、逆方程解析模块、关节轨迹控制算法模块和控制指令转换传输模块均与数据处理模块连接;
所述轨迹规划模块用于规划出挖掘机器人期望的关节轨迹;
所述逆方程解析模块用于将规划出的挖掘机器人期望关节轨迹求解为挖掘机器人期望的关节角位移;
所述关节控制算法模块用于根据挖掘机器人实际关节转动数据和期望关节角位移运用挖掘机器人关节轨迹控制方法不断修正关节角位移的偏差量至最小值,并将修正后的关节角位移信号传输给控制指令转换传输模块;
所述控制指令转换传输模块用于将修正后的关节角位移转换为挖掘机器人可以识别的控制信号;
所述数据处理模块用于保存挖掘机器人关节轨迹控制***的各种数据。
近一步的,还包括位姿显示模块,所述位姿显示模块分别与逆方程解析模块和关节轨迹控制算法模块连接,根据挖掘机器人期望的关节角位移信息和修正后的关节角位移信息不断更新挖掘机器人的显示位姿。
进一步的,还包括车身、动臂、动臂油缸、斗杆、斗杆油缸、铲斗、铲斗油缸和驱动装置,所述车身、动臂、斗杆、铲斗依次铰接,动臂油缸、斗杆油缸、铲斗油缸依次设置在车身与动臂之间、动臂与斗杆之间、斗杆与铲斗之间,所述驱动装置分别与动臂油缸、斗杆油缸,铲斗油缸相连接,所述动臂与车身的铰接点、动臂与斗杆的铰接点均设置有光电编码器,所述光电编码器与数据采集模块连接。
进一步的,所述驱动装置包括电液比例阀,电液比例阀与控制指令转换传输模块连接。
进一步的,还包括液压***,液压***分别与动臂油缸、斗杆油缸、铲斗油缸连接,所述液压***设置有油压传感器和液压流量传感器,油压传感器和液压流量传感器均与数据采集装置连接。
本发明与现有技术相比所具有的有益效果为:
1、本发明综合了滑模变结构控制和RBF神经网络的优点,使得本发明具有更好的挖掘机器人关节轨迹跟踪控制效果,本发明适用于所有的挖掘机器人机型,通用性强。
2、本发明具有精确跟踪轨迹规划模块所规划期望轨迹的能力,响应快、鲁棒性强、智能化程度较高,减轻了挖掘机器人操作人员因频繁手动调整挖掘机器人作业轨迹的工作强度。
3、本发明的关节控制方法是在RBF神经网络和滑模变结构相结合的基础上对挖掘机器人关节轨迹进行跟踪控制,滑模变结构控制的滑动模态不受***参数以及外部扰动的影响,具有很好的鲁棒性。
4、本发明通过RBF神经网络以任意精度逼近挖掘机器人动力学模型中的非线性不确定项,建立更加精确的动力学模型,进而抑制RBF神经网络滑模变结构控制律的抖振现象。
5、本发明利用和声搜索优化算法对RBF神经网络的结构参数进行优化,以提高RBF神经网络逼近挖掘机器人动力学模型不确定项的性能。
附图说明
下面将通过附图对本发明的具体实施方式做进一步的详细说明。
图1为挖掘机器人结构简图;
图2为挖掘机器人关节轨迹控制***示意图;
图3为挖掘机器人动臂和斗杆关节简化示意图;
图4为RBF神经网络逼近不确定函数结构示意图;
图5为声搜索优化算法流程图;
图6为挖掘机器人动臂关节轨迹跟踪实验结果;
图7为挖掘机器人斗杆关节轨迹跟踪实验结果;
图8为挖掘机器人动臂关节逼近不确定函数实验结果;
图9为挖掘机器人斗杆关节逼近不确定函数实验结果;
图10为挖掘机器人动臂关节轨迹跟踪误差结果;
图11为挖掘机器人斗杆关节轨迹跟踪误差结果。
图中:1为动臂油缸,2为动臂,3为斗杆油缸,4为斗杆,5为铲斗油缸,6为铲斗,7为简化动臂,8为简化斗杆,9为理想轨迹Ⅰ,10为理想轨迹Ⅱ。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例:
如图1至图11所示,一种挖掘机器人关节轨迹控制***,包括车身、动臂2、动臂油缸1、斗杆4、斗杆油缸3、铲斗6、铲斗油缸5、驱动装置、数据采集模块、位姿显示模块、数据处理模块以及依次连接的轨迹规划模块、逆方程解析模块、关节轨迹控制算法模块和控制指令转换传输模块,所述数据采集模块与关节轨迹控制算法模块相连接,所述数据采集模块、轨迹规划模块、逆方程解析模块、关节轨迹控制算法模块和控制指令转换传输模块均与数据处理模块连接;
所述车身、动臂2、斗杆4、铲斗6依次铰接,动臂油缸1、斗杆油缸3、铲斗油缸5依次设置在车身与动臂2之间、动臂2与斗杆4之间、斗杆4与铲斗6之间,所述驱动装置分别与动臂油缸1、斗杆油缸3,铲斗油缸5相连接,所述动臂2与车身的铰接点A、动臂2与斗杆4的铰接点F均设置有光电编码器,所述光电编码器与数据采集模块连接。
还包括液压***,液压***分别与动臂油缸1、斗杆油缸3、铲斗油缸5连接,所述液压***设置有油压传感器和液压流量传感器,油压传感器和液压流量传感器均与数据采集装置连接。
所述数据采集模块通过内部的数据采集卡来实现对光电编码器信号、油压信号以及油液流量信号的采集,然后将采集到的数据处理后传输到挖掘机器人关节轨迹控制***中。
所述轨迹规划模块规划出挖掘机器人期望的关节轨迹;
所述逆方程解析模块将规划出的挖掘机器人期望关节轨迹求解为挖掘机器人期望的关节角位移;
所述关节控制算法模块根据挖掘机器人实际关节转动数据和期望关节角位移运用挖掘机器人关节轨迹控制方法不断修正关节角位移的偏差量至最小值,并将修正后的关节角位移信号传输给控制指令转换传输模块;
所述控制指令转换传输模块用于将修正后的关节角位移信号转换为控制指令电压信号,然后再通过模块内部的电液比例控制器将控制指令电压信号转换为控制指令电流信号;
所述驱动装置包括电液比例阀,电液比例阀与控制指令转换传输模块连接,控制指令转换传输模块将控制指令电流信号传输给驱动装置的电液比例阀,通过控制电液比例阀的开口大小和方向变化来实现对挖掘机器人工作液压缸的控制。
所述数据处理模块用于保存挖掘机器人关节轨迹控制***的各种数据,为控制***数据的后处理提供依据。
所述位姿显示模块分别与逆方程解析模块和关节轨迹控制算法模块连接,根据挖掘机器人期望的关节角位移信息和修正后的关节角位移信息不断更新挖掘机器人的显示位姿,保证模块中显示的挖掘机器人实际位姿与期望位姿保持一致。
一种挖掘机器人关节轨迹控制方法,包括下列步骤:
S1、以挖掘机器人动臂和斗杆为研究对象,铲斗全程处于锁止状态,此时可以将挖掘机器人的工作装置简化为二自由度的机械臂,根据光电编码器采集到的关节角度建立挖掘机器人工作装置的拉格朗日动力学方程为:
其中,θ,分别为机械臂的角位移、角速度和角加速度矢量;D(θ)∈R2×2、G(θ)∈R2×1、τ(t)∈R2×1、τd(t)∈R2×1分别为惯性矩阵、哥氏力与离心力矩阵、重力矩阵、摩擦力矩阵、驱动力矩矩阵、外部扰动和未建模动态矩阵。
S2、进一步定义挖掘机器人关节轨迹控制误差为:
e(t)=θd(t)-θ(t) (2)
其中,e(t)为挖掘机器人关节轨迹误差;θd(t)为挖掘机器人关节期望角位移;θ(t)为挖掘机器人关节实际角位移。
S3、定义滑模变结构的滑模面为:
进一步,由式(1)、(2)、(3)可得:
S4、如图4所示,利用RBF神经网络能够以任意精度逼近不确定函数的原理对函数b进行逼近,通过观察函数b可以确定其输入变量为e和θd,则RBF神经网络的输入可以取为:
则根据RBF神经网络的结构原理可以得到其理想状态下的输出为:
其中,y为RBF神经网络的输出;WT为RBF神经网络隐含层与输出层之间的理想连接权值矩阵;hi(x)为RBF神经网络隐含层第i个节点的输出;h(x)为RBF神经网络隐含层节点的输出矩阵,且h(x)=[h1(x),h2(x),......,hn(x)];g(·)为RBF神经网络隐含层的激活函数,此处采用的是高斯基函数;ci为第i个隐含层节点的置信域中心;bi第i个隐含层节点的为置信域的宽度;i为RBF神经网络隐含层节点;n为RBF神经网络隐含层节点总数。
由于在实际情况下RBF神经网络在逼近不确定函数时会产生误差ε,则可以取RBF神经网络的实际输出为:
则RBF神经网络实际输出与理想输出之间的差值表示为:
S5、设计RBF神经网络滑模变结构的控制律为:
其中,τ为RBF神经网络滑模变结构的控制律;Hv为对角矩阵且元素都大于零;s为滑模面函数;q为鲁棒控制项。
将式(10)带入式(5)可得:
S6、确定式(10)中的鲁棒控制项,在实际应用中***外部扰动τd以及误差ε都具有一定的范围,本发明取τd和ε的上界分别为τdb和εb,则鲁棒控制项q可取为:
w=-(τdb+εb)sgn(s) (12)
其中,τdb为***外部扰动τd的上界;εb为RBF神经网络逼近不确定项误差ε的上界;sgn(·)为符号函数。
S7、对挖掘机器人关节轨迹控制***进行稳定性分析,
S7.1、定义Lyapunov函数为:
对式(13)求导可得:
进一步将式(11)带入(14)式可得:
S7.4、由式(12)和式(17)可知:
sT(ε+τd+q)=sT(ε+τd)+sTq=sT(ε+τd)-||s||(εb+τdb)≤0 (18)
根据Lyapunov稳定判定方法,得出挖掘机器人关节轨迹控制***在Lyapunov条件下是稳定的。
S8、在滑模变结构控制中为了尽量减小因鲁棒项引起的***抖振,将鲁棒项中的符号函数用饱和函数sat(·)代替,可得到新的基于RBF神经网络滑模变结构的控制律为:
其中,sat(·)为饱和函数;n为饱和函数边界层宽度。
S9、为了充分发挥RBF神经网络以任意精度逼近不确定函数的特性,利用改进的和声搜索优化算法对RBF神经网络的结构参数w、c和b进行优化。和声搜索优化算法具体流程如图5所示,具体步骤为:
S9.1、定义和声搜索优化算法的评价函数为:
其中,r(u)为和声搜索优化算法的评价函数;N为神经网络训练样本总数;j为神经网络训练样本;为以u为变量时神经网络的实际输出;fj(u)为以u为变量时神经网络的理想输出;变量u为(c,b,w)组成的解向量,其中w为神经网络隐含层与输出层的连接权值。
S9.2、初始化RBF神经网络的结构参数,根据挖掘机器人的关节角位移输入范围估计RBF神经网络的置信域中心c和置信域宽度b的初始值,神经网络隐含层与输出层的连接权值w则由计算机随机产生。
S9.3、为了保证RBF神经网络逼近不确定函数的性能要获取足够数量的训练样本,利用训练样本对RBF神经网络进行训练得到K个和声向量(c,b,w),并且由这K个和声向量组成和声记忆库,和声记忆库可表示为:
S9.4、进一步初始化和声搜索优化算法的参数的有关参数,最大以及最小和声记忆库取值概率HMCRmax、HMCRmin,最大以及最小音调微调概率PARmax、PARmin,最大以及最小音调微调宽度bwmax、bwmin,以上参数的初始值均根据以往经验选取。
S9.5、进一步分别运用动态调整公式调整和声记忆库取值概率HMCR、音调微调概率PAR和音调微调宽度bw,其动态调整公式为:
其中,p为算法当前迭代次数;P为算法最大迭代次数;HMCR(p)为调整后的和声记忆库取值概率;PAR(p)为调整后的音调微调概率;bw(p)为调整后的音调微调宽度。
S9.6、根据新和声产生条件生成新的和声向量,首先计算机产生一个随机数,然后用这个随机数与HMCR进行比较,具体伪代码为:
其中,unew为产生的新和声向量;u*为HM中的任意和声向量;uS为三个最小决策变量中的最小值,uS=min(cmin,bmin,wmin);uB为三个最大决策变量中的最大值,uB=max(cmax,bmax,wmax);rand为随机数且rand∈(0,1)。
S9.7、进一步比较和声记忆库中最差的和声向量和新和声向量的评价函数值,如果新和声向量的评价函数值优于和声记忆库中最差和声向量的评价函数值,则以新和声向量代替和声记忆库中最差的和声向量,否则保持原和声记忆库不变。
S9.8、进一步检查和声搜索优化算法是否达到最大迭代次数,若迭代次数大于最大迭代次数则停止搜索,否则返回S54.5继续进行循环运算,直到满足算法终止条件为止。
S9.9、根据和声搜索优化算法输出的最优和声向量(c,b,w)即可得到RBF神经网络的最优结构参数c、b和w。将得到的最优参数应用于RBF神经网络,可以使RBF神经网络无限逼近于不确定项b,可以使建立的挖掘机器人动力学模型更加精确,RBF神经网络滑模变结构的控制律的鲁棒性更好,挖掘机器人各关节的角位移轨迹控制误差会逐渐趋于零。
图6是经过和声搜索优化算法优化参数后的RBF神经网络滑模变结构控制用于挖掘机器人动臂关节轨迹跟踪控制的结果,其中,理想轨迹9定义为:1+0.2sin(0.5πt),经过RBF神经网络滑模变结构的控制,挖掘机器人实现了动臂关节轨迹的跟踪。
图7是经过和声搜索优化算法优化参数后的RBF神经网络滑模变结构控制用于挖掘机器人斗杆关节轨迹跟踪控制的结果,其中,理想轨迹10定义为:1-0.2cos(0.5πt),经过RBF神经网络滑模变结构的控制,挖掘机器人实现了斗杆关节轨迹的跟踪。
上面仅对本发明的较佳实施例作了详细说明,但是本发明并不限于上述实施例,在本领域普通技术人员所具备的知识范围内,还可以在不脱离本发明宗旨的前提下作出各种变化,各种变化均应包含在本发明的保护范围之内。
Claims (8)
1.一种挖掘机器人关节轨迹控制方法,其特征在于:包括
S1、建立挖掘机器人工作装置的拉格朗日动力学方程,以挖掘机器人动臂和斗杆为研究对象,铲斗全程处于锁止状态,将挖掘机器人的工作装置简化为二自由度的机械臂,由数据采集装置采集动臂和斗杆的关节角度,则挖掘机器人工作装置的拉格朗日动力学方程为:
S2、定义挖掘机器人关节轨迹控制误差,根据挖掘机器人的期望关节角位移和信号采集装置采集到的实际关节角位移定义挖掘机器人关节轨迹控制误差为:
e(t)=θd(t)-θ(t);
S3、定义滑模变结构的滑模面为:
进一步得出:
S4、计算RBF神经网络实际输出与理想输出之间的差值:
取RBF神经网络的输入为:
则根据RBF神经网络的结构原理可以得到其理想状态下的输出为:
由于在实际情况下RBF神经网络在逼近不确定函数时会产生误差ε,则RBF神经网络的实际输出为:
则RBF神经网络实际输出与理想输出之间的差值表示为:
S5、设计RBF神经网络滑模变结构的控制律为:
将上式带入S3可得:
S6、定义鲁棒控制项q,取τd和ε的上界分别为τdb和εb,则:
q=-(τdb+εb)sgn(s);
S7、对挖掘机器人关节轨迹控制***进行稳定性分析:
定义Lyapunov函数为:
将上式进行求导并将S5的结果带入得:
进一步由S6和上式可得:
sT(ε+τd+q)=sT(ε+τd)+sTq=sT(ε+τd)-||s||(εb+τdb)≤0,
3.根据权利要求2所述的一种挖掘机器人关节轨迹控制方法,其特征在于:所述S9中包括:
S9.1、根据挖掘机器人的关节角位移输入范围估计RBF神经网络的置信域中心c和置信域宽度b的初始值,神经网络隐含层与输出层的连接权值w由计算机随机产生;
S9.2、定义和声搜索优化算法的评价函数为:
S9.3、利用足够数量的训练样本对RBF神经网络进行训练得到K个和声向量(c,b,w),并且由这K个和声向量组成和声记忆库;
S9.4、初始化和声搜索优化算法的参数的有关参数,最大以及最小和声记忆库取值概率HMCRmax、HMCRmin,最大以及最小音调微调概率PARmax、PARmin,最大以及最小音调微调宽度bwmax、bwmin;
S9.5、分别运用动态调整公式调整和声记忆库取值概率HMCR、音调微调概率PAR和音调微调宽度bw;
S9.6、根据新和声产生条件生成新的和声向量,比较和声记忆库中最差的和声向量和新和声向量的评价函数值,如果新和声向量的评价函数值优于和声记忆库中最差和声向量的评价函数值,则以新和声向量代替和声记忆库中最差的和声向量,否则保持原和声记忆库不变;
S9.7、进一步检查和声搜索优化算法是否达到最大迭代次数,若迭代次数大于最大迭代次数则停止搜索,否则返回S25继续进行循环运算,直到满足算法终止条件为止。
4.一种挖掘机器人关节轨迹控制***,其特征在于:包括数据采集模块、数据处理模块以及依次连接的轨迹规划模块、逆方程解析模块、关节轨迹控制算法模块和控制指令转换传输模块,所述数据采集模块与关节轨迹控制算法模块相连接,所述数据采集模块、轨迹规划模块、逆方程解析模块、关节轨迹控制算法模块和控制指令转换传输模块均与数据处理模块连接;
所述轨迹规划模块用于规划出挖掘机器人期望的关节轨迹;
所述逆方程解析模块用于将规划出的挖掘机器人期望关节轨迹求解为挖掘机器人期望的关节角位移;
所述关节控制算法模块用于根据挖掘机器人实际关节转动数据和期望关节角位移运用挖掘机器人关节轨迹控制方法不断修正关节角位移的偏差量至最小值,并将修正后的关节角位移信号传输给控制指令转换传输模块;
所述控制指令转换传输模块用于将修正后的关节角位移转换为挖掘机器人可以识别的控制信号;
所述数据处理模块用于保存挖掘机器人关节轨迹控制***的各种数据。
5.根据权利要求4所述的一种挖掘机器人关节轨迹控制***,其特征在于:还包括位姿显示模块,所述位姿显示模块分别与逆方程解析模块和关节轨迹控制算法模块连接,根据挖掘机器人期望的关节角位移信息和修正后的关节角位移信息不断更新挖掘机器人的显示位姿。
6.根据权利要求4所述的一种挖掘机器人关节轨迹控制***,其特征在于:还包括车身、动臂(2)、动臂油缸(1)、斗杆(4)、斗杆油缸(3)、铲斗(6)、铲斗油缸(5)和驱动装置,所述车身、动臂(2)、斗杆(4)、铲斗(6)依次铰接,动臂油缸(1)、斗杆油缸(3)、铲斗油缸(5)依次设置在车身与动臂(2)之间、动臂(2)与斗杆(4)之间、斗杆(4)与铲斗(6)之间,所述驱动装置分别与动臂油缸(1)、斗杆油缸(3),铲斗油缸(5)相连接,所述动臂(2)与车身的铰接点、动臂(2)与斗杆(4)的铰接点均设置有光电编码器,所述光电编码器与数据采集模块连接。
7.根据权利要求6所述的一种挖掘机器人关节轨迹控制***,其特征在于:所述驱动装置包括电液比例阀,电液比例阀与控制指令转换传输模块连接。
8.根据权利要求6所述的一种挖掘机器人关节轨迹控制***,其特征在于:还包括液压***,液压***分别与动臂油缸(1)、斗杆油缸(3)、铲斗油缸(5)连接,所述液压***设置有油压传感器和液压流量传感器,油压传感器和液压流量传感器均与数据采集装置连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110067252.6A CN112681443B (zh) | 2021-01-19 | 2021-01-19 | 一种挖掘机器人关节轨迹控制方法及控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110067252.6A CN112681443B (zh) | 2021-01-19 | 2021-01-19 | 一种挖掘机器人关节轨迹控制方法及控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112681443A true CN112681443A (zh) | 2021-04-20 |
CN112681443B CN112681443B (zh) | 2024-07-12 |
Family
ID=75458496
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110067252.6A Active CN112681443B (zh) | 2021-01-19 | 2021-01-19 | 一种挖掘机器人关节轨迹控制方法及控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112681443B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113741456A (zh) * | 2021-09-02 | 2021-12-03 | 乐聚(深圳)机器人技术有限公司 | 机器人路径目标点跟踪方法、装置、电子设备及存储介质 |
CN114326378A (zh) * | 2022-01-27 | 2022-04-12 | 三一重机有限公司 | 作业机械轨迹控制方法、装置及作业机械 |
CN115075313A (zh) * | 2022-08-04 | 2022-09-20 | 网易(杭州)网络有限公司 | 控制信号量确定方法、装置、设备及存储介质 |
CN115478574A (zh) * | 2022-10-31 | 2022-12-16 | 吉林大学 | 一种基于径向基函数神经网络的挖掘机负载预测方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6076030A (en) * | 1998-10-14 | 2000-06-13 | Carnegie Mellon University | Learning system and method for optimizing control of autonomous earthmoving machinery |
KR20030008572A (ko) * | 2001-07-19 | 2003-01-29 | 현대중공업 주식회사 | 굴삭기의 자동 작업을 수행하기 위한 유압 제어 장치 및방법 |
AU2016259394B1 (en) * | 2016-02-08 | 2017-06-08 | Komatsu Ltd. | Work vehicle and method of controlling operation |
CN107882103A (zh) * | 2017-10-26 | 2018-04-06 | 南京工业大学 | 一种挖掘机三维姿态显示及远程自动控制*** |
CN110409546A (zh) * | 2019-07-25 | 2019-11-05 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种挖掘机的电控***及正流量***挖掘机 |
CN215888415U (zh) * | 2021-01-19 | 2022-02-22 | 山西创智卓越科技有限公司 | 一种挖掘机器人关节轨迹控制*** |
-
2021
- 2021-01-19 CN CN202110067252.6A patent/CN112681443B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6076030A (en) * | 1998-10-14 | 2000-06-13 | Carnegie Mellon University | Learning system and method for optimizing control of autonomous earthmoving machinery |
KR20030008572A (ko) * | 2001-07-19 | 2003-01-29 | 현대중공업 주식회사 | 굴삭기의 자동 작업을 수행하기 위한 유압 제어 장치 및방법 |
AU2016259394B1 (en) * | 2016-02-08 | 2017-06-08 | Komatsu Ltd. | Work vehicle and method of controlling operation |
CN107882103A (zh) * | 2017-10-26 | 2018-04-06 | 南京工业大学 | 一种挖掘机三维姿态显示及远程自动控制*** |
CN110409546A (zh) * | 2019-07-25 | 2019-11-05 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种挖掘机的电控***及正流量***挖掘机 |
CN215888415U (zh) * | 2021-01-19 | 2022-02-22 | 山西创智卓越科技有限公司 | 一种挖掘机器人关节轨迹控制*** |
Non-Patent Citations (1)
Title |
---|
张金萍;刘阔;林剑峰;马晓波;于文东;: "挖掘机的4自由度自适应模糊滑模控制", 机械工程学报, no. 21, 5 November 2010 (2010-11-05) * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113741456A (zh) * | 2021-09-02 | 2021-12-03 | 乐聚(深圳)机器人技术有限公司 | 机器人路径目标点跟踪方法、装置、电子设备及存储介质 |
CN114326378A (zh) * | 2022-01-27 | 2022-04-12 | 三一重机有限公司 | 作业机械轨迹控制方法、装置及作业机械 |
CN114326378B (zh) * | 2022-01-27 | 2023-12-05 | 三一重机有限公司 | 作业机械轨迹控制方法、装置及作业机械 |
CN115075313A (zh) * | 2022-08-04 | 2022-09-20 | 网易(杭州)网络有限公司 | 控制信号量确定方法、装置、设备及存储介质 |
CN115478574A (zh) * | 2022-10-31 | 2022-12-16 | 吉林大学 | 一种基于径向基函数神经网络的挖掘机负载预测方法 |
CN115478574B (zh) * | 2022-10-31 | 2024-03-19 | 吉林大学 | 一种基于径向基函数神经网络的挖掘机负载预测方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112681443B (zh) | 2024-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112681443A (zh) | 一种挖掘机器人关节轨迹控制方法及控制*** | |
Han et al. | Adaptive computation algorithm for RBF neural network | |
Egli et al. | A general approach for the automation of hydraulic excavator arms using reinforcement learning | |
Tzirkel‐Hancock et al. | Stable control of nonlinear systems using neural networks | |
CN110409546B (zh) | 一种挖掘机的电控***及正流量***挖掘机 | |
CN110409528B (zh) | 一种挖掘机铲斗轨迹自动控制装置、方法和计算机可读存储介质 | |
CN110154028A (zh) | 机械臂无模型自适应积分终端滑模控制方法 | |
CN105739310A (zh) | 一种基于多模型的伺服***自适应控制*** | |
CN111142404A (zh) | 一种基于压电陶瓷驱动的微定位平台及其建模与控制方法 | |
CN109976161A (zh) | 一种不确定非线性***的有限时间优化跟踪控制方法 | |
CN109669345A (zh) | 基于eso的水下机器人模糊pid运动控制方法 | |
CN215888415U (zh) | 一种挖掘机器人关节轨迹控制*** | |
Gu et al. | Proportional‐Integral‐Plus control of an intelligent excavator | |
CN104597753B (zh) | 一种同步碎石封层车沥青碎石撒布智能控制方法及装置 | |
CN115712244A (zh) | 一种基于事件触发的动力定位船舶h∞最优控制方法 | |
CN112835295B (zh) | 基于pi模型的压电陶瓷执行器参数辨识和复合控制方法 | |
CN110039537B (zh) | 一种基于神经网络的在线自学习多关节运动规划方法 | |
CN113156825A (zh) | 一种自适应反步滑模控制的舰载光电跟踪***设计方法 | |
Chen et al. | Learning trajectories for visual-inertial system calibration via model-based heuristic deep reinforcement learning | |
CN114012733B (zh) | 一种用于pc构件模具划线的机械臂控制方法 | |
AU2019101145A4 (en) | Method for determining ore grade using artificial neural network in a reserve estimation | |
CN114932546A (zh) | 一种基于未知机械臂模型的深度强化学习抑振***及方法 | |
Pallotta et al. | Two dimensional function learning using CMAC neural network with optimized weight smoothing | |
Peng et al. | Guided Deep Reinforcement Learning based on RBF-ARX Pseudo LQR in Single Stage Inverted Pendulum | |
CN117150901B (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 |