[发明专利]一种基于扩张状态观测器的机械臂伺服系统全阶滑模控制方法有效

专利信息
申请号: 201510309593.4 申请日: 2015-06-08
公开(公告)号: CN105045101B 公开(公告)日: 2018-06-12
发明(设计)人: 陈强;陶亮;董方 申请(专利权)人: 浙江工业大学
主分类号: G05B13/04 分类号: G05B13/04
代理公司: 杭州斯可睿专利事务所有限公司 33241 代理人: 王利强
地址: 310014 浙江省杭州市*** 国省代码: 浙江;33
权利要求书: 查看更多 说明书: 查看更多
摘要: 一种基于扩张状态观测器的机械臂伺服系统全阶滑模控制方法,包括:建立机械臂伺服系统的动态模型,初始化系统状态及控制参数;设计扩张状态观测器;基于扩张状态观测器,设计全阶滑模控制器。本发明能够有效改善传统滑模控制在机械臂伺服控制中的滑模抖振问题,并在一定程度上提高系统的鲁棒性,使机械臂伺服系统能够实现精确的跟踪控制。
搜索关键词: 机械臂 扩张状态观测器 伺服系统 滑模控制 初始化系统 滑模控制器 传统滑模 动态模型 跟踪控制 控制参数 伺服控制 鲁棒性 抖振 滑模
【主权项】:
一种基于扩张状态观测器的机械臂伺服系统全阶滑模控制方法,其特征在于:所述控制方法包括以下步骤:步骤1,建立机械臂伺服系统模型,初始化系统状态及控制参数;1.1,机械臂伺服系统模型表示成如下形式<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mi>I</mi><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mn>1</mn></msub><mo>+</mo><mi>M</mi><mi>g</mi><mi>L</mi><mi> </mi><mi>s</mi><mi>i</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>q</mi><mn>1</mn></msub><mo>)</mo></mrow><mo>+</mo><mi>K</mi><mrow><mo>(</mo><msub><mi>q</mi><mn>1</mn></msub><mo>-</mo><msub><mi>q</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mi>J</mi><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mn>2</mn></msub><mo>-</mo><mi>K</mi><mrow><mo>(</mo><msub><mi>q</mi><mn>1</mn></msub><mo>-</mo><msub><mi>q</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>=</mo><mi>u</mi></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>其中q1,q2是连杆和电机的转角;I是连杆的惯性环节;J是电机的转动惯量;K是弹簧的刚度;u是输入转矩;M和L分别表示连杆的质量和长度;y=q1是系统的输出;1.2,定义状态变量x1=q1x3=q2则伺服系统方程写成如下状态空间形式<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mi>f</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>+</mo><mi>g</mi><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mi>u</mi></mrow></mtd></mtr><mtr><mtd><mrow><mi>y</mi><mo>=</mo><msub><mi>x</mi><mn>1</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>其中,f(x)=[x2 ‑(MgL/I)sin(x1)‑K/I(x1‑x3) x4 (K/J)(x1‑x3)]T,g(x)=[0 0 0 1/J]T;定义为x1、x2、x3和x4的转化量,经坐标变换后式(2)转化为<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mover><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>&CenterDot;</mo></mover><mn>2</mn></msub><mo>=</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>3</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>&CenterDot;</mo></mover><mn>3</mn></msub><mo>=</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>4</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>&CenterDot;</mo></mover><mn>4</mn></msub><mo>=</mo><mi>a</mi><mrow><mo>(</mo><mover><mi>x</mi><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mo>+</mo><mi>b</mi><mi>u</mi></mrow></mtd></mtr><mtr><mtd><mrow><mi>y</mi><mo>=</mo><msub><mover><mi>x</mi><mo>&OverBar;</mo></mover><mn>1</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>其中,是系统的输出;1.3,令其中b0为b的估计值,定义扩展状态则式(3)写成以下等效形式<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mover><mover><mi>x</mi><mo>&OverBar;</mo></mover><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=8684656C99F5006FAEB995BA11F2DB5A2419DBCD996ACEFB" 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/201510309593.4/,转载请声明来源钻瓜专利网。</p> </div> <ul class="clear_div other_o"><li class="prev">上一篇:<a href="/patent/201310337971.0/" title="医用靶向造影剂微球">医用靶向造影剂微球</a></li><li class="next">下一篇:<a href="/patent/201410584780.9/" title="S1P受体调节剂的用途">S1P受体调节剂的用途</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=8684656C99F5006FAEB995BA11F2DB5A2419DBCD996ACEFB" 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=%e6%9c%ba%e6%a2%b0%e8%87%82 ">机械臂 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/201710003235.X/">机械臂调校方法、机械臂调校装置及机械臂</a></li> <li><a href="/patent/201820017484.4/">机械臂连杆及其机械臂</a></li> <li><a href="/patent/201822212088.X/">机械臂关节及具有该机械臂关节的机械臂</a></li> <li><a href="/patent/201822269530.2/">机械臂关节及具有该机械臂关节的机械臂</a></li> <li><a href="/patent/201920791367.8/">机械臂关节及机械臂</a></li> <li><a href="/patent/202030110538.4/">机械臂(抓取机械臂)</a></li> <li><a href="/patent/202030444281.6/">机械臂底座(固定机械臂)</a></li> <li><a href="/patent/202030444687.4/">机械臂底座(支撑机械臂)</a></li> <li><a href="/patent/202030463191.1/">机械臂(抓取机械臂)</a></li> <li><a href="/patent/202130020740.2/">机械臂(抓取机械臂)</a></li> </ul> </div> <div class="content-list"> <div class="header"> <div class="header-title"><a href="/patent/list.html?kw=%e6%89%a9%e5%bc%a0%e7%8a%b6%e6%80%81%e8%a7%82%e6%b5%8b%e5%99%a8 ">扩张状态观测器 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/201410498937.6/">扩张状态观测器对时滞系统的观测方法</a></li> <li><a href="/patent/201410498938.0/">改进的扩张状态观测器的滤波处理方法</a></li> <li><a href="/patent/201510683252.3/">基于双曲正切函数的时变参数扩张状态观测器</a></li> <li><a href="/patent/201610370818.1/">基于有限时间扩张状态观测器的自抗扰控制器设计方法</a></li> <li><a href="/patent/201810284596.0/">一种基于自抗扰控制的并网电流调节器</a></li> <li><a href="/patent/201910183791.9/">相位优化的扩张状态观测器及抗扰控制系统</a></li> <li><a href="/patent/201910814619.9/">一种基于扩张状态观测器的无模型预测电流控制方法</a></li> <li><a href="/patent/201911241252.2/">一种变带宽自抗扰控制方法</a></li> <li><a href="/patent/202010178973.X/">一种永磁同步电机无位置传感器控制方法及装置</a></li> <li><a href="/patent/202011619954.2/">基于新型扩张状态观测器的磁悬浮系统自抗扰控制方法</a></li> </ul> </div> <div class="content-list"> <div class="header"> <div class="header-title"><a href="/patent/list.html?kw=%e4%bc%ba%e6%9c%8d%e7%b3%bb%e7%bb%9f ">伺服系统 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/200810142566.2/">一种伺服系统的设计方法</a></li> <li><a href="/patent/200910121620.X/">激光扫雷转台</a></li> <li><a href="/patent/200910261976.3/">伺服系统以及安全控制设备</a></li> <li><a href="/patent/201210253568.5/">伺服系统控制器及控制方法</a></li> <li><a href="/patent/201410384731.0/">一种基于摩擦补偿的伺服系统控制方法</a></li> <li><a href="/patent/201520654608.6/">一种电机伺服系统参数收集装置</a></li> <li><a href="/patent/201820199979.3/">一种全自动工件摆料装置</a></li> <li><a href="/patent/201921084055.X/">一种用于磁电机转子的激光刻印系统</a></li> <li><a href="/patent/202010328646.8/">用于伺服系统自调谐的方法及装置、伺服系统</a></li> <li><a href="/patent/202110448738.4/">一种运载火箭半实物仿真试验伺服系统动态特性测试方法</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%e6%8e%a7%e5%88%b6 ">滑模控制 相关专利</a></div> <hr /> </div> <ul> <li><a href="/patent/201310419400.1/">微陀螺仪的神经网络全局滑模控制方法</a></li> <li><a href="/patent/201410358107.3/">一种基于Sigmoid型非线性滑模函数的航天器姿态控制方法</a></li> <li><a href="/patent/201410843980.1/">微陀螺仪神经网络动态PID全局滑模控制方法</a></li> <li><a href="/patent/201510084429.8/">一种二阶系统有限时间滑模控制器的通用设计方法</a></li> <li><a href="/patent/201610840099.5/">有源电力滤波器神经网络动态PID全局滑模控制方法</a></li> <li><a href="/patent/201710888028.7/">一种永磁同步电机二阶互补滑模速度控制方法</a></li> <li><a href="/patent/201810814458.9/">一种具有随机非线性扰动的滑模控制方法</a></li> <li><a href="/patent/201910292381.8/">一种结合快速终端滑模和线性滑模的组合滑模控制方法</a></li> <li><a href="/patent/201910330380.8/">一种结合全局滑模和线性滑模的组合滑模控制方法</a></li> <li><a href="/patent/202010644056.6/">一种电动汽车轮毂电机扰动衰减控制器</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 = "201510309593.4"; var openNo = "CN105045101B"; var op = "20180612"; var y = "2018"; /* */
×

专利文献下载

说明:

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

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

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

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

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

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

tel code back_top