CN107030698A - 机器人的逆运动学求解系统 - Google Patents

机器人的逆运动学求解系统 Download PDF

Info

Publication number
CN107030698A
CN107030698A CN201710320404.2A CN201710320404A CN107030698A CN 107030698 A CN107030698 A CN 107030698A CN 201710320404 A CN201710320404 A CN 201710320404A CN 107030698 A CN107030698 A CN 107030698A
Authority
CN
China
Prior art keywords
value
pose
parameter
joint
angle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201710320404.2A
Other languages
English (en)
Other versions
CN107030698B (zh
Inventor
肖航
韩银和
王颖
连世奇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhongke Times Shenzhen Computer System Co ltd
Original Assignee
Institute of Computing Technology of CAS
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Institute of Computing Technology of CAS filed Critical Institute of Computing Technology of CAS
Priority to CN201710320404.2A priority Critical patent/CN107030698B/zh
Publication of CN107030698A publication Critical patent/CN107030698A/zh
Priority to US16/609,511 priority patent/US11331794B2/en
Priority to PCT/CN2018/076258 priority patent/WO2018205707A1/zh
Application granted granted Critical
Publication of CN107030698B publication Critical patent/CN107030698B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39061—Calculation direct dynamics
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39062—Calculate, jacobian matrix estimator
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39073—Solve inverse kinematics by fuzzy algorithm

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本发明提供一种机器人的逆运动学求解系统，用于基于输入的机器人的目标位姿值和自由度获得与所述目标位姿值对应的关节角度值。该系统包括：参数初始化模块、逆运动学调度器、雅克比计算单元、位姿更新单元、参数选择器。本发明的系统通过硬件实现，可以快速获得用于控制机器人的运动参数，同时降低的功耗。

Description

机器人的逆运动学求解系统
技术领域
本发明涉及计算机技术领域，尤其涉及一种多自由度机器人的逆运动学求解系统。
背景技术
随着传感器、人工智能、物联网以及大数据技术的发展，各种高级的机器人被用于工业生产，或者代替人类作一些重复性高或危险的工作。灵活性、可操作性是度量机器人能力的重要标准，多关节、高自由度使机器人的功能更强大，可以完成更多的任务。逆向运动学在求解高自由度机器人的控制参数中扮演着重要的角色，是机器人领域众多学者的研究方向。然而，由于逆向运动学求解困难、计算速度慢等因素，严重限制了机器人处理问题的实时能力，此外，逆向运动学的计算消耗大量的能量，这对于电池电量有限的移动式机器人而言，续航是一个巨大的挑战。
在现有技术中，机器人的逆运动学求解通常采用CPU和GPU来计算，然而对于高自由度机器人，CPU计算非常耗时，不能满足机器人控制的实时性要求；同时GPU功耗大，且设备便携度低，不能满足移动式机器人的功耗要求。
发明内容
本发明的目的在于克服上述现有技术的缺陷，提供一种并行度高，功耗低，高自由度的机器人逆向运动学加速器。
根据本发明的一个方面，提供了一种机器人的逆运动学求解系统，用于基于输入的机器人的目标位姿值和自由度获得与所述目标位姿值对应的关节角度值，该系统包括：
参数初始化模块，用于获得参数初始值，所述参数初始值包括关节角度初始值、位姿初始值以及所述位姿初始值相对于所述目标位姿值的误差初始值；
逆运动学调度器，用于基于所述目标位姿值执行判断，以决定是将当前的关节角度值选择作为与所述目标位姿值对应的关节角度值还是将当前的关节角度值发送给雅克比计算单元，其中，所述当前的关节角度值是来自于参数初始化模块的关节角度初始值或来自于参数选择器的关节角度值；
雅克比计算单元，用于基于接收的所述关节角度值获得雅克比矩阵及雅克比转置矩阵；
位姿更新单元，用于基于所述雅克比矩阵和雅克比转置矩阵获得多个新的关节角度值；
参数选择器，用于从所述多个新的关节角度值中选择一个并发送给逆运动学调度器。
在本发明的系统中，所述参数初始化模块包括：用于生成关节角度初始值的随机信号发生器；用于获得位姿初始值的三角平方计算器和矩阵乘法器；用于获得误差初始值的加法器和三角平方计算器。
在本发明的系统中，所述逆运动学调度器通过将当前的关节角度值所对应的误差与预定阈值进行比较来决定是将当前的关节角度值选择作为与所述目标位姿值对应的关节角度值还是将当前的关节角度值发送给雅克比计算单元，其中，当前的关节角度值所对应的误差是指当前的关节角度值所对应的位姿值与所述目标位姿值之间的误差。
在本发明的系统中，所述雅克比计算单元包括用于获得雅克比矩阵及雅克比转置矩阵的三角平方计算器和矩阵乘法器。
在本发明的系统中，所述位姿更新单元包括：参数计算器，用于计算前向参数；变量更新模块，用于计算关节角度变量的增量；寄存器，用于保存关节角度变量的增量；位姿计算模块，用于根据关节角度变量的增量计算新的位姿值；误差计算器，用于计算新的位姿值和所述目标位姿值的之间的误差；控制器，用于控制变量更新模块、寄存器、位姿计算模块、误差计算器的执行。
在本发明的系统中，所述参数计算器采用矩阵乘法器来计算所述前向参数。
在本发明的系统中，所述矩阵乘法器是4*4矩阵乘法器。
在本发明的系统中，所述位姿计算模块采用加法器和三角平方计算器来计算新的位姿。
在本发明的系统中，所述参数选择器包括：用于比较多个关节角度值的比较器；用于选择一个关节角度值的数据选择器。
在本发明的系统中，所述位姿更新单元是至少两个，用于执行并行计算。
本发明以多关节、高自由度机器人为研究对象，解决机器人逆运动学的求解问题，以为机器人提供控制其运动的参数。
相对于现有技术，本发明的优点是：以专用的硬件系统求解控制机器人运动的参数，降低了计算功耗；通过高度并行的系统结构，可有效地加速逆运动学求解，从而保证对机器人实时控制；可以计算任意自由度的逆运动学问题，不局限与单一自由度的机器人控制问题，通用性更强，适用范围更广。
附图说明
以下附图仅对本发明作示意性的说明和解释，并不用于限定本发明的范围，其中：
图1示出了多自由度机器人的示意图。
图2示出了根据本发明一个实施例的基于雅克比转置法的逆运动学求解的流程图。
图3示出了根据本发明一个实施例的多自由度的机器人的逆运动学求解系统的框图。
图4示出了根据本发明一个实施例的位姿更新单元的框图。
图5示出了根据本发明一个实施例的三角平方计算器和4*4矩阵乘法器的示意图。
图6示出了根据本发明一个实施例的雅克比矩阵计算示例。
具体实施方式
为了使本发明的目的、技术方案、设计方法及优点更加清楚明了，以下结合附图通过具体实施例对本发明进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。
本发明的系统可应用于多自由度机器人的机械臂控制，如图1所示的机器人的机械臂有8个关节(即8个自由度)，通过控制各个关节的转动能够控制机器人运动。针对机械臂的逆运动学求解问题，是指从机器人的抓手的目标位姿PL(xo,yo,zo)出发，求解出机器人与目标位姿对应的各关节的角度。这种关联关系通常在对机械臂进行运动学分析的基础上，建立机器人的抓手目标位姿和各关节的角度变化之间的关系方程，通过采用雅克比矩阵进行逆运动学求解。对于关系方程的建立和雅克比矩阵求解的详细过程属于现有技术，在此不再赘述。本文将重点描述采用ASIC硬件实现机器人逆运动学求解的系统。
本发明的目的在于当给定机器人的目标位姿PL(xo,yo,zo)时，根据本发明提供的系统获得对应的各个关节的关节角度θ(θ1,θ2,...θ8)(以8自由度为例)，通过将获得的关节角度输入给机器人，可灵活的控制机器人的运动，如图1中的控制系统即可采用本发明的系统。
为了便于理解本发明的硬件实现，图2示出了本发明中基于雅可比转置法的逆运动学求解过程。
步骤一、输入目标位姿PL(xo,yo,zo)，其中，x0,y0,z0表示在三个方向的坐标值；
步骤二、随机生成一组关节角度变量初始值θinit，并且令关节角度变量θ＝θinit，计算初始化位姿Pinit，并且令位姿变量P＝Pinit，计算初始化误差Δeinit(即初始化位姿和目标位姿之间的误差)，并且令误差变量error＝Δeinit；
步骤三、将误差变量error与预定阈值(Threshold)比较，以判断是否满足精度要求，即error＜Threshold；如果满足，则输出关节角度变量θ，否则，继续执行以下步骤；
步骤四、根据关节角度变量θ计算雅克比矩阵J及其雅克比转置矩阵JT；
步骤五、根据J、JT、error并行计算出前向参数α1,α2,...,αk，并求解出对应的关节增量Δθ；
步骤六、根据Δθ、θ计算出新的位姿P1,P2,...,Pk以及与目标位姿PL的误差e1,e2,...,ek；
步骤七、从e1,e2,...,ek中选择出最小的误差以及其对应的关节角度变量θ，并且令误差变量error＝该最小的误差；
步骤八、判断error是否满足精度要求，即error＜Threshold；如果满足，输出关节角度变量θ，否则返回步骤四，继续执行。
图3示出了根据本发明一个实施例的多自由度逆运动学求解系统的框图。该系统包括参数初始化模块、逆运动学调度器、雅克比计算单元、位姿更新单元和参数选择器。该系统的输入是目标位姿PL(xo,yo,zo)和自由度N，其中，自由度N可以是任意值。输出是与目标位姿对应的各关节角度值。
参数初始化模块：用于随机生成初始化参数，例如初始化关节角度变量θinit、计算初始化位姿Pinit和Δeinit等。参数初始化模块可由随机信号发生器实现。
逆运动学调度器：用于协调整个系统中运行任务的调度和控制，例如，判断当前误差和预定的误差阈值的大小，控制迭代次数等。逆运动学调度器可由有限状态机实现，包含比较器、数据选择器等。
雅克比计算单元(JCU)：用于计算关节角度变量对应的雅克比矩阵及其转置矩阵。雅克比计算单元可由三角平方计算器和4*4的矩阵乘法器实现。
位姿更新单元(PUU)：用于计算机器人的机械臂的新的位姿、关节角度变量和以及对应的误差，可采用多个位姿更新单元并行计算，例如，32个。位姿更新单元包含参数计算器和正向运动学计算器。
参数选择器：用于从多个误差中选择最小的一个误差并返回给逆运动学调度器。参数选择器可由比较器或排序器实现。
此外，该系统还提供输入输出接口，各模块中包含有存储器或寄存器，以保存中间的计算结果或保存从其他模块接收的参数，模块之间的参数通过总线传输。
具体而言，本发明的系统执行的操作过程为：从系统外部接收目标位姿PL(xo,yo,zo)以及自由度N(在此实施例中N＝8)；参数初始化模块随机初始化关节角度，计算初始化位姿；雅克比计算单元计算关节角度变量对应的雅克比矩阵及其转置矩阵；逆运动学调度器根据自由度N控制三角平方或雅克比矩阵计算的迭代次数；位姿更新单元并行计算出新的位姿、关节角度变量以及对应的误差；同时逆运动学调度器根据误差error是否小于阈值Threshold来控制位姿更新单元的迭代次数；参数选择器从多个误差中选择最小的一个误差，返回给逆运动学调度器。在此过程中，当逆运动学调度器判断为误差error小于阈值Threshold，则停止迭代并控制输出关节角度θ(θ1,θ2,...θ8)。
为进一步理解本发明，图4示出了图3中的位姿更新单元的框图。该位姿更新单元(PUU)包括：参数计算器，可由乘法器和加法器实现；正向运动学计算器(FKU)。该正向运动学计算器包含控制器、变量更新模块、寄存器、位姿计算模块、误差计算器。
位姿更新单元接收来自于图3中的雅克比计算单元的雅克比矩阵J以及转置JT、误差error、当前位姿P和目标位姿PL，内部并行生成不同的前向参数α1,α2,...,αk并并行计算新的位姿；输出为对应的k组关节角度变量θ1,θ2,...,θk和误差e1,e2,...,ek。参数计算器用于计算正向运动学计算器需要的前向参数α1,α2,...,αk；正向运动学计算器计算新的关节角度变量和位姿。其中，正向运动学计算器的变量更新模块计算关节角度变量的增量Δθ，并保存到寄存器中；位姿计算模块根据增量Δθ计算新的位姿，传递给误差计算器；误差计算器计算新的位姿与目标位姿的误差；控制器用于控制变量更新模块、寄存器、位姿计算模块、误差计算器的执行顺序。正向运动学计算器采用流水线操作，控制器控制变量更新模块计算增量Δθ后保存到寄存器中，同时控制位姿计算模块计算新的位姿以及控制变量更新模块继续接收前向参数αk计算增量，控制器整个流水线起调度作用。
图5示出了根据本发明的一个实施例的雅克比计算单元的框图，其包括三角平方计算器和4*4矩阵乘法器。
图6示出了利用图5的雅克比计算单元计算雅克比矩阵的一个实例。第一步，根据关节角度θ1,θ2,...,θk,...,θn构造n个4*4的矩阵T[n]，使用三角平方计算器计算矩阵元素的三角函数，得到TR[n]；第二步，4*4矩阵乘法器接收矩阵TR[k]与TR[k-1]，进行矩阵相乘操作，得到TRL[n]；第三步，TRL[n]减去TRL[k]，并通过矩阵乘法器与TRL[k]相乘，得到最终的雅克比矩阵J[n]。计算过程并不代表一定同时执行n个三角函数计算或者矩阵乘法，也可以使用流水线技术串行计算雅克比矩阵。
综上所述，根据本发明的多自由度逆运动学求解系统的具体过程为：
步骤一，初始化模块使用随机信号发生器随机生成一组关节角度变量初始值θinit，同时使用三角平方计算器以及4*4矩阵乘法器计算初始化位姿Pinit，利用加法器和三角平方计算器计算初始化误差error，将参数发给逆运动学调度器；
步骤二，逆运动学调度器接收参数error使用比较器判断error是否满足精度要求，即error＜Threshold；如果满足，数据选择器选择输出电路以输出关节角度变量θ，否则数据选择器选择计算电路将关节角度变量θ发给雅克比计算单元，继续执行。
步骤三，雅克比计算单元接收关节角度变量θ，使用三角平方计算器和4*4矩阵乘法器计算雅克比矩阵J及其雅克比转置矩阵JT，逆运动学调度器根据输入的自由度控制雅克比矩阵计算的迭代次数，计算完成后，将获得的雅克比矩阵J及其转置矩阵JT发送到各个并行的位姿更新单元PUU；
步骤四，位姿更新单元根据J，JT，error使用4*4矩阵乘法器计算参数α1,α2,...,αk并传递给内部的正向运动学计算器FKU；
步骤五，正向运动学计算器中的变量更新模块接收error、JT，使用4*4矩阵乘法器计算关节增量Δθ并保存到寄存器中；
步骤六，位姿计算模块接收寄存器中的Δθ，使用加法器和三角平方计算器计算出新的位姿P；
步骤七，误差计算器使用加法器和三角平方计算器计算新的位姿和目标位姿的误差e1,e2,...,ek；整个位姿计算单元输出新的k组关节角度变量θ1,θ2,...,θk和误差e1,e2,...,ek；
步骤八，参数选择器使用比较器从e1,e2,...,ek中选择出最小的偏差error以及使用数据选择器选择对应的关节角度变量θ，并发送给逆运动学调度器；
步骤九，逆运动学调度器使用比较器判断error是否满足精度要求，即error＜Threshold；如果满足，数据选择器选择输出电路输出关节角度变量θ，否则，数据选择器选择计算电路将关节角度变量θ发给雅克比计算单元，重复步骤三，继续执行。
本领域的技术人员应理解的是，本文涉及比较器、判断器、三角平方计算器等可以采用市售的标准器件，4*4矩阵乘法器也可以采用其他维度的矩阵乘法器。
以上已经描述了本发明的各实施例，上述说明是示例性的，并非穷尽性的，并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的情况下，对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。本文中所用术语的选择，旨在最好地解释各实施例的原理、实际应用或对市场中的技术改进，或者使本技术领域的其它普通技术人员能理解本文披露的各实施例。

Claims (10)

1.一种机器人的逆运动学求解系统，用于基于输入的机器人的目标位姿值和自由度获得与所述目标位姿值对应的关节角度值，包括：
参数初始化模块，用于获得参数初始值，所述参数初始值包括关节角度初始值、位姿初始值以及所述位姿初始值相对于所述目标位姿值的误差初始值；
逆运动学调度器，用于基于所述目标位姿值执行判断，以决定是将当前的关节角度值选择作为与所述目标位姿值对应的关节角度值还是将当前的关节角度值发送给雅克比计算单元，其中，所述当前的关节角度值是来自于参数初始化模块的关节角度初始值或来自于参数选择器的关节角度值；
雅克比计算单元，用于基于接收的所述关节角度值获得雅克比矩阵及雅克比转置矩阵；
位姿更新单元，用于基于所述雅克比矩阵和雅克比转置矩阵获得多个新的关节角度值；
参数选择器，用于从所述多个新的关节角度值中选择一个并发送给逆运动学调度器。
2.根据权利要求1所述的系统，其特征在于，所述参数初始化模块包括：
用于生成关节角度初始值的随机信号发生器；
用于获得位姿初始值的三角平方计算器和矩阵乘法器；
用于获得误差初始值的加法器和三角平方计算器。
3.根据权利要求1系统，其特征在于，所述逆运动学调度器通过将当前的关节角度值所对应的误差与预定阈值进行比较来决定是将当前的关节角度值选择作为与所述目标位姿值对应的关节角度值还是将当前的关节角度值发送给雅克比计算单元，其中，当前的关节角度值所对应的误差是指当前的关节角度值所对应的位姿值与所述目标位姿值之间的误差。
4.根据权利要求1所述的系统，其特征在于，所述雅克比计算单元包括用于获得雅克比矩阵及雅克比转置矩阵的三角平方计算器和矩阵乘法器。
5.根据权利要求1所述的系统，其特征在于，所述位姿更新单元包括：
参数计算器，用于计算前向参数；
变量更新模块，用于计算关节角度变量的增量；
寄存器，用于保存关节角度变量的增量；
位姿计算模块，用于根据关节角度变量的增量计算新的位姿值；
误差计算器，用于计算新的位姿值和所述目标位姿值的之间的误差；
控制器，用于控制变量更新模块、寄存器、位姿计算模块、误差计算器的执行。
6.根据权利要求5所述的系统，其特征在于，所述参数计算器采用矩阵乘法器来计算所述前向参数。
7.根据权利要求6所述的系统，其特征在于，所述矩阵乘法器是4*4矩阵乘法器。
8.根据权利要求5所述的系统，其特征在于，所述位姿计算模块采用加法器和三角平方计算器来计算新的位姿。
9.根据权利要求1所述的系统，其特征在于，所述参数选择器包括：
用于比较多个关节角度值的比较器；
用于选择一个关节角度值的数据选择器。
10.根据权利要求1至9中的任一项所述系统，其特征在于，所述位姿更新单元是至少两个，用于执行并行计算。
CN201710320404.2A 2017-05-09 2017-05-09 机器人的逆运动学求解系统 Active CN107030698B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201710320404.2A CN107030698B (zh) 2017-05-09 2017-05-09 机器人的逆运动学求解系统
US16/609,511 US11331794B2 (en) 2017-05-09 2018-02-11 Inverse kinematics solution system for use with robots
PCT/CN2018/076258 WO2018205707A1 (zh) 2017-05-09 2018-02-11 机器人的逆运动学求解系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710320404.2A CN107030698B (zh) 2017-05-09 2017-05-09 机器人的逆运动学求解系统

Publications (2)

Publication Number Publication Date
CN107030698A true CN107030698A (zh) 2017-08-11
CN107030698B CN107030698B (zh) 2018-06-01

Family

ID=59537656

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710320404.2A Active CN107030698B (zh) 2017-05-09 2017-05-09 机器人的逆运动学求解系统

Country Status (3)

Country Link
US (1) US11331794B2 (zh)
CN (1) CN107030698B (zh)
WO (1) WO2018205707A1 (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018205707A1 (zh) * 2017-05-09 2018-11-15 中国科学院计算技术研究所 机器人的逆运动学求解系统
CN110465942A (zh) * 2019-07-26 2019-11-19 深圳前海达闼云端智能科技有限公司 位姿补偿方法、装置、存储介质和电子设备
CN110531866A (zh) * 2019-10-29 2019-12-03 深圳市瑞立视多媒体科技有限公司 基于改进的反向运动学进行姿态解算的方法及相关设备
CN114310877A (zh) * 2021-03-09 2022-04-12 香港科能有限公司 机器人协同系统及其应用和加工精度评价方法

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111168680B (zh) * 2020-01-09 2022-11-15 中山大学 一种基于神经动力学方法的软体机器人控制方法
CN111906762A (zh) * 2020-06-10 2020-11-10 哈尔滨工业大学 一种蛇形机械臂的关节角度确定方法
CN111890364B (zh) * 2020-07-29 2021-11-16 库卡机器人(广东)有限公司 机器人的运动控制方法、装置、电子设备及存储介质
CN114603548A (zh) * 2020-12-08 2022-06-10 山东新松工业软件研究院股份有限公司 一种机器人关节值的确定方法及装置
CN112597437B (zh) * 2020-12-29 2022-09-16 深圳市优必选科技股份有限公司 机械臂的逆运动学解析方法、装置及设备
CN113263498B (zh) * 2021-04-12 2022-06-10 万勋科技(深圳)有限公司 机械臂移动控制方法、装置、终端设备及存储介质
CN113160334B (zh) * 2021-04-28 2023-04-25 北京邮电大学 一种基于手眼相机的双机器人系统标定方法
DE102021111237B3 (de) * 2021-04-30 2022-06-15 Physik Instrumente (PI) GmbH & Co KG Beschleunigung direkter und indirekter Kinematiken
CN113878585A (zh) * 2021-11-03 2022-01-04 上海景吾智能科技有限公司 五自由度机器人运动控制方法及系统
CN114179086B (zh) * 2021-12-17 2023-06-09 中铁工程装备集团隧道设备制造有限公司 一种喷湿台车臂架末端的位姿规划方法
CN114521960B (zh) * 2022-02-25 2023-04-07 苏州康多机器人有限公司 一种腹腔手术机器人的全自动实时标定方法、装置及系统
CN115741672B (zh) * 2022-10-21 2024-04-19 杭州邦杰星医疗科技有限公司 一种基于刚体变换的dh推导方法
CN116304512B (zh) * 2023-03-16 2024-01-30 中国兵器装备集团自动化研究所有限公司 一种机器人腿部的逆运动学求解方法及装置

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04322983A (ja) * 1991-04-24 1992-11-12 Fujitsu Ltd 関節型ロボット
US20060279575A1 (en) * 2005-05-06 2006-12-14 Patrick Pannese Systems and methods for generating 3d simulations
CN102243620A (zh) * 2011-06-02 2011-11-16 安凯 六关节机械臂逆运动学问题的快速求解方法
CN102637158A (zh) * 2012-04-28 2012-08-15 谷菲 一种六自由度串联机器人运动学逆解的求解方法
CN105246655A (zh) * 2013-05-29 2016-01-13 株式会社神户制钢所 多关节连杆机构的逆运动学解法、以及利用了该逆运动学解法的示教数据制作装置

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06314103A (ja) * 1993-04-30 1994-11-08 Fujitsu Ltd 制御装置と能動的センシング装置
JP3602518B2 (ja) * 1995-11-07 2004-12-15 富士通株式会社 リンク機構関節データ演算装置
CN103499922A (zh) * 2013-09-16 2014-01-08 北京邮电大学 一种基于fpga的七自由度空间机械臂运动学实时解算方法
US9747717B2 (en) * 2015-05-13 2017-08-29 Intel Corporation Iterative closest point technique based on a solution of inverse kinematics problem
CN105856231B (zh) * 2016-01-25 2018-04-10 广东工业大学 一种特定构型六轴工业机器人的运动控制方法
CN107030698B (zh) * 2017-05-09 2018-06-01 中国科学院计算技术研究所 机器人的逆运动学求解系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04322983A (ja) * 1991-04-24 1992-11-12 Fujitsu Ltd 関節型ロボット
US20060279575A1 (en) * 2005-05-06 2006-12-14 Patrick Pannese Systems and methods for generating 3d simulations
CN102243620A (zh) * 2011-06-02 2011-11-16 安凯 六关节机械臂逆运动学问题的快速求解方法
CN102637158A (zh) * 2012-04-28 2012-08-15 谷菲 一种六自由度串联机器人运动学逆解的求解方法
CN105246655A (zh) * 2013-05-29 2016-01-13 株式会社神户制钢所 多关节连杆机构的逆运动学解法、以及利用了该逆运动学解法的示教数据制作装置

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018205707A1 (zh) * 2017-05-09 2018-11-15 中国科学院计算技术研究所 机器人的逆运动学求解系统
CN110465942A (zh) * 2019-07-26 2019-11-19 深圳前海达闼云端智能科技有限公司 位姿补偿方法、装置、存储介质和电子设备
CN110531866A (zh) * 2019-10-29 2019-12-03 深圳市瑞立视多媒体科技有限公司 基于改进的反向运动学进行姿态解算的方法及相关设备
WO2021082827A1 (zh) * 2019-10-29 2021-05-06 深圳市瑞立视多媒体科技有限公司 基于改进的反向运动学进行姿态解算的方法及相关设备
CN114310877A (zh) * 2021-03-09 2022-04-12 香港科能有限公司 机器人协同系统及其应用和加工精度评价方法

Also Published As

Publication number Publication date
US11331794B2 (en) 2022-05-17
CN107030698B (zh) 2018-06-01
US20200139541A1 (en) 2020-05-07
WO2018205707A1 (zh) 2018-11-15

Similar Documents

Publication Publication Date Title
CN107030698B (zh) 机器人的逆运动学求解系统
Cho et al. An FPGA-based multiple-axis motion control chip
CN107263467B (zh) 控制机器人转动关节运动的方法和装置及机器人
CN105404744B (zh) 一种空间机械臂全状态动力学半物理仿真系统
Liu et al. Real-time solution of the forward kinematics for a parallel haptic device using a numerical approach based on neural networks
Tsai et al. A strictly convergent real‐time solution for inverse kinematics of robot manipulators
Wang et al. Design and control of integrated pneumatic dexterous robot finger
Bai et al. Improve the robot calibration accuracy using a dynamic online fuzzy error mapping system
Lambersky Model based design and automated code generation from Simulink targeted for TMS570 MCU
Bai et al. Improve the position measurement accuracy using a dynamic on-line fuzzy interpolation technique
CN108638073A (zh) 基于fpga的六轴机械臂点到点定距直线规划实现方法
CN111554355B (zh) 一种基于非冯诺依曼架构的分子动力学计算方法
CN113752300A (zh) 一种工业机器人能耗预测方法
Chen et al. Implementation of 2-axis Circular Interpolation for a FPGA-based 4-axis Motion Controller
Rizvi et al. Comparison of GPGPU based robotic manipulator with other embedded controllers
Kalimullah et al. Analysis of a proposed algorithm for point to point control of a 3 DOF robot manipulator
Zhao et al. Model and simulation of the mitsubishi rv-m1 robot using matlab
Zhang et al. The Parallel Solving Method of Robot Kinematic Equations Based on FPGA
Gao et al. Research on stability of dual-arm cooperative execution task
Wu et al. Research on design and motion control of 5-dof robot for bending
Sánchez et al. A reconfigurable system approach to the direct kinematics of a 5 dof robotic manipulator
Petko et al. Hardware/software co-design of control algorithms
CN108268013B (zh) 一种基于fpga的高速高精插补系统以及直线插补算法
Zhang et al. Circular Interpolation Trajectory Control of Manipulator Based on LabVIEW
Olaru et al. Optimization of the Robot's Position Base Point by Using the Proper Algorithm and Iterative Pseudo Inverse Jacobian Neural Network Matrix Method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20230109

Address after: 518063 14th Floor, West Tower, Baidu International Building, No. 8, Haitian 1st Road, Binhai Community, Yuehai Street, Nanshan District, Shenzhen, Guangdong

Patentee after: Zhongke Times (Shenzhen) Computer System Co.,Ltd.

Address before: 100190 No. 6 South Road, Zhongguancun Academy of Sciences, Beijing, Haidian District

Patentee before: Institute of Computing Technology, Chinese Academy of Sciences