[发明专利]基于快速终端滑模的遥操作机器人固定时间控制方法有效

专利信息
申请号: 201510846957.2 申请日: 2015-11-27
公开(公告)号: CN105319972B 公开(公告)日: 2018-06-08
发明(设计)人: 华长春;杨亚娜 申请(专利权)人: 燕山大学
主分类号: G05B13/04 分类号: G05B13/04
代理公司: 秦皇岛一诚知识产权事务所(普通合伙) 13116 代理人: 续京沙
地址: 066004 河北省*** 国省代码: 河北;13
权利要求书: 查看更多 说明书: 查看更多
摘要: 发明涉及遥操作机器人同步控制技术领域,具体公开了一种基于快速终端滑模的遥操作机器人固定时间控制方法包括分别选取主机器人和从机器人组成遥操作系统,并分别测量主机器人和从机器人的系统参数,在线测量主机器人和从机器人的位置信息,并得到主机器人和从机器人的速度信息,设计快速终端滑模面,基于设计的快速终端滑模面,利用主机器人和从机器人的系统参数设计自适应固定时间控制器,利用李雅普诺夫方程给出参数自适应律、控制器参数及滑模面参数与系统收敛时间的关系式,从而根据实际应用对系统收敛时间的要求以及系统参数与系统收敛时间的关系式来确定控制器参数和滑模面参数。本发明弥补了现有遥操作机器人系统控制方法在控制速度和控制精度上的不足。
搜索关键词: 从机器人 遥操作机器人 快速终端 滑模面 收敛 控制器参数 时间控制 系统参数 滑模 同步控制技术 系统参数设计 参数自适应 时间控制器 遥操作系统 速度信息 系统控制 在线测量 自适应 测量 应用
【主权项】:
一种基于快速终端滑模的遥操作机器人固定时间控制方法,其特征在于,包括以下步骤:S1.分别选取主机器人和从机器人组成遥操作系统,并分别测量主机器人和从机器人的系统参数;S2.在线测量主机器人和从机器人的位置信息,并得到主机器人和从机器人的速度信息,设计快速终端滑模面;S3.基于设计的快速终端滑模面,利用主机器人和从机器人的系统参数设计自适应固定时间控制器;S4.利用李雅普诺夫方程给出参数自适应律、控制器参数及滑模面参数与系统收敛时间的关系式,进而根据实际应用对系统收敛时间的要求以及系统参数与系统收敛时间的关系式来确定控制器参数和滑模面参数,从而最终完成整个自适应固定时间控制器的设计;其中对于机械臂系统,所述步骤S1中的系统参数包括:杆的长度和质量信息,以及根据杆的长度和质量信息分别计算出的主机器人和从机器人的惯性矩阵、哥氏力、离心力矩阵、雅可比矩阵和重力项;主机器人和从机器人的惯性矩阵、哥氏力、离心力矩阵和重力项的计算均基于任务空间,需利用雅可比矩阵及其逆进行计算,基于关节空间的动力学模型为<mrow><msub><mi>M</mi><mi>m</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>m</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>m</mi></msub><mo>+</mo><msub><mi>C</mi><mi>m</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>m</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>m</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>m</mi></msub><mo>+</mo><msub><mi>G</mi><mi>m</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>m</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>&tau;</mi><mi>m</mi></msub><mo>+</mo><msub><msup><mi>J</mi><mi>T</mi></msup><mi>m</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>m</mi></msub><mo>)</mo></mrow><msub><mi>F</mi><mi>h</mi></msub></mrow><mrow><msub><mi>M</mi><mi>s</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>s</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>s</mi></msub><mo>+</mo><msub><mi>C</mi><mi>s</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>s</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>s</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>s</mi></msub><mo>+</mo><msub><mi>G</mi><mi>s</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>s</mi></msub><mo>)</mo></mrow><mo>=</mo><msub><mi>&tau;</mi><mi>s</mi></msub><mo>-</mo><msub><msup><mi>J</mi><mi>T</mi></msup><mi>s</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>s</mi></msub><mo>)</mo></mrow><msub><mi>F</mi><mi>e</mi></msub></mrow>其中,m表示主机器人,s表示从机器人,qm(t),qs(t)∈Rn为关节位移矩阵,为关节速度矩阵,Mm(qm),Ms(qs)∈Rn×n为正定的惯性矩阵,为哥氏力和离心力的矩阵,Gm(qm),Gs(qs)∈Rn为重力扭矩,Fh∈Rn和Fe∈Rn分别为人类操作者施加的力和环境施加的力,Jm(qm)和Js(qs)表示雅可比矩阵,τm∈Rn和τs∈Rn为提供的控制扭矩,利用任务空间与关节空间之间的关系xm=hm(qm),xs=hs(qs)得到<mrow><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>m</mi></msub><mo>=</mo><msub><mi>J</mi><mi>m</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>m</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>m</mi></msub><mo>;</mo><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>s</mi></msub><mo>=</mo><msub><mi>J</mi><mi>s</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>s</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>s</mi></msub></mrow><mrow><msub><mover><mi>x</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>m</mi></msub><mo>=</mo><msub><mover><mi>J</mi><mo>&CenterDot;</mo></mover><mi>m</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>m</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>m</mi></msub><mo>+</mo><msub><mi>J</mi><mi>m</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>m</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mo</div> </div> <div class="b20"></div> <div class="down-box" id="down-box"> <div class="msg" style="display: block;"> <span>下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。</span> </div> <div class="btns"> <span class="btn paydown">免登录下载</span><a href="/login.html?p=8684656C99F5006F63B3621D532ADB265436E56BCDDAE64E" class="btn green" target="_blank">普通用户下载</a><a href="http://yh.vipzhuanli.com/member/service/pay-vip.html?p=v1" target="_blank" class="btn red">升级VIP会员,免费下载</a> </div> </div> <div class="warning"> <p>该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于燕山大学,未经燕山大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【<a href="https://wpa1.qq.com/l11yQAzu?_type=wpa&qidian=true">客服</a>】</p> <p>本文链接:http://www.vipzhuanli.com/patent/201510846957.2/,转载请声明来源钻瓜专利网。</p> </div> <ul class="clear_div other_o"><li class="prev">上一篇:<a href="/patent/201510698868.8/" title="智能化房屋设计系统">智能化房屋设计系统</a></li><li class="next">下一篇:<a href="/patent/201510783514.3/" title="一种超远距离通信电缆高精度网络授时系统及其方法">一种超远距离通信电缆高精度网络授时系统及其方法</a></li></ul> <div class="oth-box"> <dl class="d_th"><dd><span>同类专利</span></dd><dt class="th_a"></dt></dl> <dl class="d_th" style="padding-top:15px;"><dd><span>专利分类</span></dd></dl> <div class="ps_c"> <div><a href="/ipc/G/" target="_blank" title="物理">G 物理</a></div><a class="ml1" href="/ipc/G05/" target="_blank" title="控制;调节">G05 控制;调节</a><br/><a class="ml2" href="/ipc/G05B/" target="_blank" title="一般的控制或调节系统;这种系统的功能单元;用于这种系统或单元的监视或测试装置">G05B 一般的控制或调节系统;这种系统的功能单元;用于这种系统或单元的监视或测试装置</a><br/><a class="ml3" href="/pat/ipc/G05B13/00/" target="_blank" title="自适应控制系统,即系统按照一些预定的准则自动调整自己使之具有最佳性能的系统">G05B13-00 自适应控制系统,即系统按照一些预定的准则自动调整自己使之具有最佳性能的系统</a><br/><a class="ml3" href="/pat/ipc/G05B13/02/" target="_blank" title=".电的">G05B13-02 .电的</a><br/><a class="ml3" href="/pat/ipc/G05B13/04/" target="_blank" title="..包括使用模型或模拟器的">G05B13-04 ..包括使用模型或模拟器的</a><br/> </div> </div> </div> <div class="content-r"> <div class="btns content-list" id="downdd"> <div class="header"> <div class="header-title"><a >专利文件下载</a></div> <hr /> </div> <span class="btn paydown">免登录下载</span><a href="/login.html?p=8684656C99F5006F63B3621D532ADB265436E56BCDDAE64E" class="btn green" target="_blank">普通用户下载</a><a href="http://yh.vipzhuanli.com/member/service/pay-vip.html?p=v1" target="_blank" class="btn red">升级VIP会员,免费下载</a> </div> <div class="content-list"> <div class="header"> <div class="header-title"><a href="/patent/list.html?kw=%e4%bb%8e%e6%9c%ba%e5%99%a8%e4%ba%ba ">从机器人 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/201480016822.7/">机器人系统的控制方法以及机器人系统</a></li> <li><a href="/patent/201610049922.0/">多机器人协作的路径规划方法</a></li> <li><a href="/patent/201610428044.3/">一种主从式机器人控制系统及控制方法</a></li> <li><a href="/patent/201610430962.X/">主从式蛇形机器人系统及其位置控制方法</a></li> <li><a href="/patent/201710906916.7/">一种扫地多机器人方法</a></li> <li><a href="/patent/201810680814.2/">异构机器人遥操作系统位置和速度同步控制方法</a></li> <li><a href="/patent/201811476071.3/">一种双臂机器人主从控制系统及方法</a></li> <li><a href="/patent/202010031572.1/">一种双机器人协作同步的方法、系统、装置和存储介质</a></li> <li><a href="/patent/202020447397.X/">一种多机器人协同作业的焊接系统</a></li> <li><a href="/patent/202110174853.7/">一种光伏阵列的清扫系统及方法</a></li> </ul> </div> <div class="content-list"> <div class="header"> <div class="header-title"><a href="/patent/list.html?kw=%e9%81%a5%e6%93%8d%e4%bd%9c%e6%9c%ba%e5%99%a8%e4%ba%ba ">遥操作机器人 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/200810224559.7/">机器人遥操作预测方法和遥操作预测平台</a></li> <li><a href="/patent/201210586278.2/">一种视频流传输控制方法以及视频流传输控制装置</a></li> <li><a href="/patent/201410100599.6/">具有时变时延的非线性遥操作系统位置和力跟踪控制系统</a></li> <li><a href="/patent/201410357772.0/">一种基于遥操作的摄像机器人实时控制方法</a></li> <li><a href="/patent/201510981637.8/">一种基于磁强计的机器人遥操作装置及方法</a></li> <li><a href="/patent/201610835693.5/">一种新型多足机器人在较平坦地形下的遥操作系统及控制方法</a></li> <li><a href="/patent/201810672578.X/">一种非线性遥操作双边控制系统</a></li> <li><a href="/patent/201911346270.7/">一种基于遥操作及全景视觉的机器人铸件打磨方法</a></li> <li><a href="/patent/202010629811.3/">一种遥操作机器人实时性控制系统及控制方法</a></li> <li><a href="/patent/202010999169.8/">一种遥操作工程机器人双目视觉定位系统</a></li> </ul> </div> <div class="content-list"> <div class="header"> <div class="header-title"><a href="/patent/list.html?kw=%e5%bf%ab%e9%80%9f%e7%bb%88%e7%ab%af ">快速终端 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/201410856806.0/">快速启动遥控器应用程序的方法及终端万能遥控器</a></li> <li><a href="/patent/201510052084.8/">一种移动终端应用快速启动的方法及移动终端</a></li> <li><a href="/patent/201610115753.6/">一种快速休眠功能的控制方法、终端和系统</a></li> <li><a href="/patent/201610292379.7/">通过客户端快速解锁的方法、系统和移动终端</a></li> <li><a href="/patent/201710438877.2/">具有防盗功能的快速通过终端</a></li> <li><a href="/patent/201710573678.2/">一种系统信息的发送方法、检测方法、基站及终端</a></li> <li><a href="/patent/201710818503.3/">一种智能充电方法及系统</a></li> <li><a href="/patent/201810601437.9/">车载终端快速启动的方法、装置及车载终端</a></li> <li><a href="/patent/201910312201.8/">一种网络认证方法</a></li> <li><a href="/patent/201922203363.6/">一种新型低功耗的无线通讯数据传输终端</a></li> </ul> </div> <div class="content-list"> <div class="header"> <div class="header-title"><a href="/patent/list.html?kw=%e6%bb%91%e6%a8%a1%e9%9d%a2 ">滑模面 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/201410793896.3/">基于小型无人机导航的滑模控制方法</a></li> <li><a href="/patent/201520506026.3/">高陡坡溢流面轨道混凝土滑模行走装置</a></li> <li><a href="/patent/201520506289.4/">高陡坡轨道混凝土滑模抹面平台调整装置</a></li> <li><a href="/patent/201520933312.8/">混凝土面板坝面板施工用摊铺、平整和抹面一体化装置</a></li> <li><a href="/patent/201710888028.7/">一种永磁同步电机二阶互补滑模速度控制方法</a></li> <li><a href="/patent/201910330380.8/">一种结合全局滑模和线性滑模的组合滑模控制方法</a></li> <li><a href="/patent/201910919085.6/">分数阶混沌系统的鲁棒同步控制方法</a></li> <li><a href="/patent/202010254413.8/">一种基于Buck电路的滑模控制方法和系统</a></li> <li><a href="/patent/202010693051.2/">一种有限时间收敛的二阶滑模控制方法</a></li> <li><a href="/patent/202011347868.0/">降压型直流变换器固定时间滑模控制方法和装置</a></li> </ul> </div> </div> </div> </div> <input type="hidden" id="hid_id" /> <script type="text/javascript"> /* <![CDATA[ */ var pat_ajax_url = "/down/check.html"; var wppay_ajax_url = "/pay/down"; var pnum = "201510846957.2"; var openNo = "CN105319972B"; var op = "20180608"; var y = "2018"; /* */
×

专利文献下载

说明:

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

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

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

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

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

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

tel code back_top