• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
    • / 5
    • 下载费用:30 金币  

    重庆时时彩五星和值: 一种冗余度机械臂加速度层运动规划的初始化方法.pdf

    摘要
    申请专利号:

    CN201510843147.1

    申请日:

    2015.11.26

    公开号:

    CN105598984A

    公开日:

    2016.05.25

    当前法律状态:

    授权

    有效性:

    有权

    法律详情: 授权|||实质审查的生效IPC(主分类):B25J 13/00申请日:20151126|||公开
    IPC分类号: B25J13/00; B25J9/16; G06F19/00(2011.01)I 主分类号: B25J13/00
    申请人: 华侨大学
    发明人: 郭东生; 聂卓赟; 晏来成; 金福江
    地址: 362000 福建省泉州市丰泽区城东
    优先权:
    专利代理机构: 厦门市首创君合专利事务所有限公司 35204 代理人: 张松亭
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201510843147.1

    授权公告号:

    ||||||

    法律状态公告日:

    2017.10.20|||2016.06.22|||2016.05.25

    法律状态类型:

    授权|||实质审查的生效|||公开

    摘要

    本发明中的冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置,而后利用该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案,而后利用数值算法对加速度层位置调整方案求解,最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置,该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。

    权利要求书

    1.一种冗余度机械臂加速度层运动规划的初始化方法,其特征在于:包括以下步骤:
    1)启动机械臂控制器,将冗余度机械臂调节到其极限位置,具体操作是依次驱动
    机械臂各个关节的电机使其最终达到各自的极限位置;
    2)将步骤1)的极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建
    立基于二次型优化描述的加速度层位置调整方案,所述的优化方案受约束于关节角
    度极限、关节速度极限和关节加速度极限;对于拥有n自由度的机械臂而言,加速
    度层位置调整方案设计为:
    最小化 θ ·· T θ ·· / 2 + ( 2 γ θ · + γ 2 ( θ - θ d ) ) T θ ·· , ]]>
    其中,设计参数γ>0∈R,上标T表示矩阵或向量的转置;θ∈Rn表示关节角度,
    表示关节速度,表示关节加速度;θd∈Rn为机械臂任务执行初始
    位置;
    加速度层位置调整方案受约束于:
    θ - θ θ + , θ · - θ · θ · + , θ ·· - θ ·· θ ·· + ; ]]>
    其中,θ±∈Rn、和分别表示关节角度极限、关节速度极限和关
    节加速度极限;
    3)将步骤2)的加速度层位置调整方案利用数值算法进行求解;
    4)下位机控制器根据步骤3)的求解结果,驱动机械臂使其由极限位置转动到任务
    执行位置。
    2.根据权利要求1所述的冗余度机械臂加速度层运动规划的初始化方法,其特征在于:
    步骤2)中,将机械臂的关节极限转化为在加速度层上描述的双端约束,具体操作
    是利用约束转换方法将θ-≤θ≤θ+,和转化描述为一
    个基于关节加速度的双端约束,即,其中η-∈Rn和η+∈Rn的
    第i个元素分别定义为和
    i=1,2,…n,关节极限转换参数
    k1>0∈R和k2>0∈R,关节极限转换裕量
    3.根据权利要求1所述的冗余度机械臂加速度层运动规划的初始化方法,其特征在
    于:步骤3)中,通过数值算法对加速度层位置调整方案进行求解,具体操作是将
    所述加速度层位置调整方案进一步变换为分段线性投影方程,从而构造相应的数
    值算法进行求解。

    说明书

    一种冗余度机械臂加速度层运动规划的初始化方法

    技术领域

    本发明涉及冗余度机械臂加速度层运动规划领域,具体涉及一种冗余度机械臂加速度层运动规划的初始化方法。

    背景技术

    冗余度机械臂是一种末端能动的机械装置,其自由度多于执行末端任务所需最少自由度;目前已广泛应用于装备制造、产品加工、机器作业等国民经济生产活动中。冗余度机械臂在工作空间中不同的位置执行任务时,当结束一个任务后,往往需要从当前位置移动到下一个任务的执行位置。一般而言,冗余度机械臂从当前位置移动到下一个任务的执行位置,都是通过慢慢转动机械臂各个关节并不断调整来实现。然而,这种做法是相当繁琐且存在着不足的:每次改变任务操作位置时都有可能需要多次度量各个关节角度以使机械臂准确到达其执行任务的位置;并且任务执行位置测量或调整的不准确也将影响到机械臂正常/成功完成所要求的任务。

    重庆时时彩单双窍门 www.4mum.com.cn 发明内容

    本发明的目的在于克服一般技术的不足,提供一种操作方便、工作量少、作业规范且是在加速度层上实现的冗余度机械臂运动规划初始化方法。

    本发明提供的技术方案如下:一种冗余度机械臂加速度层运动规划的初始化方法,包括以下步骤:

    1)启动机械臂控制器,将冗余度机械臂调节到其极限位置,具体操作是依次驱动机械臂各个关节的电机使其最终达到各自的极限位置;

    2)将步骤1)的极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案,所述的优化方案受约束于关节角度极限、关节速度极限和关节加速度极限;对于拥有n自由度的机械臂而言,加速度层位置调整方案设计为:

    最小化

    其中,设计参数γ>0∈R,上标T表示矩阵或向量的转置;θ∈Rn表示关节角度,表示关节速度,表示关节加速度;θd∈Rn为机械臂任务执行初始位置;加速度层位置调整方案受约束于:θ-≤θ≤θ+,

    其中,θ±∈Rn、和分别表示关节角度极限、关节速度极限和关节加速度极限;

    3)将步骤2)的加速度层位置调整方案利用数值算法进行求解;

    4)下位机控制器根据步骤3)的求解结果,驱动机械臂使其由极限位置转动到任务执行位置。

    在本发明的较佳实施例中,步骤2)中,将机械臂的关节极限转化为在加速度层上描述的双端约束,具体操作是利用约束转换方法将θ-≤θ≤θ+,和转化描述为一个基于关节加速度的双端约束,即,其中η-∈Rn和η+∈Rn的第i个元素分别定义为和i=1,2,…n,关节极限转换参数k1>0∈R和k2>0∈R,关节极限转换裕量

    在本发明的较佳实施例中,步骤3)中,通过数值算法对加速度层位置调整方案进行求解,具体操作是将所述加速度层位置调整方案进一步变换为分段线性投影方程,从而构造相应的数值算法进行求解。

    本发明中的冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置,而后利用该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案,而后利用数值算法对加速度层位置调整方案求解,最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置,该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。

    具体实施方式

    一种冗余度机械臂加速度层运动规划的初始化方法主要由冗余度机械臂调节到其极限位置、加速度层位置调整方案、数值算法求解器、下位机控制器、冗余度机械臂转动到任务执行位置组成。

    首先启动机械臂控制器,将冗余度机械臂调节到其极限位置;再将该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,从而建立基于二次型优化描述的加速度层位置调整方案;然后构造相应的数值算法来求解该加速度层位置调整方案;最后把求解结果用于驱动机械臂使其由极限位置转动到任务执行位置。

    基于最小化机械臂各个关节的当前位置与任务执行位置之间偏移量的思想,n自由度冗余度机械臂的加速度层位置调整方案可设计为:

    最小化: θ ·· T θ ·· / 2 + ( 2 γ θ · + γ 2 ( θ - θ d ) ) T θ ·· - - - ( 1 ) ]]>

    约束条件:θ-≤θ≤θ+,(2)

    θ · - θ · θ · + , - - - ( 3 ) ]]>

    θ ·· - θ ·· θ ·· + , - - - ( 4 ) ]]>

    其中,设计参数γ>0∈R,上标T表示矩阵或向量的转置;θ∈Rn表示关节角度,表示关节速度,表示关节加速度;θd∈Rn为机械臂任务执行初始位置;θ±∈Rn、和表示关节角度极限、关节速度极限和关节加速度极限。

    利用约束转换方法将(2)-(4)转化描述为一个基于关节加速度的双端约束,即,其中η-∈Rn和η+∈Rn的第i个元素分别定义为和i=1,2,…n,关节极限转换参数k1>0∈R和k2>0∈R,关节极限转换裕量用x∈Rn表示机械臂的关节加速度上述的冗余度机械臂加速度层位置调整方案(1)-(4)便可描述为如下的二次型优化问题:

    最小化:xTQx/2+pTx(5)

    约束条件:η-≤x≤η+,(6)

    其中,Q=I∈Rn×n,I为单位矩阵。

    并且,求解上述的二次型优化问题(5)-(6)等价于求解如下的分段线性投影方程:

    PΩ(x-(Qx+p))-x=0∈Rn,(7)

    其中,PΩ(·)表示分段线性投影算子。对于分段线性投影方程(7)和二次型优化问题(5)-(6),可采用如下的数值算法来求解:

    e(xk)=xk-PΩ(xk-(Qxk+p)),

    xk+1=xk-ρ(xk)φ(xk),

    φ(xk)=(QT+I)e(xk),

    ρ ( x k ) = | | e ( x k ) | | 2 2 / | | φ ( x k ) | | 2 2 , ]]>

    其中,迭代次数k=0,1,2,…,||·||2表示向量的二范数。给定初始值x0∈Rn,通过该算法的不断迭代,便可得到分段线性投影方程(7)的解,从而得到二次型优化问题(5)-(6)的最优解,也即加速度层位置调整方案(1)-(4)的最优解。

    通过数值算法得到该二次型优化问题的解后,再将求解结果传递给下位机控制器来驱动机械臂使其由极限位置转动到任务执行位置,从而完成冗余度机械臂加速度层运动规划的初始化工作。

    综上所述,该冗余度机械臂加速度层运动规划的初始化方法通过先将冗余度机械臂调节到其极限位置1,而后利用该极限位置作为起始值,并设定机械臂任务执行位置作为终止值,建立基于二次型优化描述的加速度层位置调整方案2,而后利用数值算法求解器3对加速度层位置调整方案求解,最后通过该求解结果驱动机械臂使其由极限位置转动到任务执行位置,该冗余度机械臂加速度层运动规划的初始化方法具有操作方便、工作量小、作业规范的优点。

    上述仅为本发明的一个具体实施例,但本发明的设计构思并不局限于此,凡利用此构思对本发明进行非实质性的改动,均应属于侵犯本发明?;し段У男形?。

    关 键 词:
    一种 冗余 机械 加速度 运动 规划 初始化 方法
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    关于本文
    本文标题:一种冗余度机械臂加速度层运动规划的初始化方法.pdf
    链接地址://www.4mum.com.cn/p-5886164.html
    关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服客服 - 联系我们

    [email protected] 2017-2018 www.4mum.com.cn网站版权所有
    经营许可证编号:粤ICP备17046363号-1 
     


    收起
    展开
  • 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03