【中国发明,中国发明授权】一种抑制柔性机械臂振动的边界控制方法

无权-未缴年费 中国

申请号:
CN201410675083.4
专利权人:
电子科技大学
授权公告日/公开日:
2016.01.13
专利有效期:
2014.11.21-2034.11.21
技术分类:
B25:手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
转化方式:
转让
价值度指数:
57.0分
价格:
面议
1397 0

发布人

知识产权运营中心

联系人IP先生

15113831943
9411117419@qq.com
941117419
szhf1188(加微信)
深圳市南山区粤海街道100号
  • 专利信息&法律状态
  • 专利自评
  • 专利技术文档
  • 价值度指数
  • 发明人阵容

著录项

申请号
CN201410675083.4
申请日
20141121
公开/公告号
CN104589344A
公开/公告日
20150506
申请/专利权人
[电子科技大学]
发明/设计人
[贺威, 杨川, 何修宇]
主分类号
B25J9/16
IPC分类号
C12N 9/0008(2013.01) C12N 9/16
CPC分类号
C12N 9/0008(2013.01) C12N 9/16(2013.01)
分案申请地址
国省代码
四川(51)
颁证日
G06T1/00
代理人
[温利平]

摘要

本发明公开了一种抑制柔性机械臂振动的边界控制方法,通过对柔性机械臂系统进行分析并建立数学模型,再结合数学模型设计出柔性机械臂系统的边界控制器,然后对带有控制作用的柔性机械臂系统进行稳定性分析,并仿真系统运动状态,根据仿真结果对系统的控制参数进行调整,使之最终达到设计要求。这样首先能够有效地抑制柔性机械臂在工作过程中的振动,其次,本发明在设计边界控制器时,增加了驱动柔性机械臂到达指定位置的功能,这样还能够实现柔性机械手臂的位置跟踪。

法律状态

法律状态公告日 20201030
法律状态 专利权的终止
法律状态信息 未缴年费专利权终止
IPC(主分类):B25J 9/16
专利号:ZL2014106750834
申请日:20141121
授权公告日:20160113
终止日期:20191121
法律状态公告日 20160113
法律状态 授权
法律状态信息 授权
法律状态公告日 20150527
法律状态 实质审查的生效
法律状态信息 实质审查的生效
IPC(主分类):B25J 9/16
申请日:20141121
法律状态公告日 20150506
法律状态 公开
法律状态信息 公开
暂无数据

权利要求

权利要求数量(1

独立权利要求数量(1

1.一种抑制柔性机械臂振动的边界控制方法,其特征在于,包 括以下步骤:

(1)、对柔性机械臂系统进行分析并建模

柔性机械臂系统的动能:

E k ( t ) = 1 2 I [ θ . ( t ) ] 2 + 1 2 ρ 0 L [ y . ( x , t ) ] 2 dx ; - - - ( 1 )

θ . ( t ) = θ ( t ) / t ;

y . ( x , t ) = y ( x , t ) / t ;

其中,I代表柔性机械臂系统的惯量,θ(t)代表柔性机械臂的偏 转角度,ρ代表柔性机械臂的密度,L是柔性机械臂的长度,y(x,t)代 表在位置x、时间t时柔性机械臂系统的位置,x∈[0,L]表示柔性机械 臂各个位置,t∈[0,∞]表示时间;

柔性机械臂系统的势能:

其中,E I表示柔性机械臂的弯曲刚度,T为柔性机械臂的张力, 表示在位置x、时间t时柔性机械臂系统的振动幅值;

边界控制对柔性机械臂系统的虚功:

δW m = τ ( t ) δ y ( 0 , t ) - - - ( 3 )

其中,δ是变分符号,τ(t)为边界控制器;

再根据哈密顿原理(Hamilton principle),得到柔性机械臂系统的 数学模型;

其中, y . . ( x , t ) = 2 y ( x , t ) / 2 t , y ( x , t ) = 2 y ( x , t ) / x 2 ,

在柔性机 械臂系统的数学模型中,公式(4)为柔性机械臂系统的控制方程, 公式(5)为柔性机械臂系统的边界条件;

(2)、设计边界控制器τ(t)

τ ( t ) = - k 1 θ . ( t ) - k 2 [ θ ( t ) - θ d ] - - - ( 6 )

其中,θ d表示控制柔性机械臂到达的预设位置;k 1和k 2为控制 参数,可以通过预先训练得到,即:预先通过MATLAB软件仿真一 个柔性机械臂系统,结合控制方程(4)和边界条件(5)进行仿真训 练,其训练目标是保证柔性机械臂上各处的振动幅值小于加入控制前 振动幅值 的M%,;

(3)、在时刻t,采用位移传感器测量得到柔性机械臂的振动幅 值 采用倾角计测量得到偏转角θ(t);

(4)、将步骤(3)得到的实时参数 θ(t),控制参数k 1,k 2以 及θ d的值代入步骤(2),得到任意t时刻的边界控制器τ(t),驱动装置 再根据边界控制器τ(t)向柔性机械臂施加作用力,驱使柔性机械臂移 动到指定位置θ d,同时抑制系统振动。

1.一种抑制柔性机械臂振动的边界控制方法,其特征在于,包 括以下步骤: (1)、对柔性机械臂系统进行分析并建模 柔性机械臂系统的动能: E k ( t ) = 1 2 I [ θ . ( t ) ] 2 + 1 2 ρ ∫ 0 L [ y . ( x , t ) ] 2 dx ; - - - ( 1 ) θ . ( t ) = ∂ θ ( t ) / ∂ t ; y . ( x , t ) = ∂ y ( x , t ) / ∂ t ; 其中,I代表柔性机械臂系统的惯量,θ(t)代表柔性机械臂的偏 转角度,ρ代表柔性机械臂的密度,L是柔性机械臂的长度,y(x,t)代 表在位置x、时间t时柔性机械臂系统的位置,x∈[0,L]表示柔性机械 臂各个位置,t∈[0,∞]表示时间; 柔性机械臂系统的势能: 其中,EI表示柔性机械臂的弯曲刚度,T为柔性机械臂的张力, 表示在位置x、时间t时柔性机械臂系统的振动幅值; 边界控制对柔性机械臂系统的虚功: δW m = τ ( t ) δ y ′ ( 0 , t ) - - - ( 3 ) 其中,δ是变分符号,τ(t)为边界控制器; 再根据哈密顿原理(Hamilton principle),得到柔性机械臂系统的 数学模型; 其中, y . . ( x , t ) = ∂ 2 y ( x , t ) / ∂ 2 t , y ′ ′ ( x , t ) = ∂ 2 y ( x , t ) / ∂ x 2 , 在柔性机 械臂系统的数学模型中,公式(4)为柔性机械臂系统的控制方程, 公式(5)为柔性机械臂系统的边界条件; (2)、设计边界控制器τ(t) τ ( t ) = - k 1 θ . ( t ) - k 2 [ θ ( t ) - θ d ] - - - ( 6 ) 其中,θd表示控制柔性机械臂到达的预设位置;k1和k2为控制 参数,可以通过预先训练得到,即:预先通过MATLAB软件仿真一 个柔性机械臂系统,结合控制方程(4)和边界条件(5)进行仿真训 练,其训练目标是保证柔性机械臂上各处的振动幅值小于加入控制前 振动幅值的M%,; (3)、在时刻t,采用位移传感器测量得到柔性机械臂的振动幅 值采用倾角计测量得到偏转角θ(t); (4)、将步骤(3)得到的实时参数θ(t),控制参数k1,k2以 及θd的值代入步骤(2),得到任意t时刻的边界控制器τ(t),驱动装置 再根据边界控制器τ(t)向柔性机械臂施加作用力,驱使柔性机械臂移 动到指定位置θd,同时抑制系统振动。

说明书

技术领域

本发明属于自动控制技术领域,更为具体地讲,涉及一种抑制柔性机械臂振动的边界控制方法。

背景技术

机器人技术已经经历了半个多世纪的快速发展,其应用范围已从最初单纯的工业生产延伸到了以工业、医学、农业、建筑业以及军事等为背景的各个领域。然而,随着人类对机器人性能,如质量、效率、稳定性以及寿命等指标提出了更高的要求,作为其重要组成部分的机械手臂也面临着重大的挑战。传统机械手臂(刚性手臂)的设计和制造都是以尽可能大的刚度来实现对定位和其它操作的相关要求,因此不可避免地形成了质量笨重、灵活性差、功耗高以及功能简单等缺点。相比于传统质量重、体积大的刚性手臂,采用轻质材料的柔性机械臂更好地克服了以上缺点,其操作灵活、响应快速、性能稳定的特点,使之在各个领域都具有很高的应用价值。

然而,随着材料的轻型化,必然衍生出易于受外界环境干扰而导致性能下降的负面影响,自身的振动问题成为了研究柔性机械臂所面临的最大难点。同时,由外界扰动造成的不良振动,使得机械臂难以精确定位;大的形变也将会影响其机械性能,甚至损毁机械结构,造成重大损失。因此,振动的抑制是我们必须要考虑并解决的问题。在系统的动力学分析中,柔性机械臂是一个典型的分布式参数系统,其无穷维的特点将是后续设计过程中的难点。

目前国内很多基于分布式参数系统的控制策略得到了充分地研究和发展,其中包括:变结构控制法、滑模控制法、基于能量的鲁棒控制、分布式控制和边界控制等。作为典型的非线性系统,滑模控制在柔性机械手臂的控制方面得到了一定的应用,且能表现出良好的控制效果和鲁棒性。例如专利号为201210052088.2的发明专利就采用将观测器与滑模控制相结合的策略,以达到对机械手臂的有效控制;以及专利号为201210052283.5的发明专利对欠驱动双耦合电机运用滑模控制方法实现所需的跟踪控制。但滑模控制不可避免地会引 起抖阵现象,降低控制精度,激发建模时被忽略的高频部分,且目前对滑模控制中如何设计优良的滑模面以产生稳定的滑模动态尚未得出十分有效的方法。边界控制作为一种新兴的控制方法,其应用也越来越广,例如将边界控制法应用在传送带的振动控制中,用以处理边界扰动和分布式扰动对系统造成的不良影响。抑制振动是控制理论的基本要求之一,而此种应用也仅仅局限在对系统振动的控制上,而针对工业机械手臂这类既需要抑制振动又需要控制角度的系统,目前的研究则显得十分有限。相对于其他控制方法而言,边界控制不仅能有效避免滑模控制中因忽略高频模态而引发的溢出效应,且不需要类似于分布式控制中利用大量的传感器去采集模态,大大减少了成本,因而得到了不断深入的研究和发展。

发明内容
附图说明

图1是柔性机械臂运行示意图;

图2是本发明抑制柔性机械臂振动的边界控制方法的流程图;

图3是本发明未加入边界控制时,柔性机械臂系统的振动仿真图;

图4是本发明未加入边界控制时,柔性机械臂系统的角度仿真图;

图5是本发明加入边界控制后,柔性机械臂系统的振动仿真图;

图6是本发明加入边界控制后,柔性机械臂系统的角度仿真图;

图7是边界控制器的控制输入仿真图。

具体实施方式

价值度评估

技术价值

经济价值

法律价值

0 0 0

57.0

0 50 75 100
0~50 50~75 75~100 价值较低 中等价值 价值较高

专利价值度是通过科学的评估模

型对专利价值进行量化的结果,

基于专利大数据针对专利总体特

征指标利用计算机自动化技术对

待评估专利进行高效、智能化的

分析,从技术、经济和法律价值

三个层面构建专利价值评估体

系,可以有效提升专利价值评估

的质量和效率。

总评:57.0


该专利价值中等 (仅供参考)

        该专利的技术、经济、法律价值经系统自动评估后的总评得分处于平均水平,可以重点研究利用其技术价值,根据法律价值的评估结果选择合适的使用借鉴方式。
        本专利文献中包含【3 个技术分类】,从一定程度上而言上述指标的数值越大可以反映出所述专利的技术保护及应用范围越广。 【被引用次数1 次】专利被引次数越多越能能够体现出该专利在相关技术领域研发中所发挥的基础性作用,代表着专利公开的内容有更多的产业利用价值。 【专利权的维持时间6 年】专利权的维持时间越长,其价值对于权利人而言越高。

技术价值    34.0

该指标主要从专利申请的著录信息、法律事件等内容中挖掘其技术价值,专利类型、独立权利要求数量、无效请求次数等内容均可反映出专利的技术性价值。 技术创新是专利申请的核心,若您需要进行技术借鉴或寻找可合作的项目,推荐您重点关注该指标。

部分指标包括:

授权周期(发明)

13 个月

独立权利要求数量

0 个

从属权利要求数量

0 个

说明书页数

10 页

实施例个数

0 个

发明人数量

3 个

被引用次数

1 次

引用文献数量

1 个

优先权个数

0 个

技术分类数量

3 个

无效请求次数

0 个

分案子案个数

0 个

同族专利数

0 个

专利获奖情况

保密专利的解密

经济价值    7.0

该指标主要指示了专利技术在商品化、产业化及市场化过程中可能带来的预期利益。 专利技术只有转化成生产力才能体现其经济价值,专利技术的许可、转让、质押次数等指标均是其经济价值的表征。 因此,若您希望找到行业内的运用广泛的热点专利技术及侵权诉讼中的涉案专利,推荐您重点关注该指标。

部分指标包括:

申请人数量

1

申请人类型

院校

许可备案

0 次

权利质押

0 次

权利转移

0 个

海关备案

法律价值    16.0

该指标主要从专利权的稳定性角度评议其价值。专利权是一种垄断权,但其在法律保护的期间和范围内才有效。 专利权的存续时间、当前的法律状态可反映出其法律价值。故而,若您准备找寻权属稳定且专利权人非常重视的专利技术,推荐您关注该指标。

部分指标包括:

存活期/维持时间

6

法律状态

无权-未缴年费