[发明专利]网络Euler‑Lagrange系统分布式模糊协同跟踪控制方法有效

专利信息
申请号: 201510137121.5 申请日: 2015-03-26
公开(公告)号: CN104698854B 公开(公告)日: 2017-06-23
发明(设计)人: 李传江;王俊;孙延超;马广富;王鹏宇;姜丽松 申请(专利权)人: 哈尔滨工业大学
主分类号: G05B13/04 分类号: G05B13/04
代理公司: 哈尔滨市松花江专利商标事务所23109 代理人: 杨立超
地址: 150001 黑龙*** 国省代码: 黑龙江;23
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 网络 euler lagrange 系统 分布式 模糊 协同 跟踪 控制 方法
【权利要求书】:

1.网络Euler-Lagrange系统分布式模糊协同跟踪控制方法,其特征在于它按以下步骤实现:

步骤1:对跟随双关节机械臂智能体的Euler-Lagrange动力学模型进行处理,将模型的非线性不确定项根据其来源进行分类得到和

步骤2:采用自适应模糊控制系统设计,分别实现对模型的两类非线性不确定项和进行动态在线逼近;

步骤3:采用分布式自适应模糊协同跟踪控制算法,设计τi使所有的跟随双关节机械臂智能体能渐近跟踪领航双关节机械臂智能体的转动角,使跟踪误差qi-q0趋近于零,为控制输入;其中,所述qi为跟随双关节机械臂智能体i的转动角,且i=1,2,…,n,q0表示领航双关节机械臂智能体的转动角。

2.根据权利要求1所述的网络Euler-Lagrange系统分布式模糊协同跟踪控制方法,其特征在于所述步骤1具体为:

已知Mi(qi),和gi(qi)的标称值和i=1,…,n表示跟随双关节机械臂智能体的编号,并且各跟随双关节机械臂智能体能获得自身所有转动角、转动角速度和转动角加速度信息,第i个跟随双关节机械臂智能体的动力学模型可以写成如下Euler-Lagrange形式:

<mrow><msubsup><mi>M</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><msubsup><mi>C</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><msubsup><mi>g</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>&tau;</mi><mi>i</mi></msub><mo>+</mo><msub><mi>&rho;</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>

其中:

<mrow><msub><mi>&rho;</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>e</mi><mrow><mi>m</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>M</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo><mo>+</mo><msub><mi>e</mi><mrow><mi>c</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>C</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo><mo>+</mo><msub><mi>e</mi><mrow><mi>g</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>g</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>&rsqb;</mo><mo>-</mo><msub><mi>&delta;</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow></mrow>

<mrow><msub><mi>e</mi><mrow><mi>m</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>M</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo><mo>=</mo><msubsup><mi>M</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msub><mi>M</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub></mrow>

<mrow><msub><mi>e</mi><mrow><mi>c</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>C</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo><mo>=</mo><msubsup><mi>C</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msub><mi>C</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub></mrow>

<mrow><msub><mi>e</mi><mrow><mi>g</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>g</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>&rsqb;</mo><mo>=</mo><msubsup><mi>g</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>g</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow>

qi为第i个跟随双关节机械臂智能体的转动角;

为第i个跟随双关节机械臂智能体的转动角速度;

为第i个跟随双关节机械臂智能体的转动角加速度;

为对称正定的惯量矩阵,为Coriolis力和偏心力,为广义有势力,为控制输入,是由摩擦、外部扰动以及负载变化引起的模型广义不确定项;

考虑到由摩擦、外部扰动引起的不确定项与双关节机械臂智能体的转动角和转动角速度信息有关,由负载变化引起的不确定项与双关节机械臂智能体的转动角加速度信息有关,跟随双关节机械臂智能体的Euler-Lagrange动力学模型(1),改写成如下形式

<mrow><msubsup><mi>M</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><msubsup><mi>C</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><msubsup><mi>g</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>&tau;</mi><mi>i</mi></msub><mo>+</mo><msub><mi>&rho;</mi><mrow><mi>a</mi><mi>i</mi></mrow></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>&rho;</mi><mrow><mi>b</mi><mi>i</mi></mrow></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>

其中

<mrow><msub><mi>&rho;</mi><mrow><mi>a</mi><mi>i</mi></mrow></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>e</mi><mrow><mi>c</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>C</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo><mo>+</mo><msub><mi>e</mi><mrow><mi>g</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>g</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>&rsqb;</mo><mo>+</mo><msub><mi>f</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>d</mi><mi>i</mi></msub></mrow>

<mrow><msub><mi>&rho;</mi><mrow><mi>b</mi><mi>i</mi></mrow></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>e</mi><mrow><mi>m</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>M</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo></mrow>

<mrow><msub><mi>e</mi><mrow><mi>m</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>M</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo><mo>=</mo><msubsup><mi>M</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msub><mi>M</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub></mrow>

<mrow><msub><mi>e</mi><mrow><mi>c</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>C</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>&rsqb;</mo><mo>=</mo><msubsup><mi>C</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msub><mi>C</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub></mrow>

<mrow><msub><mi>e</mi><mrow><mi>g</mi><mi>i</mi></mrow></msub><mo>&lsqb;</mo><msub><mi>g</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>&rsqb;</mo><mo>=</mo><msubsup><mi>g</mi><mi>i</mi><mn>0</mn></msubsup><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>g</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow>

di为外界扰动项,为摩擦引起的不确定项。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工业大学,未经哈尔滨工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/201510137121.5/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top