CN112689552A - 主动阻尼系统 - Google Patents

Abstract

本公开提供了一种用于在物理环境内执行交互的系统，该系统包括：(a)机器人底座；(b)相对于环境移动机器人底座的机器人底座致动器；(c)安装到机器人底座的机器人臂，该机器人臂包括安装在其上的末端执行器；(d)跟踪系统，该跟踪系统测量以下项中的至少一项：(i)机器人底座定位，其指示机器人底座相对于环境的定位；以及(ii)机器人底座移动，其指示机器人底座相对于环境的移动；(e)主动阻尼系统，其主动衰减机器人底座相对于环境的移动；以及(f)控制系统，其：(i)根据来自跟踪系统的信号确定移动校正；以及(ii)至少部分地根据移动校正来控制主动阻尼系统。

Description

主动阻尼系统

优先权文件

本申请要求于2018年7月16日提交的题为“ACTIVE DAMPING SYSTEM”的第2018902566号澳大利亚临时申请的优先权，其内容据此通过引用以其整体并入。

发明背景

本发明涉及用于在物理环境内执行交互的系统和方法，并且在一个特定示例中涉及结合主动阻尼使用安装在机器人底座上的机器人臂的系统和方法。

现有技术的描述

在本说明书中对任何现有出版物(或来源于其的信息)或对已知的任何事物的提及不被视为并且不应被视为对现有出版物(或来源于其的信息)或已知的事物形成本说明书所涉及的奋斗领域中的公知常识的一部分的承认或认可或任何形式的暗示。

已知提供了其中安装在移动机器人底座上的机器人臂用于在物理环境内执行交互的系统。例如，WO 2007/076581描述了一种用于由多个砖块建造建筑物的自动砌砖系统，其包括设置有砌砖和粘合剂施加头的机器人、测量系统和向机器人提供控制数据以在预定位置处铺设砖块的控制器。测量系统实时测量头部的定位，并为控制器产生定位数据。控制器基于定位数据和头部的预定或预编程定位之间的比较产生控制数据，以针对建造中的建筑物在预定定位处铺设砖块。控制器可以控制机器人以逐层(course by course)方式建造建筑物，其中砖块顺序地铺设在它们相应的预定定位处，并且其中在为下一层铺设砖块之前，为整个建筑物铺设完整一层的砖块。

WO 2007/076581中描述的布置在解决与长吊臂由于重力、风、末端执行器的移动和吊臂的移动而偏转相关联的问题方面取得了很大进展。然而，即使采用WO 2007/076581中描述的布置，特别是当与机器人的底座和末端执行器的距离增加时，末端执行器的定位误差仍然会发生。

本发明的概述

在一个宽泛的形式中，本发明的一个方面寻求提供一种用于在物理环境内执行交互的系统，该系统包括：机器人底座；机器人底座致动器，其相对于环境移动机器人底座；安装在机器人底座上的机器人臂，该机器人臂包括安装在其上的末端执行器；跟踪系统，其测量以下项中的至少一项：机器人底座定位，其指示机器人底座相对于环境的定位；以及机器人底座移动，其指示机器人底座相对于环境的移动；主动阻尼系统，其主动衰减机器人底座相对于环境的移动；以及控制系统：其根据来自跟踪系统的信号确定移动校正，并且至少部分地根据移动校正来控制主动阻尼系统。

在一个实施例中，控制系统使用以下项中的至少一项确定移动校正：基于机器人底座的移动与机器人底座路径的路径偏差；基于当前机器人底座定位和预期机器人底座定位的定位偏差；基于机器人底座定位变化的移动；基于机器人底座定位的变化率的加速度；基于机器人底座定位相对于预期机器人底座定位的变化的移动偏差；以及，基于机器人底座定位相对于预期机器人底座定位的变化率的加速度偏差。

在一个实施例中，主动阻尼系统耦合到以下项中的至少一项：机器人底座；和机器人底座致动器。

在一个实施例中，主动阻尼系统生成与以下项中的至少一项相反的原动力(motive force)：机器人底座的无意移动；以及机器人底座远离机器人底座路径的移动。

在一个实施例中，主动阻尼系统包括以下项中的至少一项：自适应结构构件；惯性致动器；线性惯性致动器；旋转惯性致动器；用于喷射加压流体的至少一个喷嘴；安装在机器人底座上的至少一个风扇；以及末端执行器。

在一个实施例中，主动阻尼系统包括：至少一个致动器，其可操作地耦合到机器人底座；以及至少一个质量块，其耦合到致动器以允许质量块相对于致动器移动。

在一个实施例中，主动阻尼系统包括由机器人底座支撑的飞轮和驱动器。

在一个实施例中，机器人底座致动器包括致动器底座，其中机器人底座在第一方向上与致动器底座间隔开，并且其中主动阻尼被配置为在与第一方向正交的至少两个方向上向机器人底座施加力。

在一个实施例中，机器人底座致动器包括：吊臂，其具有包括机器人底座的头部；以及吊臂底座，吊臂从吊臂底座延伸。

在一个实施例中，吊臂包括可以改变吊臂的动态响应的自适应结构构件。

在一个实施例中，自适应结构构件包括以下项中的至少一项：电活性聚合物；和形状记忆合金。

在一个实施例中，控制系统：确定延伸到末端执行器目的地的末端执行器路径；生成机器人控制信号以控制末端执行器的移动；将机器人控制信号施加到机器人臂，以使末端执行器移动。

在一个实施例中，控制系统生成机器人控制信号以考虑机器人底座的移动以及主动阻尼的操作。

在一个实施例中，控制系统使用移动偏差生成机器人控制信号。

在一个实施例中，控制系统：基于机器人底座定位和预期机器人底座定位计算机器人底座偏差；基于机器人底座偏差计算稳定响应；基于移动偏差修改稳定响应；以及，使用稳定响应生成机器人控制信号。

在一个实施例中，控制系统：获取相对于环境坐标系定义的末端执行器目的地的指示；至少部分地根据末端执行器目的地计算从当前机器人底座定位延伸的机器人底座路径；基于机器人底座路径生成机器人底座控制信号；以及，将机器人底座控制信号施加到机器人底座致动器，以使机器人底座沿机器人底座路径移动。

在一个实施例中，控制系统执行以下项中的至少一项：至少部分地使用移动校正来控制机器人底座；并且至少部分地使用移动校正来生成机器人底座控制信号。

在一个宽泛的形式中，本发明的一个方面寻求提供一种用于使用系统在物理环境内执行交互的方法，该系统包括：机器人底座；机器人底座致动器，其相对于环境移动机器人底座；安装在机器人底座上的机器人臂，该机器人臂包括安装在其上的末端执行器；跟踪系统，其测量以下项中的至少一项：机器人底座定位，其指示机器人底座相对于环境的定位；以及机器人底座移动，其指示机器人底座相对于环境的移动；以及主动阻尼系统，其主动衰减机器人底座相对于环境的移动，其中该方法包括，在控制系统中：根据来自跟踪系统的信号确定移动校正；以及至少部分地根据移动校正来控制主动阻尼系统。

在一个宽泛的形式中，本发明的一个方面寻求提供一种包括计算机可执行代码的计算机程序产品，当该计算机可执行代码由适当编程的控制系统执行时，使得控制系统控制用于在物理环境内执行交互的系统，该系统包括：机器人底座；机器人底座致动器，该机器人底座致动器相对于环境移动机器人底座；安装在机器人底座上的机器人臂，该机器人臂包括安装在其上的末端执行器；跟踪系统，其测量以下项中的至少一项：机器人底座定位，该机器人底座定位指示机器人底座相对于环境的定位；以及机器人底座移动，该机器人底座移动指示机器人底座相对于环境的移动；以及主动阻尼系统，该主动阻尼系统主动衰减机器人底座相对于环境的移动，并且其中控制系统：根据来自跟踪系统的信号确定移动校正；以及，至少部分地根据移动校正来控制主动阻尼系统。

应当理解，本发明的宽泛形式及其各自的特征可以结合使用和/或独立使用，并且对单独的宽泛形式的提及并不旨在进行限制。

附图简述

现在将参照附图来描述本发明的各个示例和实施例，在附图中：-

图1A是用于在物理环境内执行交互的系统的示例的示意图；

图1B是图1A的系统的示意性平面视图；

图2是用于图1A至图1B的系统的控制系统的示例的示意图；

图3是用于执行物理交互的过程的示例的流程图；

图4是主动阻尼过程的示例的流程图；

图5A至图5C是设置在机器人底座中的主动阻尼系统的第一示例的示意性侧视图、平面图和正视图；

图6A至图6C是设置在机器人底座中的主动阻尼系统的第二示例的示意性侧视图、平面图和正视图；

图7A至图7C是设置在机器人底座中的主动阻尼系统的第三示例的示意性侧视图、平面图和正视图；

图8A和图8B是设置在机器人底座致动器中的主动阻尼系统的示例的示意性侧视图和平面图；

图9是结合主动阻尼来控制末端执行器移动的过程的示例的流程图。

图10是用于控制机器人臂以提供末端执行器稳定的过程的第一示例的流程图；

图11A和图11B是示出图10中的提供处于静止定位的末端执行器的控制过程的示例的示意图；

图11C和图11D是示出图10中的使末端执行器沿着末端执行器路径移动的控制过程的示例的示意图；

图11E和图11F是示出图10中的使机器人底座沿着机器人底座路径以及使末端执行器沿着末端执行器路径移动的控制过程的示例的示意图；

图12是用于控制机器人臂以提供末端执行器稳定的过程的第二示例的流程图；

图13A至图13C是示出图12中的提供处于静止定位的末端执行器的控制过程的示例的示意图；

图14是用于控制机器人臂以提供末端执行器稳定的过程的第三示例的流程图；

图15A和图15B是示出图14中的提供处于静止定位的末端执行器的控制过程的示例的示意图；

图15C和图15D是示出图14中的使末端执行器沿着末端执行器路径移动的控制过程的示例的示意图；

图15E和图15F是示出图14中的使机器人底座沿着机器人底座路径移动以及使末端执行器沿着末端执行器路径移动的控制过程的示例的示意图；

图16A至图16C是结合主动阻尼的末端执行器和机器人底座控制过程的具体示例的流程图。

优选实施例的详细描述

以下描述解释了用于在环境内执行交互的许多不同系统和方法。出于说明的目的，以下定义适用于通篇使用的术语。

术语“交互”旨在指在环境内发生的任何物理交互，并且包括与环境发生的物理交互或在环境上发生的物理交互。示例交互可以包括将材料或物体放置在环境内、从环境中移除材料或物体、移动环境内的材料或物体、修改、操纵或以其他方式与环境内的材料或物体接合、修改、操纵或以其他方式与环境接合等。从下面的描述中，交互的另外示例将变得明显，并且将认识到，这些技术可以扩展到广泛的不同交互，并且指定的示例不旨在进行限制。此外，在一些示例中，交互可以包括一个或更多个不同的步骤。例如，当砌砖时，交互可以包括从砖块供应机构取回砖块以及然后将砖块放置在环境中的步骤。

术语“环境”用来指在其内或其上执行交互的任何位置、区块、区域或体积。环境的类型和性质将根据优选的实现方式而变化，并且环境可以是离散的物理环境，和/或可以是逻辑物理环境，仅仅因为这是在其内部发生交互的体积而从周围环境中描绘出来。环境的非限制性示例包括建筑物或施工现场、交通工具的部件(例如轮船甲板或卡车的装载盘)、工厂、装载现场、地面工作区域等，并且下面将更详细地描述另外的示例。

机器人臂是可编程机械操纵器。在本说明书中，机器人臂包括多轴关节臂、并联运动学机器人(例如Stewart平台、Delta机器人)、球形几何机器人、笛卡尔机器人(具有直线运动的正交轴机器人)等。

吊臂是长形支撑结构，例如具有或不具有杆或铲斗、具有或不具有伸缩元件的回转吊臂、伸缩吊臂、伸缩铰接式吊臂。示例包括起重机吊臂、推土机吊臂、卡车起重机吊臂，其都具有或都不具有线缆支撑的或线缆加固的元件。吊臂还可以包括高架门架(overheadgantry)结构或悬臂门架(cantilevered gantry)或受控拉伸桁架(吊臂可以不是吊臂，而是多线缆支撑的并联运动学起重机(见PAR系统，拉伸桁架-Chernobyl起重机))或可在空间中平移定位的其他可移动臂。

末端执行器是被设计成与环境交互的在机器人臂的末端处的设备。末端执行器可以包括夹持器、喷嘴、喷砂器、喷枪、扳手、磁铁、焊炬、割炬、锯、铣刀、镂铣刀(routercutter)、液压剪机、激光器、铆接工具等等，并且对这些示例的提及并非旨在进行限制。

TCP是工具中心点的缩写。这是在末端执行器(或工具)上的位置，末端执行器的定位和定向定义了受控物体的坐标。它通常位于运动学链的远端处。运动学链指在机器人臂的底座和末端执行器之间的连杆及它们的关节的链。

CNC是计算机数控的缩写，用于通过计算机/处理器/微控制器执行的预先编程的机器控制命令的序列来实现机器的自动化。

在CNC控制系统内的坐标变换的应用通常被执行，以允许按照方便的坐标系编程。它也被执行以允许当工件被夹持在CNC加工中心上的虎钳或夹具中时对工件定位误差的校正。

这些坐标变换通常在静态意义上被应用，以考虑静态坐标转换(shift)或校正静态误差。

机器人和CNC机器按照方便的笛卡尔坐标系被编程，且使用运动学变换来将笛卡尔坐标转换为关节定位，以移动机器人或CNC机器的姿势。

实时地测量靠近TCP的机器人臂末端执行器的定位提高了机器人的准确度。这在用于探测和钻孔的机器人上的静态末端执行器上被执行。这通过以下的多步骤过程来实现：移动到所编程的定位、进行定位测量、计算校正向量、将补偿向量添加到所编程的定位以及然后将TCP移动到新定位。这个过程不是硬实时地完成的，而是依赖于静态机器人臂姿势。

现在将参照图1A和图1B以及图2描述用于在物理环境内执行交互的系统的示例。

在图1A的示例中，系统100包括机器人组件110，机器人组件110包括机器人底座111、机器人臂112和末端执行器113。机器人组件110相对于环境E定位，在该示例中，环境E被示出为2D平面，但是在实践中可以是任何配置的3D体积。在使用中，末端执行器113用于在环境E内执行交互，例如执行砌砖、物体操纵等。

系统100还包括跟踪系统120，跟踪系统120能够跟踪机器人组件的移动，并且在一个特定示例中，跟踪机器人底座相对于环境的移动。在一个示例中，跟踪系统包括通常相对于环境E静态定位的跟踪器底座121和安装在机器人底座111上的跟踪器目标122，允许确定机器人底座111相对于环境E的定位。在其它布置中，末端执行器113的移动可以代替机器人底座111或者除了机器人底座111之外被跟踪。此外，跟踪器底座可以定位在机器人组件110上，以便与其一起移动，并且跟踪器目标可以相对于环境E静态定位。

在一个示例中，跟踪系统120包括跟踪底座121，该跟踪底座121包括跟踪器头部和底座传感器，该跟踪器头部具有被布置成向目标122发送辐射束的辐射源，该底座传感器感测反射的辐射。提供了跟踪目标122的定位并控制跟踪器头部的定向以跟随目标122的底座跟踪系统。在一个示例中，目标122包括对辐射束进行感测的目标传感器和对跟踪底座的定位进行跟踪并且控制目标的定向以跟随跟踪器头部(即，活动目标)的目标跟踪系统。在其它示例中，目标122是确实跟随跟踪器头部的无源仪器。在跟踪器头部中设置角度传感器，该角度传感器确定头部的定向(例如，仰角和方位角)。可选地，在目标中还设置角度传感器，该角度传感器确定目标的定向。处理系统根据来自传感器的信号确定目标相对于跟踪器底座的定位，特别是使用来自角度传感器的信号来确定跟踪器和目标之间的相对角度，同时可以使用辐射束的飞行时间来确定物理间隔，从而允许确定目标相对于跟踪底座的定位。在另一示例中，辐射可以被极化，以便允许确定目标相对于跟踪底座的侧倾角。

尽管示出了包括跟踪器头部和目标的单个跟踪系统120，但是这不是必需的，并且在其它示例中，可以提供多个跟踪系统和/或目标，这将在下面更详细地描述。在一些示例中，跟踪系统可以包括定位在机器人组件上的跟踪器头部，该跟踪器头部被配置成跟踪位于环境中的一个或更多个目标。

在一个特定示例中，跟踪系统是激光跟踪系统，并且示例布置由API(Radian和OT2可选地与STS(智能跟踪传感器))、Leica(AT960和可选地Tmac)和Faro制造。这些系统以300Hz、或1kHz或2kHz(取决于设备)测量定位，并且依赖于感测布置的组合(包括激光跟踪、使用2D相机的视觉系统、加速度计数据(例如来自倾斜传感器或INS(惯性导航系统)的加速度计数据))，并且可以用于对定位进行精确测量，其中从激光跟踪器和可选的活动目标获得的数据等同于活动目标相对于环境E的定位和可选的定向。由于这些系统是已知的并且是商业上可获得的，因此将不再进一步详细描述。

还将认识到，其他定位/移动传感器(例如惯性测量单元(IMU))也可以被结合到系统中，这将在下面更详细地描述。

在实践中，在上述示例中，机器人底座111经历相对于环境E的移动。移动的性质将根据优选实现方式而变化。例如，机器人底座111可以安装在轨道、轮子或类似物上，允许其在环境E内移动。

替代地，在图1B所示的示例中，机器人底座111由机器人底座致动器140支撑，该机器人底座致动器140可用于移动机器人底座。在这个示例中，机器人底座致动器是吊臂组件的形式，其包括吊臂底座141、吊臂142和杆143。吊臂通常是可控的，允许机器人底座的定位和/或定向被调整。可用的移动类型将根据优选的实现方式而变化。例如，吊臂底座141可以被安装在交通工具上，允许其被定位并可选地被旋转到期望的定位和定向。吊臂142和杆143可以是伸缩布置(包括多个伸缩吊臂或杆构件)，允许调节吊臂或杆的长度。此外，吊臂底座141和吊臂142之间以及吊臂142和杆143之间的角度可以例如使用液压致动器来控制，允许机器人底座111被设置在相对于环境E的期望定位。这样的操作通常在机器人底座致动器坐标系BACS中执行，尽管这不是必需的，这将从剩余的描述中变得明显。

WO2018/009981中描述了用于砌块(例如砖块)的这种形式的系统的示例，其内容通过交叉引用被并入本文。然而，将认识到，这样的布置不限于砌块，而是还可以用于其它形式的交互。

在图1A和图1B所示的系统中，提供了与跟踪系统120、机器人组件110和机器人底座致动器140通信的控制系统130，允许基于从跟踪系统接收的信号来控制机器人组件110和机器人底座致动器140。控制系统通常包括一个或更多个控制处理器131和一个或更多个存储器132。为了便于说明，其余的描述将参考一个处理设备和一个存储器，但是将认识到，可以使用多个处理设备和/或存储器，其中对单数的提及包含复数布置，反之亦然。在使用中，存储器存储通常以应用软件或固件的形式的控制指令，应用软件或固件由处理器131执行，允许来自跟踪系统120和机器人组件110的信号被解释并被用于控制机器人组件110以允许交互被执行。

图2中更详细地示出了控制系统130的示例。

在该示例中，控制系统230耦合到机器人臂控制器210、跟踪系统控制器220和吊臂控制器240。这通常经由合适的通信网络(包括有线或无线网络，并且更通常是以太网(Ethernet)或工业以太网(Ethercat))来执行。机器人臂控制器210耦合到机器人臂致动器211和末端执行器致动器212，它们能够分别控制机器人臂112和末端执行器113的定位。跟踪系统控制器220耦合到跟踪头221和目标222，允许跟踪系统被控制，以及跟踪头221和目标222的相对定位被确定并返回到控制系统230。吊臂控制器240通常耦合到吊臂致动器241、242，吊臂致动器241、242可用于定位吊臂并因此定位机器人底座。还可以提供第二跟踪系统，第二跟踪系统包括可操作地耦合到控制器225的传感器226(例如惯性传感器)。要理解的是，在实践中，机器人臂、末端执行器和吊臂将具有多个致动器(例如伺服电机、液压缸等)，以实现它们相应的轴(即关节)的移动，并且对单个致动器的提及并非旨在进行限制。

机器人臂控制器210、跟踪系统控制器220、第二跟踪系统控制器225和吊臂控制器240中的每一者通常包括电子处理设备，电子处理设备与存储的指令一起操作，并且操作来解释由控制系统230提供的命令，并且针对相应的致动器和/或跟踪系统生成控制信号和/或从传感器接收信号，并且向控制系统230提供相关数据。电子处理设备可以包括任何电子处理设备，例如微处理器、微芯片处理器、逻辑门配置、可选地与实现逻辑(例如FPGA(现场可编程门阵列))相关联的固件、或者任何其他电子设备、系统或布置。应当理解，机器人臂控制器210、跟踪系统控制器220和吊臂控制器240通常分别形成机器人组件、跟踪系统和吊臂组件的一部分。因为这些系统的操作在本领域中将会被理解，所以将不再详细描述这些。

控制系统230通常包括电子处理设备231、存储器232、输入/输出设备233和接口234，它们可用于将控制系统230连接到机器人臂控制器210、跟踪系统控制器220和吊臂控制器240。尽管示出了单个外部接口，但这仅仅是出于示例的目的，并且实际上可以提供使用各种方法的多个接口(例如以太网、串行、USB、无线等)。

在使用中，处理设备231执行存储在存储器232中的应用软件形式的指令，以允许所需的过程被执行。应用软件可以包括一个或更多个软件模块，并且可以在合适的执行环境(例如操作系统环境等)中被执行。

因此，将要认识到，控制系统230可以由任何合适的处理系统(例如合适编程的PC、计算机服务器等)形成。在一个特定示例中，控制系统230是标准处理系统，例如基于英特尔架构的处理系统，其执行存储在非易失性(例如硬盘)存储装置上的软件应用，但是这不是必需的。然而，还将理解的是，处理系统可以是任何电子处理设备，例如微处理器、微芯片处理器、逻辑门配置、可选地与实现逻辑(例如FPGA(现场可编程门阵列))相关联的固件、或者任何其他电子设备、系统或布置。

还应当理解，上述布置仅是出于说明的目的，并且在实践中可以使用广泛的不同系统和相关联的控制配置。例如，将认识到，控制器和/或控制系统之间处理的分布可以根据优选实现方式而变化。

出于以下示例的目的，将参考相对于环境E静止的环境坐标系ECS和相对于机器人底座111静止的机器人底座坐标系RBCS。此外，一些示例将参考机器人底座致动器坐标系BACS，该机器人底座致动器坐标系BACS是用于控制机器人底座的移动(例如控制吊臂组件的移动)的坐标系。

根据实现方式，吊臂组件可以具有显著的长度，因此例如在建造应用的情况下，吊臂可能需要横跨施工现场延伸，并且可以具有几十米的长度。在这样的情况下，吊臂通常承受各种载荷，包括由吊臂和/或机器人臂的移动、风载荷、机械振动等产生的力，这些力又会在吊臂的末端诱发振动或其他移动，进而导致机器人底座相对于环境移动。这种移动通常将被称为无意移动。另外，如上所述，可以通过主动地移动吊臂而使机器人底座以受控方式移动，并且这种移动通常将被称为有意移动。

在任何情况下，将认识到，在上述示例中，机器人底座相对于环境移动，因而机器人底座坐标系RBCS相对于环境坐标系ECS移动，这显著使得控制过程且特别是精确定位末端执行器以便在环境内执行交互的能力复杂化。在这点上，在正常机器人应用中，末端执行器在机器人底座坐标系RBCS中被控制，而末端执行器需要在环境坐标系ECS中被定位，并且由于移动导致两个坐标系相对于彼此移动，这使得很难精确定位末端执行器。

现在将参考图3描述用于在环境E内执行交互的过程的示例。

出于以下解释的目的，将提及术语“目的地”。该术语旨在指末端执行器113将被设置的定位和可选的定向(其组合称为姿势)，或者作为执行交互的一部分，或者是其他方式。例如，目的地可以对应于环境内将要发生交互的位置。然而，这不是必需的，替代地，目的地可以对应于末端执行器应该经过的任何定位，其实际上定义了通向最终目的地的多个目的地。例如，交互可以包括末端执行器移动的序列，它们可选地形成不同步骤的一部分，以及术语目的地可以指形成不同步骤的一部分的任何定位。因此，术语目的地应被解释为指末端执行器将被定位的任何特定点，并且在一些示例中，目的地可以是(例如当执行其他过程时)末端执行器将被保持一段时间的静态点，而在其他情况下，目的地可以是暂时的并且对应于末端执行器将遍历的路径上的点。

在该示例中，在步骤300处，一个或更多个目的地定位被确定。实现这一步骤的方式将根据优选实现方式而变化。在一个示例中，目的地可以从数据库或其他数据存储装置中检索，从另一处理系统接收，基于来自传感器的信号或用户输入命令等来确定。例如，末端执行器目的地可以从规划图(plan)(例如建筑物的建造规划图)中导出，在这种情况下，规划图可以被检索并且目的地可以从该规划图中导出。在这点上，建造规划图可以识别物体(诸如砖块)将被放置的定位以便建造建筑物。在本示例中，可以简单地从规划图中检索目的地定位。

然而，这不是必需的，并且替代地，目的地定位可能需要以其他方式被确定。例如，可能必需从环境中取回物体，在这种情况下，末端执行器的目的地对应于物体定位。在该示例中，物体定位可能事先是不知道的，在这种情况下，物体的定位可能需要例如使用基于相机的视觉系统或其他定位化(localisation)系统来检测，允许被检测到的定位被使用以便定义目的地定位。在这点上，物体可以是静止的或移动的，这意味着尽管目的地相对于环境坐标系ECS通常是静止的，但是在一些示例中，目的地可以是移动的。

还将认识到，目的地可以以其他适当的方式被确定，并且上述示例并不旨在进行约束。

在步骤310处，可选地，允许机器人底座111移动的机器人底座路径被规划。例如，在机器人底座111静止或已经被定位的情况下，可能不需要机器人底座路径。然而，将要认识到，机器人底座路径可以用于将机器人底座111移动到环境E内的或相对于环境E的不同定位，以便允许末端执行器113更方便地被设置在相应的目的地处。计算底座路径的方式将根据优选实现方式而变化，并且下面将更详细地描述示例。

在步骤320处，末端执行器路径被规划以将末端执行器113移动到目的地。末端执行器路径通常是基于机器人底座111相对于环境E的所规划的或理想的定位来规划的，例如以考虑机器人底座111沿着机器人底座路径的移动。末端执行器路径可以从末端执行器113的预期先前定位(例如在先前交互或其他步骤完成之处)延伸，或者可以基于当前末端执行器定位实时计算。将认识到，在目的地是基于当前定位的情况下，末端执行器路径可以是零长度的空(null)路径，其中这用于相对于环境E静态地定位末端执行器113的目的。

在步骤330处，例如通过控制吊臂组件140或另一种形式的机器人底座致动器，机器人底座111可选地基于机器人底座路径移动。该过程通常在机器人底座致动器坐标系BACS中被执行，但是这不是必需的，并且机器人底座路径规划和/或对机器人底座移动的控制可以在其它坐标系中被执行。在该过程期间和/或之后，在步骤340处，执行末端执行器移动的开始，使得末端执行器开始沿着末端执行器路径移动，假设这是需要的。该过程通常在机器人底座坐标系RBCS中被执行，但是这不是必需的，并且末端执行器路径规划和/或控制可以在其它坐标系中被执行。

当末端执行器113的移动被执行时，或者相反如果末端执行器113相对于环境E保持在静止定位处，则在步骤350使用跟踪系统120来监测机器人底座的移动，以连续检测机器人底座111相对于环境E的定位。这用于在步骤360处例如通过调整机器人臂的姿势来调整末端执行器的移动，以确保到达目的地定位。

在这点上，机器人底座可能由于环境的变动或由于吊臂的振动或风载荷等导致的机器人底座的意外移动而相对于环境E经历无意移动。这样的移动意味着，例如由于机器人底座111偏离计算出的机器人底座路径，机器人底座可能不会被设置在相对于环境的预期的或理想的定位中。在该示例中，通过监测机器人底座111的移动，可以校正这样的移动，确保末端执行器沿着末端执行器路径正确移动到目的地定位。

因此，在一个示例中，机器人底座致动器用于提供粗略定位系统，而机器人臂提供精细定位系统，以允许末端执行器相对于环境被精确定位。操作由控制系统控制，该控制系统使用跟踪系统实时测量机器人底座的定位和可选地测量机器人底座的定向，机器人底座的测量的定位(和定向)被用于计算偏移，该偏移作为定位变换被添加到精细定位机构的相对定位，使得末端执行器相对于环境被正确定位。因此，可以使用较大且相对较轻且柔性的结构来近似定位快速且精确的精细定位机构，该精细定位机构可以实时地被精确控制，允许末端执行器以精确且快速的运动相对于环境移动。

这种操作形式被申请人称为动态稳定技术(DST)，并在包括US-8,166,727、WO2009/026641、WO2009/026642、WO2018/009981和WO2018/009986在内的在先公开中进行了描述，这些公开的内容通过交叉引用并入本文。

还将认识到，DST也可以用于考虑机器人底座的有意移动，例如考虑在执行交互时机器人底座111可能正在遍历机器人路径的事实。

现在将进一步详细描述上述系统的多个不同方面的示例。根据优选的实现方式，系统的这些不同方面可以独立使用或者可以结合使用。由此将认识到的是，对单独方面的提及不应被认为是限制性的，并且根据优选实现方式和使用系统的场景，这些方面可以以任意数量的不同组合被使用。

在一个方面，提供了用于控制主动阻尼系统的过程，以及现在将参考图4更详细地描述这一过程的示例。

出于该示例的目的，假设机器人底座可以使用机器人底座致动器来相对于环境移动。致动器的性质和执行方式可以根据优选实现方式而变化。在一个示例中，机器人底座致动器可以是类似于以上参考图1A和图1B所述的吊臂组件的吊臂组件140。然而，可以提供任何形式的机器人底座致动器，并且这可以包括具有安装在交通工具上的机器人底座的交通工具，或者可以包括使用起重机或用于将机器人组件悬挂在工作环境上方的其它类似布置，或者可以包括使用例如包括轮子或轨道等的自供电机器人底座。

另外，在该示例中，假设系统包括主动阻尼系统，该主动阻尼系统主动地衰减机器人底座相对于环境的移动。主动阻尼系统的性质以及其如何附接和使用将根据优选的实施方式而变化，并且具体的示例将在下面更详细地进行描述。

在该示例中，在步骤400处，控制系统130从跟踪系统获取跟踪信号。根据优选的实施方式，信号可以从第一跟踪系统或第二跟踪系统获得，尽管更典型的信号将是以从第一跟踪系统120获得的定位信号的形式，该定位信号指示机器人底座相对于环境E的定位。

在步骤410处，控制系统根据来自跟踪系统的信号确定移动校正。移动校正通常指示远离预期的或理想的定位的移动的程度，并且可以考虑机器人底座定位、移动和/或加速度。

在步骤420处，控制系统130至少部分地根据移动校正来控制主动阻尼系统，从而至少部分地抵消机器人底座远离预期定位的移动。

在步骤430处，用于控制末端执行器移动的任何动态稳定可以可选地被更新以考虑主动阻尼的影响。在这点上，如果基于机器人底座定位与预期定位的偏差来计算动态稳定响应，然后通过主动阻尼来减轻这种影响，则如果不考虑主动阻尼的影响来校正动态稳定响应，则动态稳定响应可能导致补偿过度或不足。因此，可以在前馈过程中修改任何计算的稳定响应，以考虑主动阻尼，从而确保稳定响应是适当的。

因此，将理解，上述系统描述了可移动机器人底座的主动阻尼。这用于减少机器人底座的无意移动，机器人底座的无意移动通常是由于吊臂和/或机器人臂的移动、风载荷、机械振动等产生的力引起的。减少这种无意移动可以有助于确保末端执行器可以准确地定位在环境内，从而允许更容易地进行交互。特别是，这减少了需要使用DST进行的补偿的量，这可以允许DST在以其他方式可能不可行的情况下(例如在有风的环境中)操作，这在建造高层建筑时尤其重要。

现在将描述许多另外的特征。

根据优选的实施方式，可以以一系列不同的方式来计算移动校正。例如，移动校正可以基于指示机器人底座相对于机器人底座路径的移动的路径偏差。在该示例中，机器人底座致动器使用机器人底座路径来移动机器人底座，其中远离机器人底座路径的移动被确定为无意的，因此用于确定移动校正。类似地，这可以基于指示当前机器人底座定位与预期机器人底座定位的偏差的定位偏差。此外，和/或可选地，可以根据机器人底座的移动或加速度(基于机器人底座定位的变化或变化率)确定移动校正。最后，移动校正可以基于移动或加速度偏差(基于机器人底座定位相对于预期机器人底座定位的变化或变化率)。

因此，将理解，虽然阻尼可以仅基于机器人底座的移动或加速度来执行，但是还可以考虑机器人底座的预期定位。这可以有助于提供更有效的阻尼结果。例如，如果移动正在朝向机器人底座的预期定位前进，则与移动远离预期定位相比，可能不希望衰减移动。从而考虑移动和/或加速度的程度以及这相对于预期定位的定位，允许更有效地控制阻尼。

根据阻尼系统的性质以及阻尼系统如何被实施，阻尼系统可以耦合到机器人底座和/或机器人底座致动器，并且示例布置将在下面更详细地进行描述。

在一个示例中，主动阻尼系统用于生成原动力，该原动力抵抗机器人底座的无意移动和/或机器人底座远离机器人底座路径的移动。原动力通常由主动元件生成，并且在这方面，阻尼系统可以包括自适应结构构件、惯性致动器、线性惯性致动器、旋转惯性致动器、用于喷射加压流体的至少一个喷嘴、安装在机器人底座上的至少一个风扇、末端执行器等中的任何一个或更多个。还应当理解，该列表并非旨在穷举，而是可以使用其它布置。

现在将描述许多具体的示例阻尼装置。

在图5A至5C的示例中，示出了阻尼系统，该阻尼系统包括安装在机器人底座内的多个线性致动器。

具体而言，在该示例中，机器人底座111包括主动构件，每个主动构件包括线性致动器571.1、571.2、571.3，每个线性致动器具有与其耦合的质量块572.1、572.2、572.3。在使用中，线性致动器571.1、571.2、571.3的操作导致相应的质量块572.1、572.2、572.3移动，从而抵消机器人底座111的移动。在所示的示例中，线性致动器571.1、571.2、571.3正交定位，并且围绕机器人底座111的质心布置，允许衰减沿着机器人底座坐标系RBCS中的轴线的平移移动。

然而，将理解，可以使用其它布置。例如，线性致动器可以用旋转致动器代替，或者与旋转致动器结合使用，旋转致动器包括由机器人底座支撑的飞轮和驱动器。在这种情况下，飞轮的旋转可以用来抵消机器人底座111的旋转移动。还应当理解，可以使用多个线性致动器来衰减旋转和平移移动。例如，如果在X-Y平面中以平行间隔开的布置提供两个线性致动器，则这可以用于衰减围绕Z轴的旋转移动，以及抵消平移移动。因此，在一个示例中，六个线性致动器可用于在六个自由度的每个自由度中提供阻尼。

此外，尽管在图5A至图5C中示出了在三个平移轴中提供阻尼，但这可不是必需的。在这方面，当机器人底座致动器包括致动器底座并且机器人底座在第一方向上与致动器底座间隔开时，例如当机器人底座由从吊臂底座141延伸的吊臂142、143支撑时，则大多数不希望的振动倾向于在正交于第一方向的平面内。因此，在一个示例中，可以仅需要主动阻尼来在正交于第一方向的两个方向上向机器人底座施加力。举例来说，在图1A所示的特定配置中，吊臂沿着机器人底座坐标系RBCS的轴线X_RB延伸，这意味着需要在Z_RB-Y_RB平面中提供大多数阻尼。

图6A至图6C和图7A至图7C示出了替代的致动器布置。

在图6A至图6C的示例中，成对的风扇671.1、671.2、672.1、672.2、673.1、673.2安装到机器人底座111，其中每对风扇面向正交方向。在这种情况下，风扇的操作可以用来生成向前或向后的推力，从而施加阻尼力。一对具有共同推力的风扇的激活可用于提供平移阻尼效果，而相反的推力可生成旋转阻尼效果。在这个示例中，推力的变化可以通过改变风扇转速和/或通过改变风扇叶片间距来实现。

在图7A至图7C的示例中，成对的喷嘴771.1、771.2、772.1、772.2、773.1、773.2安装在机器人底座111的相对面上，其中喷嘴用于在压力下喷射流体(例如空气)，从而生成与由反应控制系统(RCS)提供的原动力相似的原动力。应当理解，喷嘴的适当配置可用于提供平移和/或旋转阻尼。

在图8A和图8B的示例中，在机器人底座致动器的吊臂中提供阻尼。

在该示例中，示出了两种不同类型的阻尼，其包括线性致动器871.1、872.1(其上安装有质量块871.2、872.2)的使用者。在这个示例中，这些线性致动器纵向安装在吊臂142和杆143内，从而在这些构件内提供纵向阻尼。

另外，成对的结构构件873.1、873.2、874.1、874.2、875.1、875.2、876.1、876.2设置在吊臂142和杆143的上侧和下侧以及左侧和右侧。结构构件可以被配置成提供被动阻尼，例如减少吊臂和杆的扭转或纵向弯曲。在这种情况下，结构构件873.1、873.2、874.1、874.2、875.1、875.2、876.1、876.2可以由多层粘弹性结构形成，该多层粘弹性结构用于吸收力并减少吊臂和/或杆的弯曲，如果不是由被动阻尼系统吸收，则这可以反过来导致吊臂和/或杆中不必要的振动。

在另一个示例中，结构构件873.1、873.2、874.1、874.2、875.1、875.2、876.1、876.2是自适应结构构件，该自适应结构构件可以改变吊臂的动态响应，并且特别是在吊臂上施加力。这样的自适应结构构件可由活性材料(例如电活性聚合物、形状记忆合金等)形成，允许构件通过施加控制信号(例如电和/或温度变化)来施加力。应当理解，在这种情况下，如果检测到机器人底座的移动，则结构构件873.1、873.2、874.1、874.2、875.1、875.2、876.1、876.2可以被激活以向吊臂施加力并抵消该移动。

附加地和/或替代地，与向吊臂和/或杆施加力相反，结构构件873.1、873.2、874.1、874.2、875.1、875.2、876.1、876.2可以适于修改吊臂的刚度，这进而改变吊臂对振动的响应，例如通过调节吊臂的谐振频率，这可以确保谐振频率不同于任何当前振动的频率。

还应当理解，由于机器人臂和/或末端执行器具有固有质量，因此这还可以起到提供阻尼的作用。例如，在与无意移动相反的方向上移动机器人臂和末端执行器可以提供阻尼效果。虽然这种效果对于单独的机器人臂末端执行器来说可能不大，但是在末端执行器被用于承载诸如砖块的质量块的情况下，这可以增强阻尼效果。

虽然已经独立地描述了许多不同的阻尼机构，但是应当理解，这些机构可以组合使用。例如，该系统可以包括机器人底座中和吊臂中的阻尼布置，其中根据机器人底座的移动的性质使用不同阻尼布置的组合。例如，只有一个阻尼布置可以用于小的移动，而多个阻尼布置可以用于大的移动。

如前所述，末端执行器的移动通常被控制为考虑到机器人底座的移动，并且特别是对机器人底座的移动进行校正，从而使得末端执行器能够在环境坐标系ECS内被精确控制，而与环境和机器人底座之间的相对移动无关。因此，这种DST动态地调整末端执行器，以便考虑机器人底座的移动，这可以用于例如将末端执行器保持为在环境内静止或沿着或根据环境内的限定路径移动，而不管机器人底座的移动如何。

动态稳定技术可以利用不同的方法来实现，且现在将描述三个示例机制，这些示例机制在下文中被称为动态补偿、动态坐标系和动态路径规划。

动态补偿通过生成路径校正并在生成控制机器人臂的控制信号时应用路径校正来进行操作，使臂跟随修改后的路径，从而将末端执行器带回到原始规划路径。

动态坐标系通过在跟踪机器人底座的移动的移动坐标系中计算机器人臂运动学来进行操作，使得末端执行器总是在环境坐标系ECS中具有正确定位。这通常包括转换(shifting)机器人臂运动学的原点，以确保末端执行器被正确定位。

动态路径规划包括在机器人底座和环境相对于彼此移动时重新计算末端执行器路径，使得新路径确保末端执行器始终向末端执行器目的地前进。

通常，动态稳定与主动阻尼一起实现。因此，除了执行主动阻尼之外，控制系统通常确定延伸到末端执行器目的地的末端执行器路径，生成机器人控制信号以控制末端执行器的移动，并将机器人控制信号施加到机器人臂以使末端执行器移动。

由于主动阻尼将影响机器人底座的移动，所以控制系统通常生成机器人控制信号，以考虑机器人底座的移动和主动阻尼的操作。为了实现这一点，控制系统通常使用移动偏差来生成机器人控制信号，并且在一个特定示例中，基于机器人底座定位和预期的机器人底座定位来计算机器人底座偏差，基于机器人底座偏差来计算稳定响应，基于移动偏差来修改稳定响应，然后使用稳定响应来生成机器人控制信号。

类似地，当控制机器人底座致动器时，还可以考虑阻尼。在这种情况下，控制系统通常获取相对于环境坐标系定义的末端执行器目的地的指示，至少部分地根据末端执行器目的地计算从当前机器人底座定位延伸的机器人底座路径，基于机器人底座路径生成机器人底座控制信号，并将机器人底座控制信号施加到机器人底座致动器，以使机器人底座根据机器人底座路径移动。

然后，控制系统可以至少部分地使用移动校正来控制机器人底座，并且至少部分地使用移动校正来生成机器人底座控制信号，使得这考虑到应用于机器人底座的移动的任何阻尼信号。

现在将参考图9更详细地描述控制过程的示例。

在该示例中，在步骤900处，控制系统130获取机器人底座路径。机器人底座路径可以是检索出的预先计算的路径，或者替代地，可以是例如基于多个末端执行器目的地计算出的。类似地，在步骤905处，再次通过检索预定路径或基于末端执行器目的地计算末端执行器路径来确定末端执行器路径。

在步骤910处，控制系统130从跟踪系统获取跟踪信号，并在步骤915处使用这些信号来确定机器人底座定位和/或移动。在这点上，来自第一跟踪系统120的信号可用于确定机器人底座相对于环境坐标系ECS的定位，然后可将其用于确定从先前定位的移动。附加地和/或替代地，移动可以从移动传感器226(例如惯性测量单元(IMU)或类似物)来确定。

在步骤920处，控制系统130确定移动校正。移动校正通常考虑任何当前无意移动的幅度，并且可以基于移动速度和/或加速度以及机器人底座相对于预期定位的当前定位，如从机器人底座路径导出的。特别地，计算校正以试图最小化任何无意移动的幅度，而且还有助于使机器人底座返回到期望的机器人底座路径。例如，机器人底座朝向机器人底座路径的大移动可能比机器人底座远离机器人底座路径的小移动导致更小的阻尼。阻尼程度还可以取决于当前是否正在使用DST。因此，例如，如果不需要稳定末端执行器，则可能不需要阻尼。然而，在提供阻尼以防止吊臂产生大的振动方面可能会有好处，当需要动态稳定时，这可能进而引起问题。

无论如何，在步骤925处生成阻尼控制信号，在步骤930处将阻尼控制信号施加到阻尼布置以激活主动阻尼。因此，例如，这将涉及使控制系统130生成控制信号来操作阻尼致动器等。

与该过程同时，在步骤935处，控制系统计算末端执行器的稳定响应，以便允许实现DST过程，并且下面将更详细地描述针对不同DST过程实现这一点的方式的示例。在步骤940处，控制系统130修改稳定响应以考虑正在应用的阻尼控制。在这点上，如果稳定是基于当前移动计算的，并且阻尼降低了移动的幅度，则稳定度可能会过度补偿或补偿不足。因此，在一个示例中，根据移动校正来缩放稳定，从而将末端执行器保持在期望定位。

修改了稳定之后，在步骤945处生成控制信号，并将控制信号施加到机器人底座致动器和机器人臂，以根据各自的路径移动机器人底座和末端执行器，通常这与阻尼的应用同时进行。

因此，将理解，这提供了结合动态稳定执行阻尼的机构。现在将更详细地描述不同类型的动态稳定的示例。

现在将参考图10并参考图1A和图1B的系统来描述用于执行动态补偿的过程的示例。

在该示例中，在步骤1000处，控制系统130获取末端执行器目的地，如将认识到的，这可以使用上述技术来实现。

在步骤1010处，基准机器人底座定位由控制系统130确定，这通常是相对于环境坐标系ECS被执行的。基准机器人底座定位可以是当前定位和/或未来时间点处的定位，并且因此可以表示当末端执行器要执行交互时的预期定位，例如将物体定位在环境中。

然后，在步骤1020处，控制系统130计算末端执行器路径，该路径延伸到末端执行器目的地。该过程可以至少部分地使用基准机器人底座定位来被执行，以便考虑从当前机器人底座定位到基准机器人底座定位的任何移动和/或在机器人底座坐标系RBCS和环境坐标系ECS之间变换(如果需要的话)。例如，末端执行器路径通常在机器人底座坐标系RBCS中计算，因为这允许用于机器人臂的控制信号更容易映射到移动，这意味着末端执行器目的地从环境坐标系ECS变换到机器人底座坐标系RBCS。考虑到机器人底座坐标系RBCS和环境坐标系ECS的相对定位将随着机器人底座111沿着机器人底座路径移动而变化，这是基于当机器人底座定位于基准机器人底座定位时坐标系的相对定位来被执行的。然而，这并不是必需的，且可选地，当前末端执行器定位可以被转移到环境坐标系ECS中，从而允许在环境坐标系ECS中计算末端执行器路径。

在计算了路径之后，在步骤1030处，使用来自跟踪系统的信号来确定当前机器人底座定位。这用于在步骤1040处计算指示路径修改的校正。校正的性质和对此进行计算的方式将根据优选实现方式而变化，但是在一个示例中，这是表示如基于机器人底座的运动所确定的当前末端执行器定位相对于末端执行器路径的偏差的向量形式。例如，如果机器人底座111经历远离预期机器人底座定位的运动，这将导致末端执行器113远离末端执行器路径的等效运动，这将需要被校正以便确保末端执行器继续遍历该路径。

在步骤1050处，控制系统130基于末端执行器路径和校正生成机器人控制信号，在步骤1060处，这些机器人控制信号被施加到机器人臂，以使得末端执行器113根据末端执行器路径和校正移动，使得末端执行器移动回到末端执行器路径，并继续朝向目的地。然后，根据需要重复步骤1030至1060，直到末端执行器到达目的地为止。

因此，上述技术通过如下方式来操作：基于当前测量的机器人底座定位与期望的机器人底座定位的偏差计算校正，在生成机器人控制信号时使用该校正从而校正末端执行器的定位。在一个示例中，机器人底座以较慢的动态响应移动，而末端执行器以较快的动态响应移动，使得末端执行器的移动可以被用于校正机器人底座远离预期的机器人底座定位的移动。

现在将参考图11A至图11F描述多个不同的示例场景，以更清楚地解释在多个不同场景中动态补偿的操作。这些示例示出了附接到机器人臂1112的末端执行器1113，机器人臂1112又附接到机器人底座(为了清楚起见未示出)。以下示例将说明仅在二个维度中操作的动态补偿机制，但是将认识到，这可以延伸到六个自由度，并且仅参考二个维度并不旨在进行限制。

在图11A和图11B的示例中，末端执行器目的地与当前末端执行器定位一致，这意味着计算的末端执行器路径实际上是零路径长度的零路径。将使用这样的布置以便在环境E中保持静态末端执行器定位。

在该示例中，机器人底座的无意移动1161(例如，由吊臂的振动、风载荷等引起的无意移动)使机器人臂1112移动，且从而移动末端执行器1113。结果，末端执行器1113现在偏离目的地1151。在这种情况下，基于移动1161计算校正，这生成路径校正，在这种情况下有效地创建新路径1162，新路径1162使得机器人臂移动末端执行器并抵消无意移动1161，从而将末端执行器返回到目的地1151。在这点上，机器人臂的姿势将根据机器人底座的无意移动而改变，以便实现路径校正并将末端执行器1113带回目的地1151。

在图11C和图11D的示例中，末端执行器1113沿着末端执行器路径1155行进到目的地1151。在这种情况下，当机器人臂同时沿着箭头1163所示的路径移动时，会发生无意移动1161。在这种情况下，计算校正以使末端执行器根据箭头1162移动，这与沿着路径1164的下一次移动结合在一起，导致净移动1165，净移动1165将末端执行器1113返回到原始路径1155。

图11E和图11F所示的另一个示例包括沿着末端执行器路径1155移动末端执行器，以及同时沿着机器人底座路径1153移动机器人底座。在这种情况下，基准机器人底座定位在图11E中以虚线示出，其基于当末端执行器1113到达末端执行器目的地1151时的预期的机器人底座定位。在这种情况下，从基准机器人底座定位，末端执行器路径1155垂直向下到目的地1151，并且净路径(net path)1156由末端执行器路径1155和机器人底座路径1153的组合形成，导致从当前末端执行器定位到目的地1151的净末端执行器移动(net endeffector movement)。

在这种情况下，如1163处所示，当机器人底座和末端执行器1113沿着净路径移动时，如1161所示出现无意移动。在这种情况下，计算校正1162，其与下一路径移动1164结合，导致末端执行器沿着路径1165移动，返回到原始净路径1156。

因此，将认识到，上述过程操作以校正末端执行器的至少无意移动，从而即使末端执行器在机器人底座坐标系RBCS中被控制，也将末端执行器1113保持在环境坐标系ECS内的期望定位处，或者根据环境坐标系ECS内的期望路径行进。

如上所述，在一个优选示例中，控制系统130在机器人底座坐标系RBCS中计算末端执行器路径，而末端执行器目的地通常在环境坐标系ECS中被定义。这涉及使控制系统130通过至少部分地使用基准机器人底座定位将末端执行器目的地从环境坐标系ECS变换到机器人底座坐标系RBCS来确定变换的末端执行器目的地。控制系统130然后可以计算延伸到机器人底座坐标系RBCS中的变换的末端执行器目的地的末端执行器路径。然而，将认识到，这不是必需的，并且可选地，路径计算可以在环境坐标系ECS中被执行。

在一个示例中，控制系统确定末端执行器定位，并且然后使用末端执行器定位计算末端执行器路径，使得末端执行器路径从末端执行器定位延伸到末端执行器目的地。末端执行器定位通常在机器人底座坐标系中使用机器人臂运动学来确定。在一个示例中，末端执行器定位是当前定位，但是可选地，末端执行器定位可以是当机器人底座到达基准机器人底座定位时的预期定位，在这种情况下，末端执行器定位可以通过基于基准机器人底座定位变换当前末端执行器定位来确定。

该校正通常指示末端执行器与末端执行器路径的偏差，这又基于机器人底座与预期定位的偏差。因此，控制系统基于当前机器人底座定位和预期的机器人底座定位来计算机器人底座偏差，并且然后基于机器人底座偏差计算校正。预期的机器人底座定位可以基于基准机器人底座定位或者基于机器人底座路径的遍历来预期机器人底座处于的定位。附加地，在末端执行器在环境中保持静止的情况下，预期的机器人底座定位可以基于初始或先前的机器人底座定位。

基准机器人底座定位被用于允许末端执行器路径的计算考虑到机器人底座被预期在末端执行器移动开始和到达目的地之间移动。因此，虽然基准机器人底座定位可以是当前或初始机器人底座定位，但是更典型地，基准机器人底座定位是基于机器人底座沿着机器人底座路径的移动的预测的机器人底座定位。具体地，基准机器人底座定位优选地是当末端执行器到达末端执行器目的地时的预想的机器人底座定位。因此，将认识到，基准机器人底座定位可以基于到达目的地时机器人底座的预期定位来计算，使得末端执行器在机器人底座坐标系RBCS中沿着从当前定位到末端执行器目的地的直接路径移动。

当基准机器人底座定位基于交互期间的定位时，补偿只需要考虑机器人底座远离延伸到基准机器人底座定位的机器人底座路径的无意移动。但是将认识到，这并不是必需的，且可选地，校正可以考虑无意移动和有意移动。例如，可以基于初始机器人底座定位来计算末端执行器路径，利用末端执行器路径来补偿沿着机器人底座路径的移动。

在某些情况下，可能希望的是不使用DST来控制末端执行器的定位。例如，这种情况的示例仅在末端执行器与在机器人底座坐标系RBCS内的物体交互以从被安装在机器人底座上的传送机构取回物体时发生。在这种情况下，由于物体和末端执行器都随机器人底座移动，因此这不需要DST处于活动状态。

因此，可能需要激活和去激活DST机构，例如，当末端执行器从在机器人底座坐标系RBCS中收集物体变换到将物体放置在环境E中时，激活DST。由于机器人底座路径可能已经在正在被计算的末端执行器路径和正在被激活的DST之间经历了显著的移动，因此完全激活补偿机构可导致大的校正在被计算，这可能由于机器人臂动力学而不实际。

因此，在一个示例中，控制系统130基于当前末端执行器定位与末端执行器目的地的相对距离来缩放校正。特别地，缩放可以用来有效地转换DST的开和关。虽然可以使用任何形式的缩放，但是控制系统通常使用S形曲线缩放校正，以逐步应用校正。随着末端执行器接近目的地，这将逐渐启用校正并降低缩放比例的增加速率，从而减少大的末端执行器校正。

在一个特定示例中，控制系统130在分别在机器人底座坐标系RBCS和环境坐标系ECS中定义的第一末端执行器目的地和第二末端执行器目的地之间移动末端执行器113，其中控制系统基于当前末端执行器定位与第一末端执行器目的地和第二末端执行器目的地的相对距离缩放校正。因此，当末端执行器靠近第一末端执行器目的地时，不执行校正，而当末端执行器靠近第二末端执行器目的地时，执行完全校正。

在上面的示例中，提到了机器人底座和末端执行器的定位。然而，将认识到，DST也可以应用于末端执行器的定向，这意味着实际上上述过程是基于末端执行器和机器人底座的姿势来实现的，并且末端执行器目的地是末端执行器姿势的形式。

在该特定示例中，控制系统确定相对于机器人底座坐标系的末端执行器姿势，使用环境坐标系中的末端执行器姿势和基准机器人底座姿势计算末端执行器路径，使用来自跟踪系统的信号确定当前机器人底座姿势，并基于当前机器人底座姿势计算校正。在该示例中，校正通常是指示六个自由度中的每一个自由度的移动的向量的形式。然后，控制系统控制末端执行器姿势，从而在所有六个自由度上提供校正。

虽然上述示例集中于机器人底座移动的场景，但是将认识到，这不是必需的，并且当机器人底座静止并且环境相对于机器人底座移动时，可以实现相同的技术。

现在将参考图12描述使用动态坐标系稳定的过程的示例。

在该示例中，在步骤1200处，控制系统130使用与上述类似的技术获取末端执行器目的地。在步骤1210处，控制系统130确定基准机器人底座定位，该基准机器人底座定位通常在环境坐标系ECS中被确定，并且该基准机器人底座定位又可以对应于当前定位、预期发生交互的定位等。在步骤1220处，至少部分使用基准机器人底座定位来确定延伸到末端执行器目的地的末端执行器路径。

将认识到，上述步骤1200至1220通常类似于前面参照图10描述的等效步骤。然而，在该示例中，虽然末端执行器路径可以在机器人底座坐标系RBCS中被计算，但是更典型地，这是在环境坐标系ECS中使用基准机器人底座定位来执行的。

在步骤1230处，控制系统130使用来自跟踪系统120的信号确定当前机器人底座定位。这用于在步骤1240处计算机器人臂运动学，使得运动学考虑当前机器人定位，并且更典型地考虑与预期的机器人底座定位的偏差。具体地，在一个示例中，机器人底座定位被用作机器人臂运动学的原点，使得当机器人底座在环境坐标系内移动时，这允许机器人臂运动学的原点被更新，允许机器人臂在环境坐标系中被控制。

在步骤1250处，基于末端执行器路径和计算的机器人臂运动学生成控制信号，允许控制系统在步骤1260处将控制信号施加到机器人臂，从而导致机器人臂移动。然后，可以根据需要重复步骤1230至1260，例如直到到达末端执行器目的地为止。

因此，与计算指示末端执行器与规划路径的偏差的路径校正的先前示例相反，上述示例通过修改机器人臂运动学来操作。在一个特定示例中，这是通过以下方式来实现的：基于机器人底座从预期的机器人底座定位的移动来转换机器人臂运动链的原点，使得原点转换反映机器人底座的移动。然后，这修改了机器人臂的定位，使得机器人臂在相对于环境坐标系ECS移动的动态坐标系中被控制，并且使得末端执行器能够保持在末端执行器路径上。这样做的好处是避免了计算路径校正的需要，且从而降低了执行DST的计算复杂性。

然而，与此无关，机器人底座以较慢的动态响应移动，而机器人臂以及因此末端执行器以较快的动态响应移动，使得机器人臂的移动可以用于校正机器人底座远离预期的机器人底座定位的移动，使得末端执行器可以保持在期望定位。

现在将参考图13A至图13C描述具体的示例校正，图13A至图13C示出了附接到从机器人底座1311延伸的机器人臂1312的末端执行器1313。以下示例示出了仅在二个维度中操作的动态坐标系机构，但是将认识到，这可以延伸到六个自由度，并且仅参考二个维度并不旨在进行限制。

在该示例中，末端执行器相对于环境坐标系ECS保持在静止定位处，且因此基于具有有效零路径长度的零路径来控制计算的末端执行器路径。因此，如图13A所示，末端执行器1313最初被设置成与目的地1351一致。

如图13B所示，机器人底座经历无意移动，移动了箭头1361所示的距离，使得机器人底座现在偏离原始机器人底座坐标系RBCS。这产生了修改的机器人底座坐标系RBCS’，其可以作为运动学的原点的转换而被应用于机器人臂运动学，导致机器人臂运动学被重新计算，使得末端执行器如图13C所示移动，从而将末端执行器与目的地1351对准。

因此，对于具有零路径长度的末端执行器路径，所计算的机器人臂运动学将末端执行器返回到末端执行器目的地，从而在环境坐标系内保持末端执行器静止。特别地，当机器人臂的运动链的原点在环境坐标系中动态地转换时，末端执行器目的地被用于更新对于末端执行器保持静止所需的反向运动学(即，对于机器人臂的每个连杆的关节角度)，从而补偿机器人臂的移动原点。

将认识到，当使末端执行器1313沿着路径遍历时和/或当移动机器人底座1311时，可以应用类似的技术，且因此这将不再详细描述。然而，将认识到，对于具有非零路径长度的末端执行器路径，计算出的机器人臂运动学将末端执行器返回到末端执行器路径。在这点上，在机器人臂的运动链的原点转换时，控制系统确定在末端执行器路径上的期望的末端执行器定位，并计算在该路径上实现期望的末端执行器定位所需的反向运动学。在该示例中，机器人臂的运动链的动态原点和末端执行器目的地(其可以是沿着末端执行器路径的最终目的地或路径点)都在环境坐标系中被表示，这简化了对系统的控制。

在一个示例中，控制系统确定末端执行器定位，并且然后使用末端执行器定位计算末端执行器路径，使得末端执行器路径从末端执行器定位延伸到末端执行器目的地。

如上所述，末端执行器定位通常基于环境坐标系中的机器人底座定位使用机器人臂运动学来确定，允许在环境坐标系ECS中直接计算末端执行器路径，并且通过基于机器人底座的移动使机器人臂运动学的原点转换来在环境坐标系ECS中执行控制。

在另一个示例中，在环境坐标系中确定末端执行器目的地(即，期望的末端执行器定位)，且然后应用变换将期望的末端执行器定位变换到机器人底座坐标系RBCS中。这是可以实现的，因为机器人底座坐标系RBCS的原点由跟踪系统测量，并以环境坐标进行表示。在该示例中，然后可以通过计算将末端执行器移动到期望的末端执行器定位(其可以是沿着末端执行器路径的路径点或最终目的地)所需的反向运动学，在机器人底座坐标系RBCS中实现控制。

在一个示例中，末端执行器定位是当前定位，但是可选地，末端执行器定位可以是当机器人底座到达基准机器人底座定位时的预期定位，在这种情况下，末端执行器定位可以通过基于基准机器人底座定位变换当前末端执行器定位来确定。

典型地，控制系统通过基于当前机器人底座定位计算机器人底座移动来操作，且然后使用机器人底座移动来修改机器人臂运动学。该移动通常是基于延伸到机器人底座基准定位的机器人底座路径从初始或预期的机器人底座定位开始的移动。如在前面的示例中，基准机器人底座定位可以取决于当前机器人底座定位、基于机器人底座相对于当前机器人底座定位的移动的预测的机器人底座定位、基于机器人底座沿着机器人底座路径的移动的预测的机器人底座定位、或者当末端执行器到达末端执行器目的地时的预想的机器人底座定位。

与前面的示例一样，虽然只提到了定位，但是这些技术可适用于定位和定向。因此，末端执行器目的地通常包括末端执行器姿势，其中跟踪系统测量机器人底座姿势，以及控制系统使用来自跟踪系统的信号确定当前机器人底座姿势，并基于机器人底座姿势计算机器人臂运动学。在这种情况下，控制系统可以确定末端执行器姿势，并计算从末端执行器姿势延伸到末端执行器目的地的末端执行器路径。因此，将认识到，上述技术可以校正姿势的变化以及仅调整定位。

虽然上述示例集中于机器人底座移动的场景，但是将认识到，这不是必需的，并且当机器人底座静止并且环境相对于机器人底座移动时，可以实现相同的技术。此外，虽然描述仅集中于对无意移动的校正，但是将认识到，该布置也可以补偿机器人底座的有意移动。

现在将参考图14描述用于执行动态路径规划稳定的过程的示例。

在本示例中，基于机器人底座定位的移动，根据需要重新计算末端执行器路径。为了实现这一点，在步骤1400处，控制系统130获取末端执行器目的地。

在步骤1410处，机器人底座定位由控制系统130确定。然后，在步骤1420处计算末端执行器路径，该路径从末端执行器定位延伸到末端执行器目的地。该路径通常在机器人底座坐标系RBCS中计算，这是通过使用机器人底座定位将末端执行器目的地变换成机器人底座坐标系RBCS来实现的，但是可选地，路径可以在环境坐标系ECS中计算。

在步骤1430处，生成机器人控制信号，在步骤1440处，这些机器人控制信号被施加到机器人臂以使机器人臂移动。然后，根据需要重复步骤1410至1440，使得基于机器人底座定位不断地重新计算末端执行器路径，例如考虑机器人底座定位与机器人底座路径的偏差，从而将末端执行器朝向目的地移动。

现在将参考图15A至图15F描述许多不同的示例场景，图15A至图15F示出了附接到机器人臂1512的末端执行器1513，机器人臂1512又附接到机器人底座(为了清楚起见未示出)。以下示例将说明仅在二个维度中操作的动态路径规划机制，但是将认识到，这可以延伸到六个自由度，并且仅参考二个维度并不旨在进行限制。

在图15A所示的示例中，末端执行器路径具有零长度，从而保持相对于环境的静态末端执行器定位。因此，末端执行器1513最初与目的地1551对准。机器人底座的无意移动引入偏移量1561，这导致在步骤1430处计算新路径1562，这将末端执行器1513返回到目的地1551。

在图15C和图15D的示例中，末端执行器1513沿着末端执行器路径1555移动到目的地1551。在这种情况下，当末端执行器沿着路径1563移动时，无意移动产生偏移量1561。这导致计算将末端执行器返回到目的地1551的新路径1565。

图15E和图15F中示出了另一个示例，其包括沿着末端执行器路径1555移动末端执行器，同时沿着机器人底座路径1553移动机器人底座。在这种情况下，基准机器人底座定位在图15E中以虚线示出，使得末端执行器路径1555最初被计算为从基准机器人底座定位垂直向下到目的地1551。由末端执行器路径1555和机器人底座路径1553的组合形成的净路径1556导致末端执行器从当前末端执行器定位移动到目的地1551。

在这种情况下，如1563所示，当机器人底座和末端执行器沿着净路径移动时，产生了如1561所示的无意移动。在这种情况下，根据更新的基准机器人底座定位计算新路径1565，当更新的基准机器人底座定位与机器人底座移动结合时，产生新的净路径1565。

将认识到，尽管上述技术需要不断地重新计算路径，这通常比先前描述的DST布置计算成本更高，但这可能有好处。例如，末端执行器穿过的路径倾向于以更直接的方式朝向目的地行进，这可以产生降低的路径校正次数和/或减少的路径距离。附加地或可选地，通过减少所需的校正次数，这避免了末端执行器路径围绕目标路径摆动以校正机器人底座的移动，这可以减少方向上急剧变化的需要，这反过来有助于确保路径在机器人动力学的约束范围内，且因此可以更容易地被实现。

如上所述，在一个示例中，末端执行器目的地通常相对于环境坐标系定义，在这种情况下，控制系统通过至少部分使用机器人底座定位将末端执行器目的地从环境坐标系ECS变换到机器人底座坐标系RBCS来计算变换的末端执行器目的地。然后，可以计算延伸到机器人底座坐标系中的变换的末端执行器目的地的末端执行器路径。然而，可选地，路径计算可以在环境坐标系ECS中被执行。

在一个示例中，控制系统确定末端执行器定位，并且然后使用末端执行器定位计算末端执行器路径，使得末端执行器路径从末端执行器定位延伸到末端执行器目的地。末端执行器定位通常在机器人底座坐标系中使用机器人臂运动学来确定。

将认识到，当前机器人底座定位可以考虑机器人底座沿着机器人底座路径的移动。因此，在这种情况下，末端执行器路径将基于基准机器人底座定位来计算，以考虑机器人底座沿着机器人底座路径的移动，其中末端执行器路径基于机器人底座定位与机器人底座路径的偏差来计算。

如在前面的示例中，机器人底座以较慢的动态响应移动，而末端执行器以较快的动态响应移动，使得末端执行器的移动可以用于校正机器人底座远离预期的机器人底座定位的移动。

虽然以上仅参考定位进行了描述，但是将认识到，这些技术也可适用于定位和定向。因此，在一个示例中，末端执行器目的地包括末端执行器姿势，并且跟踪系统测量机器人底座姿势。在该示例中，控制系统使用来自跟踪系统的信号确定机器人底座姿势，并基于当前底座姿势计算末端执行器路径。在一个特定示例中，控制系统确定相对于机器人底座坐标系的末端执行器姿势，并使用来自跟踪系统的信号确定当前机器人底座姿势，使用这两者来计算末端执行器路径。

虽然上述示例集中于机器人底座移动的场景，但是将认识到，这不是必需的，并且当机器人底座静止并且环境相对于机器人底座移动时，可以实现相同的技术。

在上述示例中，机器人臂致动器以快速动态响应移动，以补偿机器人底座的移动或定位误差，以便精确定位和稳定机器人臂的末端执行器。除了这种补偿之外，在一些示例中，控制系统还监测机器人底座的定位，并以慢速动态响应来控制机器人底座致动器，以使机器人底座朝向其预期或理想定位移动。这种附加的校正可以减少机器人臂致动器所需的补偿量，并且对于将机器人臂保持在其工作包络面(working envelope)内以便将末端执行器定位在其目的地特别有用。虽然机器人底座致动器和机器人臂的动态补偿可以一起实现，但是这不是必需的，并且一项可以在没有另一项的情况下被执行。

在一个示例中，控制系统包括计算机数控(CNC)系统。在这点上，CNC系统可以形成为独立模块，被实现为软件、固件、硬件或其组合。在该实例中，附加的功能可以由其他模块来计算。例如，系统可以实现与CNC模块对接的DST模块，以允许系统被控制。例如，DST模块可以计算校正或机器人臂运动学原点转换，将此提供给CNC模块以允许机器人臂被控制。

在以上所有示例中，尤其是在实现DST时，重复这些步骤以不断更新或校正机器人底座的移动。对于控制系统的处理周期，尤其是控制系统的连续处理周期，这通常是重复的。因此，可以为控制系统的每个时钟周期计算新的校正、机器人臂运动学原点转换或新的路径。在另一示例中，这也基于跟踪系统的刷新率来执行，使得每次跟踪系统更新机器人底座定位时都计算新的校正等。由此可以理解，在一个优选示例中，控制系统的处理周期和跟踪系统的刷新率具有相同的频率，且甚至更优选地是时间同步的。

控制信号通常在考虑末端执行器速度分布、机器人动力学和/或机器人运动学的情况下被生成。这样做是为了确保机器人臂能够执行必要的运动。例如，计算出的末端执行器路径可能超过机器人臂的能力，例如需要不可行的移动变化，或者需要以实际上无法实现的速率移动。在这种情况下，可以重新计算路径以确保其可以被执行。

在一个示例中，这可以通过执行对应于原始规划移动的移动来实现，但是所执行的移动在幅度上被限制为可行的移动。在该实例中，如果需要进一步的移动，这可以在连续的处理周期中被实现。

现在将参考图16A至图16C来描述整体控制方法的示例，在该整体控制方法中使用动态补偿结合主动阻尼来执行DST。出于这个示例的目的，假设该系统类似于上面参考图1A和图1B描述的系统，其中机器人臂被安装在吊臂上。

在该示例中，在步骤1600处机器人底座路径被检索。将理解的是，这可以包括计算机器人底座路径。

在一个示例中，这被执行，使得路径形状和速度(velocity)分布被仔细地控制，以最小化机器人底座速度的变化，这又可以被用于避免不连续(例如阶梯式或急剧的速度变化)。突然的速度变化(例如增加或降低机器人底座移动的速率(speed)，或者改变移动的方向)可以在机器人底座致动器内诱导(例如吊臂组件的吊臂)振动。这又会导致机器人底座更大的无意移动，包括更多的移动和/或更大幅度的移动，使得更难以进行校正机器人底座的移动的阻尼和/或DST并确保末端执行器被设置在正确的定位处。

为了最小化速度变化(包括速率和/或方向变化)的幅度，可以使用许多不同的方法。在一个示例中，机器人底座路径是弯曲的和/或被配置为允许机器人底座在执行交互的同时逐渐移动，使得机器人底座不必停止。

附加地和/或替代地，路径规划可以考虑指示执行交互的时间的交互时间，该交互时间然后被用于计算机器人底座路径速度分布，并且可选地定义交互窗口，该交互窗口然后可以被用于动态地控制机器人底座。在这点上，交互窗口通常对应于环境中在末端执行器目的地周围的区域，虚拟机器人底座可以设置在该区域中，同时仍然允许执行交互，并且因此这允许例如根据交互的完成状态来控制机器人底座在遍历机器人底座路径时的机器人底座的速度。

交互窗口通常基于交互时间和速度来确定，使得执行交互(例如拾取物体或放置物体)所需的时间对应于以所定义的机器人底座路径速度分布遍历交互窗口所花费的时间。在一个特定示例中，基于围绕目的地的设定距离来定义交互窗口，该设定距离是例如基于机器人臂运动学和/或动力学(例如末端执行器的可及范围和或速度)而导出的。

在定义了交互窗口之后，然后可以使用这些交互窗口，以便控制机器人底座和末端执行器的移动，且特别是确保交互在不需要离散速度变化的情况下完成。例如，控制系统可以监测末端执行器交互以确定完成状态，并且根据监测的结果选择性地修改机器人底座控制信号以使机器人底座以不同的速度移动。

在一个特定示例中，当机器人底座路径包括与每个末端执行器目的地相关联的交互窗口时，随着机器人底座进入交互窗口，控制系统可以控制机器人臂开始交互和/或末端执行器沿着末端执行器路径到末端执行器目的地的移动。然后，控制系统可以通过确定在机器人底座接近交互窗口的出口时交互是否将完成来监测交互，可选地逐渐降低机器人底座速度以确保在机器人底座到达交互窗口的出口时交互完成。

因此，上述布置操作以计算避免方向或速率的不连续和/或突然或急剧变化的路径，从而最小化机器人底座的无意移动，例如不希望的振动或其他移动。附加地和/或替代地，上述方法在环境内执行交互的过程期间使用交互窗口来控制机器人底座速率。在这点上，基于执行交互所花费的时间，交互窗口与路径速度分布一起被定义，使得交互可以在不偏离速度分布的情况下被执行。在操作中，交互的完成被监测，如果交互进行得落后于计划，则机器人底座沿着机器人底座路径的移动逐渐减慢。这样做是为了确保交互可以在机器人底座退出交互窗口之前被执行。

此外，在该示例中，假设交互包括多个步骤，其中控制系统通过监测步骤的完成来监测交互。作为该过程的一部分，控制系统确定用于下一步骤的末端执行器路径，且然后生成控制信号以移动末端执行器，从而完成该步骤。例如，这些步骤可以包括将末端执行器移动到末端执行器目的地，且然后将末端执行器返回到起始定位、原定位或基准定位。因此，在砌砖的情况下，交互可以包括从安装在吊臂和/或机器人底座上的提交机构(presentation mechanism)收集砖块，在返回末端执行器以允许收集下一个砖块之前，将末端执行器和砖块移动到环境中的目的地以允许砖块被铺设。

在步骤1602处，获取跟踪系统信号，这些跟踪系统信号被用于在步骤1604处确定当前机器人底座姿势。具体地，这将基于跟踪目标姿势来计算，并使用几何变换来变换成当前机器人底座姿势。在一个示例中，机器人底座姿势是虚拟机器人底座姿势，其物理上偏离机器人底座，并与末端执行器对准，这对于允许机器人底座被更加容易地定位以便允许交互被执行可以是有益的。

例如，当计算机器人底座路径时，控制系统可以仅获取末端执行器目的地，并且然后使用该目的地以及跟踪目标定位来定义机器人底座路径，使得机器人底座遍历环境到达适于执行交互的定位。具体地，这可用于将末端执行器与末端执行器目的地对准，从而降低末端执行器路径的复杂性和对末端执行器的显著控制的需要。

附加地和/或替代地，这可以有助于路径规划。例如，使用与末端执行器对准的虚拟机器人底座定位对机器人底座的路径规划和/或对其移动的跟踪可以帮助避免末端执行器与环境或其中设置的对象或材料的碰撞。

在步骤1606处，确定是否到达交互窗口，如果未到达交互窗口，则过程前进到步骤1630。否则，假设已经到达交互窗口，则在步骤1608处选择下一步骤，其中在步骤1610处例如使用图10的步骤1000至1030计算和/或检索末端执行器路径。

在步骤1612处，确定是否需要稳定，如果不需要稳定，例如如果该步骤包括从安装在机器人底座上的输送机构取回物体，则过程进行到步骤1624。

否则，在步骤1614处，基于根据机器人底座路径计算的在当前机器人底座姿势和预期的机器人底座姿势之间的偏差来计算机器人底座姿势偏差。然后，在步骤1616处，基于末端执行器与末端执行器目的地的接近度，确定缩放因子。在步骤1618处，机器人底座偏差用于计算向量形式的校正，该向量包括关于六个自由度中每一个自由度的偏移并表示机器人底座姿势与预期的机器人底座姿势的偏移。然后，根据缩放因子对校正进行缩放。

与此同时，在步骤1617处，基于机器人底座的移动计算主动阻尼响应。然后将这与校正一起使用，从而修改校正，使得校正考虑到阻尼效果。

在步骤1620处，使用末端执行器路径和缩放的校正来计算机器人运动学变换，在步骤1622处，对机器人运动学变换进行评估以确保动力学是可行的。在这点上，校正可能需要机器人臂经历超出机器人臂的能力的移动，例如需要过快的移动。如果该移动是不可行的，则可以例如通过基于机器人臂动力学来限制产生的校正幅度而重新计算或修改该移动。在一个示例中，这是通过返回到步骤1618以重新计算校正来实现的。然而，这不是必需的，并且在一个示例中，在步骤1624处，可以基于机器人臂动力学生成控制信号，以在控制系统的下一个处理周期之前简单地实现最大可能程度的校正。因此，如果校正需要10mm的末端执行器移动，但是在由控制器实现的下一个处理周期之前只能实现5mm的移动，那么将实现5mm的移动。

此时，控制系统130可以在步骤1626处确定交互是否按计划进行，如果没有按计划进行，则控制系统130在步骤1628处修改吊臂速率，例如减慢吊臂的移动。无论吊臂速率是否被修改，在步骤1630处，控制系统130都生成所产生的吊臂控制信号。

然后在步骤1632处将控制信号施加到各个致动器，并在步骤1631处将控制信号施加到阻尼系统，从而移动吊臂和末端执行器，并执行阻尼。在步骤1634处获取跟踪系统信号，在步骤1636处，随着末端执行器和机器人底座的移动，跟踪系统信号被用于确定当前底座姿势。

在步骤1638处，评估该步骤是否完成，如果没有完成，则过程返回到步骤1612以再次确定是否需要稳定。否则，在步骤1640处确定是否所有步骤都完成，如果没有，则过程返回到步骤1608以选择下一步骤。否则，过程返回到1606，以确定是否已经到达下一个交互窗口。

将认识到，通过遵循上述顺序，这允许吊臂沿着吊臂路径逐渐移动，其中通过执行一系列步骤来执行交互，每个步骤包括确定末端执行器路径，其中末端执行器沿着末端执行器路径移动到目的地。

虽然图16A至图16C的示例聚焦于动态补偿的使用，但是将认识到，类似的方法可以用于针对结合主动阻尼的DST的动态坐标系和动态路径规划方法。

上述阻尼布置在许多需要对大作业体积进行精细定位和运动控制的应用中是有用的。

下面给出了一些示例应用：

船(ship)转移

船至船、或船至石油钻机、或船至天然气钻机、或船至风力涡轮机的货物、液体或人员的转移是本发明的控制系统的潜在应用。已知使船只(vessel)稳定用于定位保持。也已知用陀螺仪或推进器使船只横滚(roll)稳定。已知用推进器使船只偏航(yaw)稳定。还已知向工作设备(例如吊臂)提供升沉(heave)、俯仰(pitch)、横滚和偏航补偿。

然而，已知对于在汹涌海面状况中的长吊臂，现有的补偿方法有局限。粗略的吊臂定位和精细的末端执行器定位或者甚至精细定位的额外阶段将在更大的海面状况和更恶劣的天气下实现更安全的转移、挂钩、断开和操作。

对于需要或希望在所有天气条件下将东西从一艘船只转移到另一艘船只或者从一艘船只转移到固定对象的石油化学产品、可再生能源和军事操作者(以及其他人)，这可能有很大的好处。

长建筑物

长结构(例如高速公路的隔音墙)可以用砌砖机来建造。按照传统的布置，必须从一个位置建造，然后周期性地重新定位，并且从下一个固定位置建造。能够从爬行机建造将是有利的。这将减少重新定位损失的时间，并将实现具有更短吊臂的更小更紧凑的机器。带有短吊臂的履带式机器将是理想的。提供了多个固定地面基准以便于此。

长挖沟

用于基础设施(例如地下管线和地下电缆)的长沟槽可以用已知的(例如由DitchWitch或Vermeer制造的)连续挖沟机挖掘，或者对于更大横截面的沟槽用(例如由Caterpillar、Volvo、John Deere、Komatsu和其他制造的)挖掘机挖掘。对于许多应用(例如对于污水管道)，沟槽和管道的精确坡度和位置很重要。对于许多应用(例如在城市中)，知道精确定位很重要，以避免损坏现有的基础设施，例如管道、电缆、地基以及地下列车和公路隧道。当前的系统允许对挖掘进行某种控制，并向操作者提供挖掘深度或铲斗定位的反馈。在当前系统中，机器的底座(轨道)必须是固定的。

所描述的动态控制系统允许精确挖掘到目前其他方法无法实现的公差。此外，它允许预先编程的挖掘，以用于完全自主的操作。此外，它允许从连续移动的机器(例如沿着所提议的沟槽的路径爬行的履带式挖掘机)精确挖掘。

地面修整

已知使用平地机、推土机、装载机、挖掘平整机或自动刮板机来用推土板或铲斗使泥土或混凝土表面平滑。机器的固有设计将实现比它移动过的表面更平坦的表面，因为机器的几何结构提供平滑作用。已知使用自动控制将铲斗或推土板保持于预定的水平、坡度或轮廓可实现更准确和更快的结果。推土板或铲斗围绕横滚轴自动向上或向下移动或倾斜，以保持激光平面水平或坡度，或与由GPS或全站仪(total station)测量作为基准的轮廓相匹配。这些已知的控制系统具有低带宽，并且机器实现准确的结果，因为机器的固有设计将实现比它在上面行驶的表面更平坦的表面，即使没有机器引导。

本发明允许更复杂的机器布置(例如(经修改的)挖掘机)装配有多轴控制的推土板或铲斗，以用完全可编程的方式实现非常复杂的土方作业。

采矿

已知对采矿使用自动卡车。

挖掘机和正铲挖土机目前由机器操作员操作。该技术通过按照矿井坐标对底座移动(轨道底座)和挖掘程序进行预先编程来实现挖掘机和正铲挖土机的自主控制。

疏浚

安装在驳船上的挖掘机用于疏浚。疏浚通道深度、宽度、剖面和位置对航运安全极为重要。疏浚是昂贵的，因此使移动的废土的量最小化是有利的。疏浚越精确，越少的废土需要被移除。

驳船是漂浮的，因此当挖掘机移动时，驳船俯仰且横滚且移动。以6dof实时地测量驳船定位和定向使铲斗定位能够(经由测量挖掘机的姿势的已知传感器)被精确地计算、或者甚至被控制到一组预先编程的挖掘位置。

高架工作平台

已知使用各种高架工作平台(EWP)，例如吊臂升降机或剪式升降机或由诸如JLG、Snorkel和Genie的制造商制造的垂直伸缩升降机。已知非常高的吊臂升降机以大的幅度摇摆，且使工作变得困难、危险或不可能。摇摆是吊臂升降机可工作的高度的限制因素。已知在平台上升的情况下驱动吊臂升降机或EWP引起摇摆，并使平台变得不舒适或危险。本发明提供了获得稳定平台的手段，使得当平台或EWP移动时，平台相对于地面或期望的轨迹是稳定的。

缆索悬挂式机器人

已知在由处于拉伸的缆索悬挂的平台上支撑机器人，缆索由高架门架或塔支撑(见PAR系统-张拉桁架和Chernobyl起重机以及拆除机器人)。绳索可以支撑高载荷，但结构具有低刚度。横向刚度非常低。通过将跟踪部件添加到悬挂的平台以提供机器人臂的底座的6DOF定位，机器人和末端执行器的定位的精度将大大提高。这将使这样的系统能够完成精确的工作，而不是它目前被用来完成的相对不精确的拆除工作。

非常精确的应用

这种系统可以包括检流计振镜，其与高功率激光器一起使用于激光切割、激光雕刻或3D增材激光熔化制造。

将认识到，还设想广泛的其他用途。例如，该系统可用于执行多层和/或高层建筑物的建造。在这点上，在建造期间，机器人底座可以由建筑物支撑或远离建筑物，该系统被用于补偿机器人底座相对于建筑物的移动，该移动可能是由建筑物的风荷载和/或用于支撑机器人底座的支撑系统引起的。

该系统还可以与上面提到的那些交通工具之外的广泛的其他交通工具(例如空间飞行器)一起使用。在该示例中，机器人底座可以安装在空间飞行器上，允许其用于执行与另一交通工具的交互(例如促进对接、卫星取回等)或者与其他物体的交互(例如与小行星或类似物体的交互)。

在一个示例中，该系统使用具有定位设备、测量系统和控制通道的级联系统。在一个实施例中，大范围的不准确总运动系统引导支撑大面积粗定位吊臂的交通工具，该粗定位吊臂然后支撑小动态补偿和精细定位机器人，该机器人然后又支撑甚至更精细的动态补偿和定位机构。

在一个示例中，该系统描述了移动机器和稳定末端执行器的动态坐标系和方法。在优选实施例中，提供了使补偿转变为开启和关闭或衰减转变的方法，使得移动末端执行器的机器人臂可以按照头部坐标系和地面或工作坐标系交替地工作。

将运动学变换编码为独立的软件是有利的。这意味着CNC内核不必须被修改来适应不同的运动链。通过使用动态坐标系作为末端执行器机器人运动链的底座，末端执行器可以按照工作坐标系被编程，且进行所有正常CNC坐标转换和变换，诸如对于工作坐标的偏移和坐标系旋转。

对于机器人臂的运动链的底座的动态坐标系，补偿量的概念是抽象的。如果机器人臂的运动链的底座在它的编程位置处，则没有补偿量，且机器人臂将处于第一姿势。如果底座在它的实际位置处且机器人臂处于第一姿势，则末端执行器将在错误位置处(且在错误的定向上)，差异是补偿量。

在一个示例中，提供了一种用于由臂底座支撑的臂的控制系统，所述臂具有从其安装的末端执行器，所述末端执行器具有由另一臂底座支撑的另一臂，且所述另一臂具有安装在其上的另一末端执行器，所述臂通过与臂致动器连接的臂控制器相对于所述臂底座可移动以将所述末端执行器定位到经编程的位置，所述另一臂通过与另一臂致动器连接的另一臂控制器可移动以将所述另一末端执行器定位在经编程的定位处；所述控制系统具有跟踪器系统，以跟踪定位在邻近所述另一臂底座或末端执行器的一偏移量的第一目标的定位，并且跟踪以与所述另一末端执行器相距TCP偏移量定位的第二目标的定位和定向；其中，所述跟踪器系统跟踪所述第一目标的定位，并将数据馈送到所述臂控制器，以用慢速动态响应来操作所述臂致动器，以将所述第一目标动态地定位成接近所述偏移量，以将所述另一臂底座定位成接近所述经编程的位置，并且所述跟踪器系统跟踪所述第二目标的定位和定向，并将数据馈送到所述另一臂控制器以用快速动态响应来操作所述另一臂致动器，以将所述第二目标动态地定位并可选地定向到离所述经编程的定位和可选地定向的所述TCP偏移量。TCP偏移量可以由定位和可选地定向数据定义。在慢速动态响应和快速动态响应之间的差异与臂和另一臂的潜在惯性成反比。在另一臂比该臂小得多的情况下，该另一臂将具有较小的潜在惯性，并且可以用相对快速的动态响应来移动。

在一个示例中，所述第二目标以与所述另一末端执行器相距所述TCP偏移量来定位，以便随着所述另一末端执行器的移动和姿势来移动。在这种情况下，TCP偏移量由定位和定向数据定义，并且所述跟踪器系统测量所述第二目标的定位和定向。

通过“接近”所述经编程的位置，另一臂底座被移动得足够近，使得另一末端执行器在它的编程任务的范围内，即，另一臂可以将另一末端执行器移动到一个定位，以便可以完成另一末端执行器将要执行的任务。通过动态地定位以及动态地定位和定向，应该理解，当另一臂底座的定位由于偏转而变化时，它的定位(和在适用情况下的定向，见下文)一直处于检查状态，且由臂致动器以慢速动态响应来调整，并且另一末端执行器的定位和定向也一直处于检查状态，且由另一臂致动器以快速动态响应来调整。

在一个示例中，所述另一臂底座靠近所述臂的远端、远离所述臂底座被安装。

在一个示例中，所述另一臂底座和所述第一目标安装在被安装到臂的远端的头部上。

在一个示例中，所述头部枢转地安装到臂的远端。

在一个示例中，所述头部绕水平轴枢转地安装到臂的远端。

在一个示例中，所述跟踪器系统跟踪所述第一目标的定位和定向，并且将数据馈送到所述臂控制器，以用慢速动态响应操作所述臂致动器，以将所述第一目标定位并定向成接近所述偏移量，以将所述另一臂底座定位成接近所述经编程的位置。

在头部枢转地安装到臂的远端的情况下，头部的姿态(poise)可以由与臂控制器分离的控制器控制，在这种情况下，臂控制器只需要操作臂致动器来沿着三个正交轴定位第一目标。然而，对于头部的姿态的控制可以集成到臂控制器中，在这种情况下，可以跟踪第一目标的定位和定向。

在头部绕多轴机构枢转地安装到臂的远端的情况下，可以以六个自由度跟踪第一目标的定位和定向。可以以六个自由度跟踪第二目标的定位和定向。

在一个示例中，所述跟踪器系统包括用于所述第一目标和所述第二目标的单独目标跟踪设备。

在一个示例中，所述另一臂控制器可以可控地在第一状态和第二状态之间切换，在第一状态中所述另一臂控制器对从所述跟踪器系统得到的定位反馈数据做出响应，而在第二状态中以另一臂底座(以及因此，臂的远端)为基准的预先校准的定位数据被依赖，并且当在所述第一状态和所述第二状态之间切换时，所述另一臂控制器控制所述另一臂的移动，以衰减另一臂的移动，从而避免所述另一臂和所述另一末端执行器的突然移动。这种突然移动可被反馈给臂，使臂经历反应移动。

在一个示例中，所述臂底座设置有移动装置，以相对于地面移动所述臂底座。移动装置可以选自包含或未包含运移作用(locomotion)的轮式运输工具或者自供电的环形履带。移动装置可以包含自调平以使臂底座调平。

在一个示例中，所述臂底座安装在主动悬架系统上，并且所述臂底座包含用于所述跟踪器系统的第三目标，所述主动悬架系统具有与悬架致动器连接的悬架控制器，以响应于来自读取所述第三目标的定位和定向的所述跟踪器系统的数据来控制所述臂底座的定位和定向。

可选地，所述臂底座安装到具有比在主动悬架系统上的所述臂更大的惯性的物体上，并且所述臂底座包含用于所述跟踪器系统的第三目标；所述主动悬架系统具有与悬架致动器连接的悬架控制器，以响应于来自读取所述第三目标的定位和定向的所述跟踪器系统的数据来控制所述臂底座相对于所述物体的定位和定向，所述悬架致动器以比所述臂控制器操作所述臂致动器更慢的动态响应来控制所述臂底座的定位。

在另一个示例中，提供了一种用于由吊臂底座支撑的吊臂的控制系统，所述吊臂具有通过从其机器人底座安装的机器人臂，所述机器人臂具有末端执行器，所述吊臂通过与吊臂致动器连接的吊臂控制器相对于所述吊臂底座可移动以将所述机器人底座定位到经编程的位置，所述机器人臂通过与机器人臂致动器连接的机器人臂控制器可移动以将所述末端执行器定位在经编程的定位和定向处；所述控制系统具有跟踪器系统，以跟踪定位在靠近所述机器人底座一偏移量的第一目标的定位，并且跟踪以与所述末端执行器TCP相距TCP偏移量定位的第二目标的定位和定向；其中，所述跟踪器系统跟踪所述第一目标的定位，并将数据馈送到所述吊臂控制器，以用慢速动态响应来操作所述吊臂致动器，以将所述第一目标动态地定位成接近所述偏移量，以将所述机器人底座定位成接近所述经编程的位置，并且所述跟踪器系统跟踪所述第二目标的定位和定向，并将数据馈送到所述机器人臂控制器，以用快速动态响应来操作所述机器人臂致动器，从而将所述第二目标动态地定位和定向成离所述经编程的定位和定向所述TCP偏移量。TCP偏移量可以由定位和定向数据定义。

在一个示例中，所述第二目标以相对于所述末端执行器TCP的所述TCP偏移量来定位，以便随着所述末端执行器的移动和姿势而移动。

通过“接近”所述经编程的位置，机器人底座被移动得足够近，使得末端执行器在它的编程任务的范围内，即，机器人臂可以将末端执行器移动到一个定位，以便可以完成末端执行器将要执行的任务。通过动态地定位以及动态地定位和定向，应该理解，当机器人底座的定位由于偏转而变化时，它的定位(以及在适用情况下的定向，见下文)一直处于检查状态，且由吊臂致动器以慢速动态响应来调整，并且末端执行器的定位和定向也一直处于检查状态，且由机器人臂致动器以快速动态响应来调整。

在一个示例中，所述机器人底座被安装成靠近所述吊臂的远端、远离所述吊臂底座。

在一个示例中，所述机器人底座和所述第一目标安装在被安装到吊臂的远端的头部上。

在一个示例中，所述头部枢转地安装到吊臂的远端。

在一个示例中，所述头部绕水平轴枢转地安装到吊臂的远端。

在一个示例中，所述跟踪器系统跟踪所述第一目标的定位和定向，并且将数据馈送到所述吊臂控制器，以用慢速动态响应来操作所述吊臂致动器，以将所述第一目标定位和定向成接近所述偏移量，以将所述机器人底座定位成接近所述经编程的位置。

在头部枢转地安装到吊臂的远端的情况下，头部的姿态可以由与吊臂控制器分离的控制器控制，在这种情况下，吊臂控制器只需要操作吊臂致动器，以沿着三个正交轴定位第一目标。然而，对于头部的姿态的控制可以被集成到吊臂控制器中，在这种情况下，第一目标的定位和定向可以被跟踪。

在头部绕多轴机构枢转地安装到吊臂的远端的情况下，可以以六个自由度来跟踪第一目标的定位和定向。可以以六个自由度跟踪第二目标的定位和定向。

在一个示例中，所述跟踪器系统包括用于所述第一目标和所述第二目标的单独目标跟踪设备。

在一个示例中，所述机器人臂控制器可以可控地在第一状态和第二状态之间切换，在第一状态中所述机器人臂控制器对从所述跟踪器系统得到的定位反馈数据做出响应，而在第二状态中以机器人底座(和因此，吊臂的远端)为基准的预先校准的定位数据被依赖，并且当在所述第一状态和所述第二状态之间切换时，所述机器人臂控制器控制所述机器人臂的移动，以衰减机器人臂的移动，从而避免所述机器人臂和所述末端执行器的突然移动。这种突然移动可被反馈给吊臂，使吊臂经历反应移动。

在一个示例中，所述吊臂底座设置有移动装置，以相对于地面移动所述吊臂底座。该移动装置可以是从包含或未包含运移作用的轮式运输工具或自供电的环形履带中选出的交通工具。该移动装置可以包含自调平以使吊臂底座调平。这种自调平应该移动吊臂底座，以使吊臂底座和因此的吊臂稳定，抵抗在由交通工具经过的地面中的波动引起的吊臂底座的定位和定向的变化。

在一个示例中，所述吊臂底座被安装在主动悬架系统上，并且所述吊臂底座包含用于所述跟踪器系统的第三目标，所述主动悬架系统具有与悬架致动器连接的悬架控制器，以响应于来自读取所述第三目标的定位和定向的所述跟踪器系统的数据，来控制所述吊臂底座的定位和定向。

可选地，所述吊臂底座安装到具有比在主动悬架系统上的所述吊臂更大的惯性的物体上，并且所述吊臂底座包含用于所述跟踪器系统的第三目标；所述主动悬架系统具有与悬架致动器连接的悬架控制器，以响应于来自读取所述第三目标的定位和定向的所述跟踪器系统的数据来控制所述吊臂底座相对于所述物体的定位和定向，所述悬架致动器以比所述吊臂控制器操作所述吊臂致动器更快的动态响应来控制所述吊臂底座的定位。

控制系统可以包括在机器上的不同定位处的多个跟踪器部件，使得跟踪器(或多个跟踪器)具有到由机器所支撑的一个或更多个跟踪器部件的视线。

在一个示例中，机器的控制系统包括评估视线的算法，以便可以选择在特定姿势下在跟踪器和跟踪器部件之间的最佳视线。最佳视线的标准包括：最准确的定位和定向解决方案(其可取决于跟踪器或其传感器的姿势)、跟踪器或传感器的视场、到末端执行器的距离(越近越好)、在经编程的路径或关键操作期间始终保持视线。

在一个示例中，所述机器包括在所述机器人臂上或在所述末端执行器上支撑的另一跟踪器部件，并且所述机器使用另一跟踪器系统来测量另一跟踪器部件的定位，并且向机器人臂组件施加另一补偿移动，以校正在所编程的另一跟踪器部件定位和所测量的另一跟踪器部件定位之间的变化。

吊臂底座可以是交通工具，其可以包括在交通工具上的定位处的跟踪器部件或者在交通工具上的各种定位处的多个跟踪器部件。跟踪器部件(多个跟踪器部件)可用于确定交通工具相对于工作空间坐标系的定位和定向。跟踪器部件(多个跟踪器部件)可用于确定用于移动交通工具的交通工具的定位和定向。跟踪器系统可以包括多个地面基准，以在交通工具沿着路径前进时跟踪跟踪器目标。

以上所述的布置可以在大尺寸的工作空间上实现高程度的动态运动质量和定位公差。这导致位于长吊臂或塔的末端处或在长缆索桁架上支撑的末端执行器的运动更加平稳。本发明的布置可以使由移动交通工具支撑的长吊臂或塔所支撑的末端执行器的运动平稳。

申请人技术的进一步细节在以下专利出版物和共同未决申请中被描述：US8166727、PCT/AU2008/001274、PCT/AU2008/001275、PCT/AU2017/050731、PCT/AU2017/050730、PCT/AU2017/050728、PCT/AU2017/050739、PCT/AU2017/050738、PCT/AU2018/050698、AU2017902625、AU2017903310、AU2017903312、AU2017904002和AU2017904110，这些文件的内容通过交叉引用被并入本文。

在整个本说明书和随附的权利要求中，除非上下文另有要求，否则措辞“包括(comprise)”以及变型例如“包括(comprises)”或“包括(comprising)”，将被理解为暗示包括陈述的整体或整体的组或步骤但不排除任何其它的整体或整体的组。如本文所用且除非另有说明，术语“大约”是指±20％。

本领域的技术人员将认识到，多种变型和修改将变得明显。对本领域的技术人员变得明显的所有的这样的变型和修改应当被认为落在本发明在描述之前宽泛地表现的精神和范围内。

Claims (21)

1.一种用于在物理环境内执行交互的系统，所述系统包括：

a)机器人底座；

b)机器人底座致动器，所述机器人底座致动器相对于环境移动所述机器人底座；

c)机器人臂，所述机器人臂被安装到所述机器人底座，所述机器人臂包括被安装在所述机器人臂上的末端执行器；

d)跟踪系统，所述跟踪系统测量以下项中的至少一项：

i)机器人底座定位，所述机器人底座定位指示所述机器人底座相对于环境的定位；和，

ii)机器人底座移动，所述机器人底座移动指示所述机器人底座相对于环境的移动；

e)主动阻尼系统，所述主动阻尼系统主动衰减所述机器人底座相对于环境的移动；以及，

f)控制系统，其：

i)根据来自所述跟踪系统的信号确定移动校正；和

ii)至少部分地根据所述移动校正来控制所述主动阻尼系统。

2.根据权利要求1所述的系统，其中，所述控制系统使用以下项中的至少一项来确定所述移动校正：

a)基于所述机器人底座相对于机器人底座路径的移动的路径偏差；

b)基于当前机器人底座定位和预期的机器人底座定位的定位偏差；

c)基于机器人底座定位的变化的移动；

d)基于机器人底座定位的变化率的加速度；

e)基于机器人底座定位相对于预期的机器人底座定位的变化的移动偏差；以及，

f)基于机器人底座定位相对于预期的机器人底座定位的变化率的加速度偏差。

3.根据权利要求1或权利要求2所述的系统，其中，所述主动阻尼系统耦合到以下项中的至少一项：

a)所述机器人底座；和，

b)所述机器人底座致动器。

4.根据权利要求1至3中的任一项所述的系统，其中，所述主动阻尼系统生成与以下项中的至少一项相反的原动力：

a)所述机器人底座的无意移动；以及，

b)所述机器人底座远离机器人底座路径的移动。

5.根据权利要求1至4中的任一项所述的系统，其中，所述主动阻尼系统包括以下项中的至少一项：

a)自适应结构构件；

b)惯性致动器；

c)线性惯性致动器；

d)旋转惯性致动器；

e)用于喷射加压流体的至少一个喷嘴；

f)安装在所述机器人底座上的至少一个风扇；以及，

g)所述末端执行器。

6.根据权利要求1至5中的任一项所述的系统，其中，所述主动阻尼系统包括：

a)至少一个致动器，所述至少一个致动器可操作地耦合到所述机器人底座；以及，

b)至少一个质量块，所述至少一个质量块耦合到所述致动器，以允许所述质量块相对于所述致动器移动。

7.根据权利要求1至6中的任一项所述的系统，其中，所述主动阻尼系统包括由所述机器人底座支撑的飞轮和驱动器。

8.根据权利要求1至7中的任一项所述的系统，其中，所述机器人底座致动器包括致动器底座，其中，所述机器人底座在第一方向上与所述致动器底座间隔开，并且其中，所述主动阻尼被配置为在与所述第一方向正交的至少两个方向上向所述机器人底座施加力。

9.根据权利要求1至8中的任一项所述的系统，其中，所述机器人底座致动器包括：

a)吊臂，所述吊臂具有包括所述机器人底座的头部；以及，

b)吊臂底座，所述吊臂从所述吊臂底座延伸。

10.根据权利要求1至9中的任一项所述的系统，其中，所述吊臂包括能够改变所述吊臂的动态响应的自适应结构构件。

11.根据权利要求10所述的系统，其中，所述自适应结构构件包括以下项中的至少一项：

a)电活性聚合物；以及，

b)形状记忆合金。

12.根据权利要求1至11中的任一项所述的系统，其中，所述控制系统：

a)确定延伸到末端执行器目的地的末端执行器路径；

b)生成机器人控制信号以控制所述末端执行器的移动；

c)将所述机器人控制信号施加到所述机器人臂，以使所述末端执行器移动。

13.根据权利要求12所述的系统，其中，所述控制系统生成所述机器人控制信号，以考虑：

a)所述机器人底座的移动；以及，

b)所述主动阻尼的操作。

14.根据权利要求13所述的系统，其中，所述控制系统使用所述移动偏差来生成所述机器人控制信号。

15.根据权利要求12至14中的任一项所述的系统，其中，所述控制系统：

a)基于所述机器人底座定位和预期的机器人底座定位计算机器人底座偏差；

b)基于所述机器人底座偏差计算稳定响应；

c)基于所述移动偏差修改所述稳定响应；以及，

d)使用所述稳定响应生成所述机器人控制信号。

16.根据权利要求1至15中的任一项所述的系统，其中，所述控制系统：

a)获取相对于环境坐标系定义的末端执行器目的地的指示；

b)至少部分地根据所述末端执行器目的地来计算从当前机器人底座定位延伸的机器人底座路径；

c)基于所述机器人底座路径生成机器人底座控制信号；以及，

d)将所述机器人底座控制信号施加到所述机器人底座致动器，以使所述机器人底座沿着所述机器人底座路径移动。

17.根据权利要求16所述的系统，其中，所述控制系统执行以下项中的至少一项：

a)至少部分使用移动校正来控制所述机器人底座；以及，

b)至少部分使用移动校正来生成所述机器人底座控制信号。

18.一种用于使用系统在物理环境内执行交互的方法，所述系统包括：

a)机器人底座；

b)机器人底座致动器，所述机器人底座致动器相对于环境移动所述机器人底座；

c)机器人臂，所述机器人臂被安装到所述机器人底座，所述机器人臂包括被安装在所述机器人臂上的末端执行器；

d)跟踪系统，所述跟踪系统测量以下项中的至少一项：

i)机器人底座定位，所述机器人底座定位指示所述机器人底座相对于环境的定位；和，

ii)机器人底座移动，所述机器人底座移动指示所述机器人底座相对于环境的移动；和

e)主动阻尼系统，所述主动阻尼系统主动衰减所述机器人底座相对于环境的移动，其中，所述方法包括，在控制系统中：

i)根据来自所述跟踪系统的信号确定移动校正；以及，

ii)至少部分地根据所述移动校正来控制所述主动阻尼系统。

19.根据权利要求18所述的方法，其中，所述方法使用根据权利要求1至17中的任一项所述的系统来执行。

20.一种计算机程序产品，所述计算机程序产品包括计算机可执行代码，当所述计算机可执行代码由适当编程的控制系统执行时，使得所述控制系统控制用于在物理环境内执行交互的系统，所述系统包括：

a)机器人底座；

b)机器人底座致动器，所述机器人底座致动器相对于环境移动所述机器人底座；

c)机器人臂，所述机器人臂被安装到所述机器人底座，所述机器人臂包括被安装在所述机器人臂上的末端执行器；

d)跟踪系统，所述跟踪系统测量以下项中的至少一项：

i)机器人底座定位，所述机器人底座定位指示所述机器人底座相对于环境的定位；和，

ii)机器人底座移动，所述机器人底座移动指示所述机器人底座相对于环境的移动；和

e)主动阻尼系统，所述主动阻尼系统主动衰减所述机器人底座相对于环境的移动，并且其中，所述控制系统：

i)根据来自所述跟踪系统的信号确定移动校正；以及，

ii)至少部分地根据所述移动校正来控制所述主动阻尼系统。

21.根据权利要求20所述的计算机程序产品，其中，所述计算机程序产品用于使所述控制系统控制根据权利要求1至17中的任一项所述的系统。

Images