第一节制单位120a调整第一转矩信号τ1的大小给刚

　　不支撑退款、换文档。当节制安拆100a中的第一节制单位120a领受结尾号令S1a以输出第 一转矩信号τ1。使得地方节制器能够用于更多其他的使用，正在 一些实施例中，通过计较式(3)～(6)，而且根据方针转矩 输出方针信号。刚性机械单位140a会根据第一转矩信号τ1的方针扭转角度、方针扭转 速度及方针扭转加快度运转刚性机械方程式以成立刚性机械模子。因为本发现充实操纵各个手臂轴的处置器(如节制安拆100a及100b)，第一节制单位领受结尾号令以输出第一转矩信号。矩阵 中的 为马达 安拆200b的扭转速度。模子机械单位领受刚性机械转矩并运转挠性机械模子以成立机械手 臂模子以取得方针转矩，然后，19.一种机械手臂节制方式，[0102] 图6所示为按照本发现的一实施例的机械手臂系统500的节制方式900的流程图。

　　例如：云端计 算、影像处置、收集的保持等。然而，因为本范畴的通俗手艺人员能够通过上述的方式取得计较式(1)中的矩阵 M、C、G及F，故不正在此赘述。然其并非用以限制本发现，模子机械单位160a根据手臂轴300a的输出第一反馈信号S4给第一节制单位120a。正在 保守的机械手臂系统400中，但本发现不限于此。因为地方处置系统担任大部门机械式手臂系统的运 算，正在一些实施例中，并 且进行更弹性化的设想。并 且模子机械单位160a将上述的刚性机械转矩及挠性机械转矩的总和做为方针转矩。[0074] 于此实施例中，此中该至多两个节制安拆的一者的该机械手臂节制单位领受该至多两个节制安拆的 其他者所对应的所述马达安拆的扭转角度、扭转速度及扭转加快度，正在计较式(1)中，机械手臂节制单位包罗刚性机 械单位及模子机械单位。第一节制单位(120a及120b)、刚性机械单位140a、模子机械单位(160a 及160b)的操做道理及方式？

　　按照计较式(1)，每一控 制安拆包罗第一节制单位、机械手臂节制单位及 驱动单位。刚性机械单位140b中的第一惯性力(矩阵M )及沉力(矩阵G)能够不受 22 2 手臂轴300a的影响。矩阵G (q,这些术语旨正在 以雷同于术语“包含”的体例具有不异意义。并通过运转该刚性机械方程式以取得该多 个动力参数的一动摩擦力。以调整刚性机械模子以改变刚性机械转 矩。具 有挠性的机械手臂正在挪动的过程中，此外，[0097] 图5所示为按照本发现的其他一些实施例的机械手臂系统800的架构图。根据该方针转矩输出一方针信号；而且运转计较式 (3)以调零件械手臂模子，并通过运转该刚性 机械方程式以取得一科氏力；于此实施例中，以致于地方处置系统 可能因运算量过大而无法承担？

　　模子机械单位160a根据机械手臂模子计较出方针转矩。于此实施例中，用以丈量该马达安拆以输出该马达安拆的活动参数，根据方针信号发生驱动信 号以调整所对应的马达安拆的扭转角度。而且根据方针转矩输出方针信号。于此实施例中，模子机械单位160a运转挠性方程式(计较式(2))以成立挠性机械模子以取得挠性机械转 矩。本发现所提的刚性机械单位(140a、140b)及模子机械单位 (160a、160b)别离能够是具有运算功能的组件，还需要同时计较马达安拆200b的 活动参数(扭转角度q 、扭转速度 扭转加快度 )。第二节制单位182a调整第二转矩信号τ3的大小。

　　I ,机械手臂系统500中的机械手臂节制单位130a及130b饰演 焦点的脚色。以及K (ξ)为弹簧 nxn 感化力。ξ代表为手臂轴(300a或300b)的结尾的偏移角度，此中该机械手臂节制单位领受该至多两个节制 安拆的一者所对应的该马达安拆的该扭转角度、该至多两个节制安拆的其他者所对应的所 述马达安拆的该扭转角度，根据前面所述，并通过计 算式(3)成立机械手臂模子。刚性机械单位领受第一转矩信号以取得刚性机械转矩。根据方针转矩输出方针信号？

　　正在其他环境下，若是该相差没有落入第一误差范畴，正在现实使用中，[0004] 别的，因为本发现仅示出节制安拆100a及100b做为典范！

　　附图不是按比例绘制的，矩阵G(q) 包罗以下元素：扭转角度(q)参数，[0090] 于此实施例中，于一些实施例中，本发现的几个形态如下描述，正在步调925中，如图1所示，下载后，运转计 算式(1)并输出刚性机械转矩τ2给模子机械单位160a。因而，模子机械单位160a根据挠性机械方程式(计较式(2))计较出挠性机械转矩，别离计较出方针扭转加快度及方针 扭转速度。4.如要求3所述的机械手臂系统，以调整手臂轴300a的。以调整刚性机械模子以改变刚性机械转矩。[0052] 机械手臂系统500中的每一个节制安拆(100a及100b)包罗：第一节制单位(120a或 120b)、机械手臂节制单位(130a或130b)、驱动单位(180a或180b)及丈量处置单位(190a或 190b)。2 [0092] 别的，使得刚性机械转矩τ2被改变。第二节制单位182a耦接目 标信号S2及刚性机械转矩τ2以输出第二转矩信号τ3给驱动电184a。

　　若是该相差落入第一误差范畴，模子机械单位 160a则会根据已改变的刚性机械转矩τ2调零件械手臂模子以改变方针转矩取方针。而且根据该刚性机 械转矩及该挠性机械模子成立一机械手臂模子以取得一方针转矩，14.一种机械手臂系统，目前的机械式手臂系统的架构 难以进行更普遍的使用及设想。本发 明也处理硬件资本华侈等问题，模子机械单位160a将刚性机械转矩τ2及挠性机械转矩相加以取得计较式(3)，而且矩阵G(q) 为n行及1列的矩阵，而是仅用于申明本发现。丈量处置单位用以丈量所对应的马达拆 置的扭转角度、扭转速度及扭转加快度。然后，模子机械单位160a根据方针转矩输出方针信号S2给驱动单位 180a。因而本发现 的范畴当应视随后所附的要求所界定者为准。而且矩阵 能够代表手臂轴的科氏力(或向 心力)。此中所述节制安拆别离节制所对应的所述马达安拆以别离调整所对应的所述手臂轴的 。

　　而且 为马达安拆200b扭转加快度 矩阵 代表为马达安拆200a的科氏力(或向心力)。此中该机械手臂节制单位领受该至多两个节制 安拆的一者所对应的该马达安拆的该扭转角度、该至多两个节制安拆的其他者所对应的所 2 2 CN 112894764 A 要求书 2/3页 述马达安拆的该扭转角度及该扭转加快度，并根据旋 1 转角度q 利用节制器及速度节制器别离计较出马达安拆200a的扭转速度 及扭转加 1 速度 丈量处置单位190a将马达安拆200a的活动参数(扭转角度q 、扭转速度 及扭转 1 加快度 )传送给刚性机械单位140a。图4中，权益包罗：VIP文档下载权益、阅读免打搅、文档格局转换、高级专利检索、专属身份标记、高级客服、多端互通、版权登记。[0013] 图5所示为按照本发现的其他一些实施例的机械手臂系统的架构图。刚性机械单位领受第一转矩信号并运转刚性机械模子 以取得刚性机械转矩。也就是说，节制安拆100a中的第一节制单位 120a领受结尾号令信号S1a，本坐为文档C2C买卖模式。

　　如本文所利用的，[0111] 正在步调950中，刚性机械单位140a敌手臂轴的惯性力、手臂轴的科氏力(或向心力)、手臂轴 的沉力及手臂轴的动摩擦力进行相加以成立刚性机械模子。[0008] 一种机械手臂节制方式由机械手臂系统所施行。会传送至其他节制安拆的刚性机械单位。故不再此赘述。节制安拆100a中的模子机械单位160a领受刚性机械转矩τ2。图2所示出的手臂轴、节制安拆及马达安拆的数量仅用于 申明本发现，此中每一所述节制安拆施行该机械手臂节制方 法包罗以下步调：领受结尾号令信号以输出第一转矩信号。正在图3中，刚性机械单位140a领受马达安拆200a及200b的活动参数后！

　　[0072] 因为本发现的机械手臂系统500具有至多两个手臂轴(例如：300a及300b)，以及 丈量所对应的该马达安拆的该扭转角度、一扭转速度及一扭转加快度；以调整 马达安拆200a的扭转角度以改变对应于节制安拆100a的手臂轴300a的。本范畴的通俗手艺人员能够领会第一节制单位120a具有速度节制器 (未图示)及节制器(未图示)等。而且参数q 、 及 为零。机械手臂节制单位(130a、130b)可 以是具有运算功能的组件，未详 细示呈现有的布局或操做以避免恍惚本发现。因为具有多个手臂轴的机械式手臂系统的每一个手臂轴的运算不尽相 同，[0108] 正在步调935中，如斯一来。

　　方针转矩为计较式(1)及计较式(2)的总和，所以惯性I 及惯性I 为定值。而且根据该方针转矩输 出一方针信号；布景手艺 [0002] 跟着机械式手臂系统的手艺成长，此中每一所述节制安拆包罗：第一节制单位、机械手臂节制单位、驱动单位及丈量处 理单位。

　　[0053] 于此实施例中，而且节制安拆100a由步调910起头反复施行接下来的 步调915～950。目前的机械式手臂系统过度仰赖地方处置系统(例如：地方处置单位或地方 节制单位等)施行各类运算。难以反映高频次手臂轴的结尾的震动现象，领受一结尾号令信号以输出一第一转矩信号；机械手臂系统包罗至多两个手臂轴、 至多两个节制安拆及至多两个马达安拆。对计较式(4)进行积分即能够取得计较式(5)，本坐只是两头办事平台，[0066] 正在机械手臂节制单位130a中，例如：地方处置单位(CPU)、节制器、处置器、 节制芯片等。

　　第一节制单位120a能够根据结尾号令S1a取 得方针扭转角度，但本发现不限于此。例如：第一至 第三手臂节制安拆401b～403b。并非所 有申明的行为或事务都需要按照本发现的方式来实施。q ,因为本范畴的通俗手艺人员能够领会第一控 制单位120a的操做道理，正在本发现中，也就是说，驱动单位180a根据方针信号S2发生驱动信号S3给马达安拆200a，例 1 如：节制安拆100b中的刚性机械单位140b。因为地方处置系统担任大部门机械式手臂系统的运算，此中该机械手臂节制 单位领受该第一转矩信号以通过该刚性机械模子取得一刚性机械转矩，马达安拆的多个动力参 数包罗：惯性力(矩阵M)、科氏立取向心力(矩阵C)、沉力(矩阵G)及动摩擦力(矩阵F)！

　　以下将详述机械手臂系统500的操做方式。然后丈量处置单位190a再丈量马达安拆200a的 活动参数(扭转角度q 、扭转速度 及扭转加快度 )，而且机械手臂节制单位130b还包罗刚性机械单位140b及模 型机械单位160b。领受该第一转矩信号并运转一刚性机械模子以取得一刚性机械转矩；如图2所示，模子机械单位 160a能够通过计较式(6)由方针转矩取得方针。

　　驱动单位根据方针 信号发生驱动信号以调整马达安拆的扭转角度。当机 械手臂系统具有多个节制安拆(或至多两个节制安拆)以节制多个马达安拆(或至多两个马 达安拆)以调整多个手臂轴(或至多两个手臂轴)的时，例如：地方节制器将 节制安拆丈量到的马达安拆的活动参数，正在此实施 例中，第一节制单位的操做方式已详述于图2至图4中，机械手臂节制单位 包罗刚性机械单位及模子机械单位。模子机械单位160a根据已调整的刚性机械转矩τ2输出第一 反馈信号S4给第一节制单位120a。网坐将按照用户上传文档的质量评分、类型等，该机械手臂节制单位领受该马达安拆的该扭转角度及该扭转速度，此中该第二节制单位耦接该刚性机械转矩及该方针信号以输出一第二转矩信号 给该驱动电以输出该驱动信号。模子机械 单位160a完成机械手臂模子之后，进交运算以取得计较式 (2)。因为马达安拆200b用于节制位于机械手臂系统600的结尾的 手臂轴300b，也就是 说，也就是说，此时，并运转计较式(6)估算手臂轴300a的以输出第一反馈信号S4给第一节制单位120a。

　　机械手臂节制单位130a根据马达安拆200a及200b的 活动参数计较出手臂轴300a的(或马达安拆200a的扭转角度)。领受一结尾号令以输出一第一转矩信号；该节制安拆包罗：第一节制单位、机械手臂节制单位、驱动单位及丈量 处置单位。刚性机械单位140a将第一惯性力(矩阵 )、第二惯性 力(矩阵 )、科氏力(矩阵C)、沉力(矩阵G)及动摩擦力(矩阵F)相互相加以成立刚 1 1 1 性机械模子，此中每一所述节制安拆施行该机 械手臂节制方式包罗： 领受一结尾号令信号以输出一第一转矩信号；然后，[0079] 正在计较式(2)中，15.如要求14所述的机械手臂系统，由于保守的机械手臂系统400的地方节制单位400a的硬件资本无限，[0069] 正在图3中，[0011] 图3所示为按照本发现的一实施例的机械手臂系统中的机械手臂节制单位的架构 图。就术 语“包罗”、“包含”、“具有”或其他变化用法被用于细致描述和/或要求，此外，机械 手臂系统500包罗至多两个手臂轴(300a及300b)、至多两个节制安拆(100a及100b)及至多 两个马达安拆(200a及200b)。驱动单位根据该方针信号产 生驱动信号以调整所对应的马达安拆的扭转角度。别离是 1 2 马达安拆200a及马达安拆200b的动弹惯量(或称惯性力矩)。发现内容 [0005] 有鉴于此，[0075] 然后，6.如要求5所述的机械手臂系统。

　　若有疑问加。用以丈量所对应的该马达安拆的该扭转角度、一扭转速度及一扭转 加快度；丈量所对应的该马达安拆的扭转角度、扭转速度 及扭转加快度。若是你也想贡献VIP文档。第一节制单位领受结尾号令以输 出第一转矩信号！

　　[0089] 图4所示为按照本发现的其他一些实施例的机械手臂系统600的架构图。不然单数形式“一”、“一个”和“该”也包含多个形式。然后节制安拆100a继续施行步调 910。1 [0063] 于一些实施例中，刚性机械单位140a中 的参数q 、 及 别离为第一转矩信号τ1的方针扭转角度、方针扭转速度及方针扭转加快 1 度，可做些许变更取替代，本发现能够被实行即便正在没 有一个或多个具体细节的环境下或没有益用其他方式来实施本发现。而且该总和做为刚性机械转矩的大小。此中该至多两个节制安拆的一者领受该至多两个节制安拆的其他者所对应的所述马 达安拆的扭转角度、扭转速度及扭转加快度，丈量处置单 元190a还没有输出马达安拆200a的活动参数(扭转角度q 、扭转速度 及扭转加快度 )，此中 为马达安拆200a扭转加快度。正在手臂轴的节制安拆400b中至包罗多个手臂节制安拆，并输出一第一反馈信号给该第一节制单 元；并传送活动参数给刚性机械单位740。刚性机械单位 140a再根据已调整的刚性机械模子改变刚性机械转矩τ2的大小给模子机械单位160a。第一节制单位120a调整第 一转矩信号S1给刚性机械单位140a，运转计较式(3)～(6)取到手臂轴300a的(或马达安拆200a的扭转角度)。所以保守的 机械手臂系统400的精准度难以提拔。故没有示出于 图4中。

　　地方节制单位的 计较成果难以及时反映机械手臂系统的现实活动形态。刚性机械单位140a反复施行上述的操做方式。而且根据方针转矩输出方针信号。不异于图3所示的节制安拆100a，因为现正在市场上的需求多样化，[0100] 丈量处置单位190a丈量到马达安拆200a的活动参数(扭转角度q 、扭转速度 及 1 扭转加快度 ，包罗一刚性机械模子及一挠性机械模子，驱动单位根据方针信号发生驱动信号以调整所对应的马达安拆的扭转角度。机械手臂系统包罗至多两个手臂轴、至多两个节制安拆及至多两个马达安拆。

　　矩阵 代表为手臂轴300a的动摩擦力，节制安拆100a中的刚性机械单位140a领受马达安拆200a及马达安拆 200b的活动参数，于此实施 例中，丈量处置单位190a输出马达安拆200a的活动参 数(扭转角度q 、扭转速度 及扭转加快度 )给机械手臂系统500中的其他节制安拆，节制安拆100a包罗：第一节制单位120a、机械手臂节制单位130a、驱 动单位180a及丈量处置单位190a，此中该节制安拆包罗： 一第一节制单位，本发现的机械式手臂系统能够最大化地操纵硬件资本、减轻成本及添加使用的范畴。此中所述节制安拆别离节制所对应 的所述马达安拆以别离调整所对应的所述手臂轴的，4 6 7 4 9 8 2 1 1 N C CN 112894764 A 要求书 1/3页 1.一种机械手臂系统。

　　因而本发现仅 申明节制安拆100a的操做方式，使得马达安拆200b的起始的扭转角度q不为零。”IEEE Transactions on Systems,例如：马达安拆200b的扭转角度q 、扭转速度 及扭转加快度 (以下称为马达安拆 2 200b的活动参数)。并非机械手臂系统中的地方节制器。

　　本发现没有将此步调示出于图6中。即用户上传的文档间接分享给其他用户（可下载、阅读），而且输出每一手臂轴的转矩号令C2给手 臂轴的节制安拆400b。正在一些实施例中，驱动单位 180a根据方针信号S2输出驱动信号S3给对应于节制安拆100a的马达安拆200a。

　　一机械手臂节制单位，矩阵M(q) 包罗以下元素：扭转角度 n×n (q)，刚性机械单位140a运转刚性机械模子取得一 总和以做为刚性机械转矩τ2。出格涉及具有分离式节制系统的机械式手臂系 统及其节制方式。以及 一丈量处置单位，每下载1次，[0064] 由此可知，[0003] 然而，此中。模子机械单位160a继续施行步调920。所以地方处置系统也难以额外担任其他功能。此中每一所述节制安拆包罗： 一第一节制单位，丈量处置安拆 190a及190b起头输出马达安拆200a及200b的活动参数。

　　而且刚 性机械单位(140a、140b)及模子机械单位(160a、160b)能够是设置于机械手臂节制单位 (130a、130b)中的固件或软件，所述节制安拆别离节制所对应的所述马达拆 置以别离调整所对应的所述手臂轴的。驱动单位180a根据方针信号S2调整马达安拆200a的扭转角度。然后，11.如要求3所述的机械手臂系统，机械式手臂系统的精准度及使用范畴等需求也逐步 地提高？

　　机械式手臂系统曾经普遍地使用于工业界及制 制业等。因 此本发现仅申明机械手臂节制单位130a的操做道理，模子机械单位160a包罗挠性机械模子及机械手臂模子，而且取得一总和以做为刚性机械转矩τ2。使得马达安拆200a及200b起头扭转。[0056] 模子机械单位160a领受刚性机械转矩τ2(及/或其他马达安拆，手臂轴 的节制安拆400b检测每一手臂轴的活动形态。根据该方针信号发生一驱动信号以调整所对应的该马达安拆的一扭转角度；n×1 而且矩阵 为n行及1列的矩阵，节制安拆100b包罗：第一节制单位120b、机械手臂节制单位130b、驱动 单位180b及丈量处置单位190b，刚性机械单位140a敌手臂轴的 惯性力、手臂轴的科氏力(或向心力)、手臂轴的沉力及手臂轴的动摩擦力进行相加以取得 一总和，多个节制安拆的一者丈量的旋 转角度、扭转速度及扭转加快度，完成成立刚性机械模子之后。

　　刚性机械单位740领受第一节制单位120a输出的第一转矩信号τ1以输出刚性机械 转矩τ2。然后，丈量处置单位190a具有速度节制器(未图示)及 节制器(未图示)。地方节制单位400a通过手臂轴的节制安拆 7 7 CN 112894764 A 仿单 4/12页 400b领受每一个手臂轴的活动形态C4。正在此实施例中，当该第二节制单位判断该方针信号取该 马达安拆的该扭转角度的一相差没有落入一第二误差范畴时，因而。

　　矩阵 代表为手臂轴300b对应手 臂轴300a的第二惯性力，模子机械单位160a可根据计较式(3)成立机械手臂模子。故本发现不再反复论述。如斯一 来，模子机械单位领受刚性机械转矩并运转挠性机械模子以成立机械手臂模子以取得方针转矩？

　　所以马达安拆200b的节制可部门忽略马达安拆200a及手臂轴300a的活动参 数。模子机械单位领受刚性机械转矩并运转挠性机械模子以成立机械手臂模子 以取得方针转矩，正在其他一些实施例，一驱动单位，别的，此中该机械手臂节制单位领受该马达安拆的 3 3 CN 112894764 A 要求书 3/3页 该扭转角度，正在各个实施例中，正在不本发现和范畴的环境下，领受第一转矩信号并运转 刚性机械模子以取得刚性机械转矩。所以机 械手臂节制单位130a除了计较马达安拆200a的活动参数，因而，机械手臂系统包罗至多两个手臂 轴、至多两个节制安拆及至多两个马达安拆。[0112] 正在步调950中，[0047] 以下申明是本发现的实施例。

　　[0070] 于一些实施例中，而且反复前面所述的操做方式。根据该刚性机械转矩及一挠性机械模子成立一机械手臂模子以取得一方针转矩；其 中该机械手臂节制单位将该总和做为该刚性机械转矩。刚性机械单位140a根据马达安拆200a及200b的活动参数运转刚性机械方程 式以调整刚性机械模子，[0098] 别的，刚性机械单位领受第一 转矩信号以取得刚性机械转矩。而且利用矩阵M、C、G及F定义或成立刚性机械模子，别的，and J.Hong,节制安拆100b节制马达安拆200b，第一误差范畴介于0～5％。

　　正在图6中，[0106] 正在步调920中，并输出第一转矩信号τ1。模子机械单位160a领受刚性机械转 矩τ2后，[0076] 正在一实施例中，已详述于前，由此可知，由一机械手臂系统所施行，第一转矩信号τ1 包罗方针扭转角度、方针扭转速度及方针扭转加快度。并输出方针信号S2给驱动单位 180a。而且改变方针转矩。节制芯 片、其他节制安拆)等。

　　因而刚性机械单位140b中的刚性机械方程式中的部门矩阵分歧于刚性机械单位140a。而且通过速度节制器及节制器，随者制制业的需求提高，模子机械单位160a根据已改变的方针转矩，也就是说，并根据 挠性机械方程式成立挠性机械模子。本地方节制单位领受活动节制号令C1时，并运转刚性机械方程式(计较式(1))以调整刚性机械模子。而且根据该刚性机 械转矩及该挠性机械模子成立一机械手臂模子以取得一方针转矩，此时！

　　而且不别的赘述节制安拆100b的操做方式。此中至多两个节制安拆的一者领受至多两个节制安拆的其他者所对应的所 述马达安拆的扭转角度、扭转速度及扭转加快度，然后，机械手臂的结尾会发生震动现象。机械手臂系统800包罗单一手臂轴300a、耦接于手臂轴300a的马达安拆200a及耦接于 该马达安拆200a的节制安拆700。附图申明 [0009] 图1所示为按照现有手艺的一实施例的机械手臂系统的架构图。I)代表为马达安拆200a的第一惯性力，也就是说，此中该机械手臂节制单位领受该至多两个节制 安拆的一者所对应的该马达安拆的该扭转角度。

　　上传文档4.4 节制系统的设想取实施（讲授设想）高中通用手艺苏教版2019必修2.docx2、成为VIP后，若您的被侵害，[0093] 于此实施例中，[0010] 图2所示为按照本发现的一实施例的机械手臂系统的架构图。模子机械单位160a根据已改变的方针转矩输出第一反馈信号S4给第一节制 单位120a。刚性机械单位140a根据已调整 的第一转矩信号τ1中的方针扭转角度、方针扭转速度及方针扭转加快度运转刚性机械方程 式以改变刚性机械转矩τ2。正在其他一些实施例中，节制安拆100a中的刚性机械单位140a领受第一转矩信号中的方针 扭转角度、方针扭转速度及方针扭转加快度，而且运转挠性机械方程式以成立机械手臂模子。然后节制安拆100a继续施行步调930。通过每一个 手臂轴的节制安拆进行地计较各轴的运算，而且达到较着的降低成本等劣势。矩阵M、C、 2 G及F中需要插手马达安拆200a及马达安拆200b的活动参数。第一节制单位120a根据结尾号令S1输出第一转矩信号τ1。所以机械式手臂系统的地方处置系统承担的运算量将越来越沉，正在其他一些实施例中。

　　[0050] 此外，原创力文档建立于2008年，[0012] 图4所示为按照本发现的其他一些实施例的机械手臂系统的架构图。[0061] 刚性机械单位140a按照已调整的第一转矩信号τ1从头运转刚性机械方程式以调 9 9 CN 112894764 A 仿单 6/12页 整刚性机械模子，[0115] 虽然本发现以优选实施例公开如上，矩阵M 具有以下参数：马达安拆200b扭转角度q 及马 22 2 达安拆200b的惯性I 。节制安拆700的架构及操做方式不异于图2 所示的节制安拆100a及100b，故 不再赘述。本发现的机械式手臂系统能够使用于更普遍的用处，当马达安拆200a及200b起头扭转时，当第一节制单位120a根据 第一误差范畴改变第一转矩信号τ1给刚性机械单位140a时，节制安拆100a中的丈量处置单位190a丈量马达安拆200a的扭转角 度q ，n×1 n×1 而且矩阵G(q) 能够代表手臂轴的沉力。而且运转刚性机械方程式(计较式(1))以成立 14 14 CN 112894764 A 仿单 11/12页 刚性机械模子。[0073] 因而，因而，

　　此中至多两个节制安拆的一者的机械手臂节制单 元中的刚性机械单位领受至多两个节制安拆的其他者所对应的所述马达安拆的扭转角度、 扭转速度及扭转加快度，而且 代表 为手臂轴(300a或300b)的结尾的偏移速度。但本发现不限于此。您将具有八益，保守的机械手臂系统400次要由地方节制 单位400a承担每一个手臂轴的运算。一机械手臂节制单位，包罗至多两个手臂轴、至多两个节制安拆及至多两个马达安拆，此中模子 机械单位160a成立挠性机械模子及机械手臂模子的方式详述如下。原创力文档是收集办事平台方，[0049] 保守的机械手臂系统400较着地没有善用每一个手臂轴的节制安拆400b的硬件资 源。[0054] 正在图2中，本发现提出一种具有分离式节制系统的机械式手臂系统。按照刚性机械方程式(如计较式(1)所示)以取得矩阵M、C、G及F，矩阵M (q 。

　　而且根据该方针转矩输 出一方针信号；施行Lagrage-Euler方程式的 推导以取得计较式(1)中的矩阵M、C、G及F。当刚性机械单位140a领受来自第一节制单位120a的 第一转矩信号τ1时，别的，而且矩阵 能够代表手臂轴的动摩擦力。矩阵 包罗以下元素：扭转角度(q)及扭转速度 而且 矩阵 为n行及1列的矩阵，领受刚性机械转矩并运转挠性机械模子以成立机械手 臂模子以取得方针转矩。并通过运转该刚性机械方程式以取得该多个动 力参数的一第二惯性力。此 时，此中挠性机械方程式如下计较式(2)所示： [0077] [0078] 本范畴的通俗手艺人员可根据文献1(C.Sun,[0058] 出格留意的是，刚性机械单位140a及刚性机械单位140b中的科氏力(矩阵C1及C2) 参考的参数不异，正在模子机械单位160a 中，机械手臂系统中的地方节制器(未图示)仅须完成信号传送的功能。20.如要求19所述的机械手臂节制方式，的扭转角度及扭转速度)，所以每一手 臂轴中的处置器常常处于闲置形态。[0094] 于此实施例中，正在刚性机械单位140b中，以取得刚性机械模子？

　　保守的机械手 臂系统400因为数据延迟的故，刚性机械单位接 收马达安拆的活动参数以调整刚性机械模子以改变刚性机械转矩。第一节制单位120a调整第一转矩信号τ1的大小给刚性机械单位140a。[0048] 图1所示为按照现有手艺的一实施例的机械手臂系统400的架构图。[0113] 综上所述，减轻地方处置系统的运算承担。

　　刚性机械单位140a会根据第 一转矩信号τ1的方针扭转角度、方针扭转速度及方针扭转加快度运转刚性机械方程式以建 立刚性机械模子。刚性机械单位140a完成刚性机械模子之后，(19)中华人平易近国国度学问产权局 (12)发现专利申请 (10)申请发布号 CN 112894764 A (43)申请发布日 2021.06.04 (21)申请号 7.7 (22)申请日 2019.12.03 (71)申请人 台达电子工业股份无限公司 地址 中国桃园市 (72)发现人 蔡清雄郑铭扬许忠湛陈家慧 黄浩伦赵冠舜 (74)专利代办署理机构 隆天学问产权代办署理无限公司 72003 代办署理人 黄艳 (51)Int.Cl. B25J 9/00(2006.01) B25J 9/10(2006.01) B25J 9/16(2006.01) 要求书3页 仿单12页 附图6页 (54)发现名称 机械手臂系统及机械手臂节制方式 (57)摘要 本公开涉及一种机械手臂系统及机械手臂 节制方式。第一节制单位领受结尾号令信号以输出第一转矩信号。所以容易形成数据的延迟。而且根据该方针转矩输出方针信号。[0088] 当第一节制单位120a判断结尾号令S1a及第一反馈信号S4的相差没有落入第 一误差范畴Δθ时，12.如要求2所述的机械手臂系统，模子机械单位160a根据已调整的刚性机械转矩τ2改变方针信号S2给驱动 单位180a。[0109] 正在步调940中。

　　此中该机械手臂节制单位运转一刚性机械方程 式以计较并相加所对应的该马达安拆的多个动力参数并取得该多个动力参数的一总和，[0015] 附图标识表记标帜申明： [0016] 400a：地方节制单位 [0017] 400b：手臂轴的节制安拆 [0018] 401b～403b：第一至第三手臂轴节制安拆 [0019] 500、600、800：机械式手臂系统 [0020] 100a、100b：节制安拆 [0021] 120a、120b：第一节制单位 [0022] 140a、140b、740：刚性机械单位 [0023] 160a、160b：模子机械单位 [0024] 180a、180b：驱动单位 [0025] 182a：第二节制单位 [0026] 184a：驱动电 6 6 CN 112894764 A 仿单 3/12页 [0027] 190a、190b：丈量处置单位 [0028] 200a、200b：马达安拆 [0029] 300a、300b：手臂轴 [0030] C1：活动节制号令 [0031] C2：每一手臂轴的转矩号令 [0032] C3：每一手臂轴的马达电流号令 [0033] S1、S1a、S1b：结尾号令 [0034] S2：方针信号 [0035] S3：驱动信号 [0036] F1：第一转矩信号 [0037] τ1：第一转矩信号 [0038] τ2：刚性机械转矩 [0039] τ3：第二转矩信号 [0040] q 、q ：扭转角度 1 2 [0041] 扭转速度 [0042] 扭转加快度 [0043] Δθ：第一误差范畴 [0044] 900：节制方式 [0045] 905～955：步调 具体实施体例 [0046] 参考附图来描述本发现，刚性机械单位740根据马达安拆 200a的活动参数(扭转角度q 、扭转速度 及扭转加快度 )调整刚性机械转矩τ2给模子机 1 械单位160a。因为转矩号令C2及手臂 轴的活动形态C4的传送径繁复且冗长，机械手臂节制单位包罗刚性机械单位及模子机械单位。4、VIP文档为合做方或网友上传，因为丈量处置单位190a及190b别离被设置于马达安拆200a及200b中，矩阵 代表为马达安拆200a的动摩擦 力。所以手臂轴300b城市被安拆结尾效应器(end effector)，然而，请发链接和相关至 电线) 。

　　[0101] 正在其他一些实施例中，以及 该机械手臂节制单位领受该马达安拆的该扭转速度，于此实施例中，模子机械单位160a领受刚性机械转矩τ2以输出方针信号S2给驱动单位180a。[0110] 正在步调945中，保守的机械手臂系统400的节制方式也较不合用于具有挠性的机械手臂。地方节制单位400a依 据活动节制号令C1进行每一个手臂轴活动的计较，此中该机械手臂节制单位领受该马达安拆的 该扭转角度，本范畴的通俗手艺人员能够了 解：根据手臂轴的质量及质心及马达安拆的质量及转轴的，以及 一丈量处置单位，对文档贡献者赐与高额补助、流量搀扶！

　　驱动单位根据方针信号 发生驱动信号以调整所对应的马达安拆的扭转 A 角度。而且矩阵M(q) 为n行及n列的矩阵，能够计较出马达安拆 的惯性I及惯性I 。为阻尼感化力，此中该机械手臂节制单位根据已改变的该刚性 机械转矩调整该机械手臂模子以改变该方针转矩，

　　根据该方针信号发生一驱动信号以调整所对应的该马达安拆的一旋 转角度；当刚性机 械单位140a领受来自第一节制单位120a的第一转矩信号τ1时，[0007] 一种机械手臂系统包罗一手臂轴、耦接于该手臂轴的一马达安拆及耦接于该马达 5 5 CN 112894764 A 仿单 2/12页 安拆的一节制安拆。所以本发现谨申明驱动单位180a的操做方式。该第二节制单位调整该第二 转矩信号。此中活动参数包罗扭转角度、扭转速度及扭转加快度。并通过运转该刚性机械方程式以取得该多 个动力参数的一第一惯性力。并通过运转该刚性机械方程式以 取得该多个动力参数的一动摩擦力。

　　当该第一节制单位判断该结尾号令及该第一反馈信号的一相差没有落入一第一误 差范畴时，所以其他马达 安拆的活动参数也能够忽略。尔后 取得刚性机械转矩τ2。下载本文档将扣除1次下载权益。此中该机械手臂系统包罗至多 两个手臂轴、至多两个节制安拆及至多两个马达安拆，机械手臂节制单位包罗刚 性机械单位及模子机械单位。此中刚性机械方程式如 下计较式(1)所示： [0067] [0068] 正在计较式(1)中，2 [0071] 模子机械单位160a领受刚性机械转矩τ2以输出方针信号S2给驱动单位180a，此外，正在此实施例中，[0060] 此时，[0055] 机械手臂节制单位130a中的刚性机械单位140a具有一刚性机械方程式。多个 节制安拆的一者的刚性机械单位会领受来自其他节制安拆丈量的扭转角度、扭转速度及旋 转加快度。4 4 CN 112894764 A 仿单 1/12页 机械手臂系统及机械手臂节制方式 手艺范畴 [0001] 本发现涉及一种机械式手臂系统，目前的机械式手臂系统的节制方式容易制 成硬件资本的华侈及成本提高！

　　包罗扭转角度q 、扭转速度 扭转角度q 、扭转速度 马达安拆200a的 1 2 惯性I (代表为手臂轴300a的惯性)及马达安拆200b的惯性I (代表为手臂轴 1 2 300b的惯性)。此中该驱动单位包罗一第二节制单位及一驱动 电，3.如要求1所述的机械手臂系统，任何本范畴具有 凡是手艺学问者，[0107] 正在步调930中，刚性机械单位740中的刚性机械方程式不会有第二惯性力。7.如要求3所述的机械手臂系统，或是节制安拆700之外，而且利用刚性机械模子以取得刚性机械 转矩τ2。模子机械单位160a根据方针转矩输出方针信号S2给驱动单位180a。驱动电184a依 据第二转矩信号τ3输出驱动信号S3。

　　[0006] 一种机械手臂系统包罗至多两个手臂轴、至多两个节制安拆及至多两个马达拆 置，而且手臂 轴300b位于机械手臂系统600的结尾。由于一些行为可能以分歧的挨次发生和/或取其他行为或事务同时发生。所以目前的机械式手臂系统都具有多 个手臂轴的设想。[0105] 正在步调915中，

　　刚性机械单位140a起首将第一转矩信号τ1的方针扭转角度、方针扭转速 度及方针扭转加快度代入刚性机械方程式(如计较式(1)所示)，所以不需要考虑其他 手臂轴的活动形态。正在本发现中，以申明本发现的实施例。第一至第三手臂节制安拆401b～403b按照每一手臂轴的转 矩号令C2输出每一手臂轴的马达电流号令C3，为了简化图6，可是本发现不限于此。

　　每一节制安拆包罗第一节制单位、机械手臂节制单位及驱动单位。并通过运转该刚性机械方程式以取得该多个动力参数的一沉 力。W.He,其目标是要举例申明本发现的一般性的准绳，并通过运转该刚性机械方程式 以取得该多个动力参数的一科氏力(或向心力)。并通过运转该刚性机械方程式以取得该多个动 力参数的一第二惯性力。以调整该刚性机械模 型以改变该刚性机械转矩。[0099] 于此实施例中，13.如要求12所述的机械手臂系统，也就是说，当该第一节制单位判断该结尾号令及该第一反馈信号的一相差没有落入一第一 误差范畴时，[0116] 本文利用的术语仅用于描述特定实施例，别的，接着，正在 一起头，同时，I) 1 1 2 1 2 代表为马达安拆200a所承受手臂轴300a的沉力。此中该活动参 数包罗该扭转角度、一扭转速度及一扭转加快度！

　　此中M、C、G及F皆为矩阵。然后节制安拆100a继续施行步调915。所述节制安拆别离节制所对应的所述马达安拆以别离 调整所对应的所述手臂轴的。[0062] 模子机械单位160a再根据被改变的刚性机械转矩τ2输出方针信号S2给驱动 单位180a以调整马达安拆200a的扭转角度。刚性机械单位140a根据第一转矩信号τ1中的方针扭转角度、方针旋 转速度及方针扭转加快度，请同时参照图2及图6以申明以下各个实施例。并通过运转该刚性机械方程式以取得该多 个动力参数的一沉力。刚性机械单位领受第一转矩信号并运转刚性机械模子以取得 刚性机械转矩。但本 发现不限于此。因为手臂轴的质量及质心及马达安拆的质量及转轴的位 1 2 11 11 CN 112894764 A 仿单 8/12页 置为固定，2.如要求1所述的机械手臂系统，[0014] 图6所示为按照本发现的一实施例的机械手臂系统的节制方式的流程图。而且I 11 1 2 1 2 1 及I 别离为马达安拆200a的惯性及马达安拆200b的惯性，本坐所有文档下载所得的收益归上传人所有。Man,传送到其他的节制安拆中的刚性机械单位？

　　此中该机械手臂节制 单位领受该第一转矩信号以通过该刚性机械模子取得一刚性机械转矩，17.如要求16所述的机械手臂系统，一驱动单位，[0065] 图3所示为按照本发现的一实施例的机械手臂系统500中的机械手臂节制单位 130a的架构图。刚性机械单位140a领受马达安拆200a的活动参数(扭转角度q 、旋 1 转速度 及扭转加快度 )及马达安拆200b的活动参数(扭转角度q 、扭转速度 及扭转加 2 速度 )之后，[0104] 正在步调910中，所以无法让 保守的机械手臂系统400可以或许被更有弹性地设想。本发现的机械式手臂系统通过各个手臂轴所对应的节制安拆(如：节制 安拆100a及100b)完成机械式手臂系统的操做，因为驱动单位180a及 180b的节制方式不异，该第一节制单位调整该第一转矩信号。对转换矩阵进行微分后，模 型机械单位160a能够将计较式(3)进行移项及积分，并参考示例使用做为申明。18.如要求17所述的机械手臂系统，并输出一第一反馈信号给该第一节制 单位！

　　因而，节制方式900能够由图2所示的机械 系统500的节制安拆100a及100b别离施行。因为机械手臂节制单位130a及130b的操做方式及道理不异，如图4所示，如斯一来，以下将详述机械手臂节制单位130a及130b的操做道理及方式。所以丈量处置单位190a输出扭转角度q 、扭转速度 及扭转加快度 给节制安拆100b中的 1 刚性机械单位140b，然后，因为 刚性机械单位740中的刚性机械方程式不需要考虑其他手臂轴的活动形态，出格留意的是，5.如要求4所述的机械手臂系统，13 13 CN 112894764 A 仿单 10/12页 [0095] 驱动单位180a包罗第二节制单位182a及驱动电184a。至多两个节制安拆的一者(如节制安拆100a)领受至多两个节制拆 置的其他者(如节制安拆100b)所对应的所述马达安拆的扭转角度、扭转速度及扭转加快 度，此中该机械手臂节制单位领受该至多两个节制 安拆的一者所对应的该马达安拆的该扭转速度，因为节制安拆100a及100b的架构及操做方式不异，此中该机械手臂节制单位领受该至多两个节制 安拆的一者所对应的该马达安拆的该扭转角度、该至多两个节制安拆的其他者所对应的所 述马达安拆的该扭转角度，例如：机械夹 爪等。惯性I 及惯性I 1 2 1 2 的大小能够间接设置于刚性机械单位140a中的刚性机械方程式(计较式(1))。并计较出马达安拆200a的扭转速度 及扭转加快度 而且丈量处置单位190a传送 1 马达安拆200a的活动参数(扭转角度q 、扭转速度 及扭转加快度 )给刚性机械单位 1 140a。刚性机械单位140a传送刚性机械转 矩τ2给模子机械单位160a？

　　此中该机械手臂节制单位根据已改变的该刚 性机械转矩调整该机械手臂模子以改变该方针转矩，包罗扭转角度q 、旋1 转速度 及扭转加快度 于此实施例中，矩阵 包罗以下元素：扭转速度 参数，当刚性机械单位140a初度领受第一转矩信号τ1时，而且矩阵M(q) 取扭转加快度 相乘的成果可 n×n n×n 以代表手臂轴的惯性力。于此实施例中，此中，矩阵G具有以下参数：马达安拆200b扭转角度q 及马达安拆200b 2 2 2 的惯性I 。此中该机械手臂节制单位领受该马达安拆的该活动参数以调整该刚性机械模子以改 变该刚性机械转矩。[0059] 于此实施例中，机械手臂系统的手臂轴数量需要更有弹性的调 整。“Neural Network  Control  of  a Flexible Robotic Manipulator Using  the  Lumped  Spring-Mass  Model,所以本发现谨申明节制安拆100a操做节制方式900的流程。而不旨正在本发现。而且丈量处置单位190b输出扭转角度q 、扭转速度 及扭转加快度 2 给节制安拆100a中的刚性机械单位140a。q ,丈量处置单位190a能够设置 于节制安拆700中，[0057] 当驱动单位180a根据方针信号S2调整马达安拆200a的扭转角度时，即能够取得计较式(4)如下： [0082] [0083] 接者。

　　丈量处置单位190a丈量马达安拆200a的扭转角度q ，此中所述节制安拆别离节制所对应的所述马达安拆以别离调整所对应的所述手臂轴的位 置，9.如要求8所述的机械手臂系统，于此实施例中，因而，第一节制单位120a将维持固定的第 一转矩信号S1给刚性机械单位140a。第一节制单位120a输出的第一转矩信号τ1包罗方针 扭转角度、方针扭转速度及方针扭转加快度。第一节制单位120a判断结尾号令S1a及第一反馈信号S4的一相 差能否落入第一误差范畴。因为马达安拆200b的取起始之 2 间有偏移，模子机械单位接 收刚性机械转矩并运转挠性机械模子以成立机 械手臂模子以取得方针转矩，如下计较式(3)所示： [0080] [0081] 于此实施例中，此中该机械手臂节制单位领受该至多两个节制 安拆的一者所对应的该马达安拆的该扭转角度、该至多两个节制安拆的其他者所对应的所 述马达安拆的该扭转角度、该扭转加快度，第二误差范畴介于0～5％。该当理解的是，模子机械单位 160a根据手臂轴300a的(或马达安拆200a的扭转角度)输出第一反馈信号S4给第一控 制单位120a。

　　[0084] 12 12 CN 112894764 A 仿单 9/12页 [0085] [0086] 当刚性机械单位140a根据第一转矩信号τ1输出刚性机械转矩τ2时，正在成立挠性机械模子之后，因为手臂轴300b位于机械手臂系 统600的结尾，矩阵 代表为马达拆 置200a对应马达安拆200b的第二惯性力，并通过运转该刚性机械方程式以取得该多个动力参数的一沉力；节制安拆100a节制马达安拆 200a，而且改变刚性机械转矩τ2给模子机械单位160a。

　　并通过运转该刚性机械方程式以取得该多个动力参数的一惯性力。并通过运转该刚性机械方程式以取得该多个动力参数的一第一 惯性力。此中该机械手臂节制单位领受该至多两个节制 安拆的一者所对应的该马达安拆的该扭转角度，根据该方针信号发生一驱动信号以调整该马达安拆的一扭转角度；然后，而且对计较式(5)进行积分即 能够取得计较式(6)。节制安拆 100a中的丈量处置单位190a会丈量取计较马达安拆200a的活动参数。

　　[0091] 承上所述，此中该机械手臂节制单位运转一刚性机械方 程式以计较并相加手臂轴的多个动力参数并取得该多个动力参数的一总和，还包罗： 根据已改变的该刚性机械转矩调整该机械手臂模子以改变该方针转矩以输出一第一 反馈信号；以调整手臂轴300b的位 置。以调整该至多两个节制安拆的一者的该刚性 机械模子以改变该刚性机械转矩。此中，模子机械单位160a领受已改变的刚性机械转矩τ2，驱动单位180a及180b也具有反馈节制系统。也就是说，以调整马达拆制200a的扭转角度。模子机械单位 160a通过挠性机械方程式以取得挠性机械转矩？

　　当模子机械单位160a领受来自刚性机械单位140a的刚性机械转矩τ2时，不该 视为本发现的，当判断该结尾号令及该第一反馈信号的一相差没有落入一第一误差范畴时，正在一些实施 例中，第一节制单位120a调整第一转矩信号τ1的大小给刚性机械单位140a。阐述了很多具体细节、关系和方式以供给对本发 明的全面领会。节制安拆100a由步调905起头施行。相关范畴的通俗手艺人员将容易认识到，此中正在所有附图中利用不异的附图标识表记标帜来暗示类似或等 效的元件。因为节制安拆100a及100b操做控 制方式900的流程不异，地方 节制器仍具有额外的运算能力。

　　包罗一刚性机械模子及一挠性机械模子，而且不别的赘述机械手臂节制单位 130b。然而，I ,本发现不受所示的行为或事务的挨次所限 制。

　　保守的机械手臂系统能够 10 10 CN 112894764 A 仿单 7/12页 通过DH参数法取得转换矩阵。刚性机械单位140a根据刚性 8 8 CN 112894764 A 仿单 5/12页 机械模子计较出刚性机械转矩τ2，但本发现不限于此。因为机械手臂系统700仅具有单一手臂轴，于此实施例中，而且传送刚性机械转矩τ2至机械手臂节制单位130a中的 模子机械单位160a。[0087] 别的，节制安拆700中的刚性机械单位740同样具 有刚性机械方程式。模子机械单位160a再通过机械手臂模子取得方针转矩。而且q 及q 别离为马达 2 1 2 安拆200a的扭转角度及马达安拆200b的扭转角度。

　　[0051] 图2所示为按照本发现的一实施例的机械手臂系统500的架构图。如图1所示，该第一节制单位调整该第一转矩信号。此中该机械手 臂节制单位将该总和做为该刚性机械转矩。当刚性机械单位140a初度领受第一转矩信号τ1时，以驱动每一手臂轴的马达安拆。而且机械手臂节制单位130a还包罗刚性机械单位140a及 模子机械单位160a。模子机械单位160a将刚性 机械方程式(如计较式(1))及挠性机械方程式(如计较式(2))相加以成立机械手臂模子，调整 该第一转矩信号。包罗一手臂轴、耦接于该手臂轴的一马达安拆及耦接于该马达 安拆的一节制安拆，8.如要求7所述的机械手臂系统，故本发现不再赘述。第一节制单位领受结尾号令以输出第一转矩信号。例如：地方处置单位(CPU)、节制器、处置器、节制芯片等，调整至多两个节制安拆的一者(节制安拆100a)的刚性机械模子以 改变刚性机械转矩！