CN103895017B - 一种基于使用可靠度的空间机械臂控制方法及系统 - Google Patents

Abstract

本发明实施例提供了一种基于使用可靠度的空间机械臂控制方法，包括：任务的第一控制周期结束后，获得空间机械臂末端的空间位置误差概率分布；依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度；依据所述使用可靠度和预设的可靠度阈值，获得调整量；依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位置信息；所述第二目标空间位置信息为在第二控制周期结束后所述空间机械臂末端的空间位置信息；本发明实施例还提供一种基于使用可靠度的空间机械臂控制系统。根据本发明实施例提供的技术方案，可以实现提高空间机械臂的使用可靠性。

Description

一种基于使用可靠度的空间机械臂控制方法及系统

【技术领域】

本发明涉及自动化控制技术，尤其涉及一种基于使用可靠度的空间机械臂控制方法及系统。

【背景技术】

目前，空间站设备的组装、回收、维修及舱外活动都需要依赖空间机械臂来完成，由于空间机械臂处于微重力、高低温交变、高辐射等恶劣的太空环境中，维修和维护十分困难，因此空间机械臂的可靠性成为世界航天技术的主要难点。空间机械臂的可靠性包括固有可靠性和使用可靠性，其中，固有可靠性在空间机械臂的设计和生产过程中就已经确定，因此提高空间机械臂的使用可靠性是一个经济、有效地提高空间机械臂的任务完成质量的方法。

空间机械臂都是按照预先设置好的任务规划，执行任务，需要在预设的时间到达预设的空间位置，然而，由于空间机械臂关节上的齿轮间隙或者传感器噪声等原因，空间机械臂在执行任务后，实际到达的空间位置与预期的空间位置之间存在一定得误差，如果空间机械臂继续执行任务，任务的实际执行结果与预期的执行结果之间的误差将越来越大，将导致空间机械臂的使用可靠性较低。

【发明内容】

有鉴于此，本发明实施例提供了一种基于使用可靠度的空间机械臂控制方法及系统，以实现提高空间机械臂的使用可靠性。

本发明实施例提供了一种基于使用可靠度的空间机械臂控制方法，包括：

任务的第一控制周期结束后，获得空间机械臂末端的空间位置误差概率分布；

依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度；

依据所述使用可靠度和预设的可靠度阈值，获得调整量；

依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位置信息；所述第二目标空间位置信息为在第二控制周期结束后所述空间机械臂末端的目标空间位置信息。

上述方法中，所述空间机械臂末端的空间位置误差概率分布为：

θ_i|y_i～N(μ_i，Λ_i)

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差；i为大于或者等于1的整数；y_i为第i个控制周期结束后空间机械臂末端的空间位置的检测误差；θ_i|y_i为表示空间机械臂末端的空间位置的检测误差为y_i时，空间机械臂末端的空间位置的实际误差；μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望；Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差。

上述方法中，利用如下公式获得第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i：

${\mathrm{\μ}}_i=\frac{{\mathrm{\Σ}}^{-1}{y}_i+{{\mathrm{\Λ}}_{i-1}}^{-1}({\mathrm{\μ}}_{i-1}+x_{i-1})}{{\mathrm{\Σ}}^{-1}+{{\mathrm{\Λ}}_{i-1}}^{-1}}$

其中，x_i-1为第i-1个控制周期结束后获得的调整量；Σ为预设的常数；

利用如下公式获得第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差Λ_i：

${\mathrm{\Λ}}_i=\frac{{\mathrm{\Σ\Λ}}_{i-1}}{\mathrm{\Σ}+{\mathrm{\Λ}}_{i-1}}$

其中，Λ_i-1为第i-1个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差；Σ为预设的常数。

上述方法中，所述依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度，包括：

依据所述空间机械臂末端的空间位置误差概率分布，并利用如下公式，获得所述空间机械臂末端的空间位置误差概率密度函数：

$f\left({\mathrm{\θ}}_i\right|y_i)=\frac{1}{\sqrt{2\mathrm{\π}{\mathrm{\Λ}}_i}}\exp \{-[\frac{{({\mathrm{\θ}}_i-{\mathrm{\μ}}_i)}^2}{{2\mathrm{\Λ}}_i}\left]\right\}$

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差；θ_i|y_i表示空间机械臂末端的空间位置的检测误差为y_i时，空间机械臂末端的空间位置的实际误差；μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望；Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差；

依据所述空间机械臂末端的空间位置误差概率密度函数f(θ_i|y_i)，并利用如下公式，获得空间机械臂的使用可靠度：

$P\{{\mathrm{\θ}}_{i1}\≤{\mathrm{\θ}}_i\≤{\mathrm{\θ}}_{i2}\}={\∫}_{{\mathrm{\θ}}_{i1}}^{{\mathrm{\θ}}_{i2}}f\left({\mathrm{\θ}}_i\right|y_i){\mathrm{d\θ}}_i={\∫}_{{\mathrm{\θ}}_{i1}}^{{\mathrm{\θ}}_{i2}}\frac{1}{\sqrt{2\mathrm{\π}{\mathrm{\Λ}}_i}}\exp \{-\frac{{({\mathrm{\θ}}_i-{\mathrm{\μ}}_i)}^2}{{2\mathrm{\Λ}}_i}]\}{\mathrm{d\θ}}_i$

其中，P{θ_i1≤θ_i≤θ_i2}为空间机械臂的使用可靠度；θ_i1为预设的第一阈值；θ_i2为预设的第二阈值，且θ_i2≥θ_i1。

上述方法中，所述依据所述使用可靠度和预设的可靠度阈值，获得调整量，包括：

比较所述使用可靠度与所述可靠度阈值的大小；

若所述使用可靠度小于所述可靠度阈值，依据所述空间机械臂末端的空间位置误差概率分布的期望，获得所述空间机械臂末端的调整量。

上述方法中，所述依据所述空间机械臂的空间位置误差概率分布的期望，获得所述空间机械臂末端的调整量，包括：

依据所述空间机械臂的空间位置误差概率分布的期望，并利用如下公式，获得所述空间机械臂末端的调整量：

$x_i\left({\mathrm{\μ}}_i\right)=\left\{\begin{array}{cc}-{\mathrm{\μ}}_i,& {\left|\right|{\mathrm{\μ}}_i\left|\right|}^2>{\left({\mathrm{\μ}}_i^{*}\right)}^2\\ 0,& {\left|\right|{\mathrm{\μ}}_i\left|\right|}^2\≤{\left({\mathrm{\μ}}_i^{*}\right)}^2\end{array}\right.$

其中，x_i(μ_i)为空间机械臂末端的调整量；μ_i为所述空间机械臂的空间位置误差概率分布的期望；为调整量边界值。

上述方法中，获得所述调整量边界值的方法包括：

依据满足L_i(μ_i)＝c+L_i(0)的||μ_i||，获得所述调整量边界值

其中，L_i(μ_i)为第i个控制周期结束后空间机械臂末端的空间位置的误差的估计值为μ_i时，不进行空间机械臂末端的目标空间位置信息进行调整的情况下，从第i+1个控制周期至最后一个控制周期结束的最小期望损失；c为归一化的调整成本；||μ_i||为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i的模；L_i(0)为关于变量μ_i的函数L_i(μ_i)在变量μ_i等于0时的数值；

其中， $L_i\left({\mathrm{\μ}}_i\right)={\left|\right|{\mathrm{\μ}}_i\left|\right|}^2+\mathrm{tr}(\mathrm{\Σ}+{\mathrm{\Λ}}_i)+\∫L_{i+1}^{*}\left({\mathrm{\μ}}_{i+1}\right)f\left({\mathrm{\μ}}_{i+1}\right|y_i,x_i=0){\mathrm{d\μ}}_{i+1},;$ tr(·)为矩阵(Σ+Λ_i)的迹；Σ为预设的常数；f(μ_i+1|y_i，x_i＝0)为预设的概率密度函数；||μ_i||²为μ_i的平方。

上述方法中，所述第一目标空间位置信息包括以下信息中至少一个：空间机械臂末端在空间坐标系的坐标值、所述空间机械臂末端与空间坐标系中坐标轴的夹角；

所述依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位值信息，包括：

依据所述第一目标空间位置信息与所述调整量的和值，获得所述第二目标空间位置信息。

本发明实施例还提供了一种基于使用可靠度的空间机械臂控制系统，包括：

处理单元，用于在任务的第一控制周期结束后，获得空间机械臂末端的空间位置误差概率分布；

评估单元，用于依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度；

生成单元，用于依据所述使用可靠度和预设的可靠度阈值，获得调整量；

控制单元，用于依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位置信息；所述第二目标空间位置信息为在第二控制周期结束后所述空间机械臂末端的目标空间位置信息。

由以上技术方案可以看出，本发明实施例具有以下有益效果：

本发明实施例的技术方案中，依据空间位置误差概率分布，获得空间机械臂的使用可靠度，进而依据使用可靠度获得调整量，依据调整量对下一个控制周期的目标空间位置进行调整，从而可以控制空间机械臂在下一个控制周期的任务执行，因此能够实现在空间机械臂的任务执行结果出现误差的情况下，及时地对空间机械臂的目标空间位置进行调整，以避免空间机械臂的任务执行结果与预期结果之间的误差越来越大，因此可以提高空间机械臂的使用可靠性，提高任务执行成功率，保证空间机械臂的任务执行成功率高。

【附图说明】

为了更清楚地说明本发明实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其它的附图。

图1是本发明实施例所提供的基于使用可靠度的空间机械臂控制方法的流程示意图；

图2是利用本发明实施例提供的方法对目标空间位置信息进行调整的过程示意图；

图3是利用本发明实施例所提供的方法对目标空间位置信息进行调整的过程中使用可靠度的曲线图；

图4是基于现有技术的空间机械臂的控制过程的误差示意图；

图5是本发明实施例的执行结果的精度分布示意图；

图6是本发明实施例所提供的基于使用可靠度的空间机械臂控制系统的结构示意图。

【具体实施方式】

为了更好的理解本发明的技术方案，下面结合附图对本发明实施例进行详细描述。

应当明确，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。

空间机械臂的控制主要包括三个部分，即任务规划、路径规划和运动控制。其中，任务规划指的是输入空间机械臂需要执行的任务的任务规划约束，如任务目标(如任务的起始位置、空间机械臂末端的空间位置)、空间机械臂的约束(如空间机械臂中每个臂杆的长度、每个关节的角度)、环境障碍(如障碍的尺寸和位置)等；然后，依据任务规划约束，对一个完整的任务进行任务拆分，从而获得至少两个子任务；然后，依据任务规划约束，确定每个子任务的中间点；每个子任务的中间点可以是一个或多个。依据中间点和预设的路径规划约束，为空间机械臂生成每两个中间点之间的执行路径，所述执行路径为空间机械臂在两个中间点之间的移动路径，依据该执行路径，空间机械臂就可以按照规划的执行路径进行移动，以完成指定的任务。

使用可靠性是指空间机械臂执行规定的任务时，采用规定的控制方法成功完成任务的能力。使用可靠性通过使用可靠度进行量化，使用可靠度是采用规定的控制方法执行规定的任务，成功完成任务的概率。任务成功的标准由预设的任务执行的精度决定，只要在任务执行的精度范围内，就认为任务成功。执行相同的任务，控制方法不同，所表现出的使用可靠性不同。

本发明实施例中，预先设置至少两个控制周期，在控制空间机械臂执行上述任务过程中，在每个控制周期结束后，都获得空间机械臂的使用可靠度，然后依据使用可靠度获得调整量，依据调整量对下一个控制周期结束后空间机械臂末端的空间位置进行调整，以减小空间机械臂末端的空间位置的误差。为了方面说明，本发明实施例以第一控制周期和第二控制周期为例进行说明，即任务的第一控制周期结束后，可以获得空间机械臂的使用可靠度，依据使用可靠度，获得调整量，然后依据调整量对第二控制周期的目标空间位置信息进行调整。

本发明实施例给出一种基于使用可靠度的空间机械臂控制方法，请参考图1，其为本发明实施例所提供的基于使用可靠度的空间机械臂控制方法的流程示意图，如图1所示，该方法包括以下步骤：

步骤101，任务的第一控制周期结束后，获得空间机械臂末端的空间位置误差概率分布。

具体的，首先，针对空间机械臂闭环控制系统，建立以下状态空间方程模型，用以描述空间机械臂的控制过程：

$\left\{\begin{array}{c}{\mathrm{\θ}}_i={\mathrm{\θ}}_{i-1}+x_{i-1}\\ y_i={\mathrm{\θ}}_i+v_i\end{array}\right.$

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差，即空间机械臂末端的空间位置的真实误差；i为大于或者等于1的整数，y_i为第i个控制周期结束后空间机械臂末端的空间位置的检测误差，即检测到的带有噪声的空间位置误差；x_i-1为第i-1个控制周期结束后空间机械臂的调整量；v_i为高斯噪声，v_i服从正态分布v_i～N(0，Σ)，Σ为预设的常数。

由于空间机械臂的控制系统中各控制环节存在扰动和噪声，若空间机械臂在执行任务的过程中，空间机械臂末端的实际空间位置处于预设的精度范围内，过度地控制调整将会带来更多的扰动，将由此带来的精度损失定义为调整成本。依据空间机械臂末端的空间位置的实际误差和调整成本，构建如下绩效函数，用以描述空间机械臂执行任务的质量：

$L=E[\underset{i=1}{\overset{N}{\mathrm{\Σ}}}{y_i}^T{y}_i+\mathrm{c\δ}\left(x_{i-1}\right)]$

其中，L表示空间机械臂执行任务的质量，E[·]表示数学期望运算，y_i为第i个控制周期结束后空间机械臂末端的空间位置的检测误差，c为归一化的调整成本；x_i-1为第i-1个控制周期结束后获得的调整量，T为矩阵y_i的转置。

其中，利用如下公式获得δ(x)：

$\mathrm{\δ}\left(x\right)=\left\{\begin{array}{cc}1,& x\≠0\\ 0,& x=0\end{array}\right.$

这里，x表示δ(x)函数中的变量。

因此，在同时考虑空间机械臂末端的空间位置的检测误差和调整成本的情况下，空间机械臂的最优控制策略为：使空间机械臂按照序列{x_i}进行调整，i为大于或者等于1的整数，x_i为第i个控制周期结束后获得的调整量。

依据每个控制周期结束后采集的空间机械臂末端的空间位置的检测误差y_i，通过贝叶斯估计算法对控制过程中的空间机械臂末端的空间位置的实际误差θ_i的分布进行推导。

采用如下的正态共轭先验模型作为空间机械臂末端的空间位置的实际误差θ_i的先验概率分布：

θ₀～N(μ₀，Λ₀)

其中，μ₀为空间机械臂末端的空间位置的实际误差θ_i的先验概率分布的期望，也称为空间机械臂末端的空间位置的实际误差θ_i的概率分布的期望的初始值，Λ₀为第i个控制周期结束后空间机械臂末端的空间位置的实际误差θ_i的先验概率分布的方差，也称为空间机械臂末端的空间位置的实际误差θ_i的概率分布的方差的初始值，θ₀为空间机械臂末端的空间位置的实际误差的初始值。

由于存在如下公式：

$\left\{\begin{array}{c}{\mathrm{\θ}}_i={\mathrm{\θ}}_{i-1}+x_{i-1}\\ y_i={\mathrm{\θ}}_i+v_i\end{array}\right.$

因此，y₁|θ₀服从如下分布：

y₁|θ₀～N(θ₀+x₀，Σ)

其中，θ₀为空间机械臂末端的空间位置的实际误差的初始值，x₀为调整量的初始值，x₀可以等于0，Σ为预设的常数，y₁|θ₀为空间机械臂末端的空间位置的实际误差为θ₀时，下一个控制周期结束后空间机械臂末端的空间位置的检测误差为y₁。

然后，利用贝叶斯估计算法，获得：

$p\left({\mathrm{\θ}}_0\right|y_1)=\frac{p\left(y_1\right|{\mathrm{\θ}}_0)p\left({\mathrm{\θ}}_0\right)}{\∫p\left(y_1\right|{\mathrm{\θ}}_0)p\left({\mathrm{\θ}}_0\right){\mathrm{d\θ}}_0}=\mathrm{\αp}\left(y_1\right|{\mathrm{\θ}}_0)p\left({\mathrm{\θ}}_0\right)$

其中，p(θ₀|y₁)表示θ₀|y₁发生的概率。

其中，α为与θ₀无关的常数，其可以利用如下公式获得如下：

$\mathrm{\α}=\frac{1}{\∫p\left(y_1\right|{\mathrm{\θ}}_0)p\left({\mathrm{\θ}}_0\right){\mathrm{d\θ}}_0}$

因此，可以得到：

$p\left({\mathrm{\θ}}_0\right|y_1)={\mathrm{\α}}^{\′}\exp \{-\frac{1}{2}[(\frac{1}{\mathrm{\Σ}}+\frac{1}{{\mathrm{\Λ}}_0}){{\mathrm{\θ}}_0}^2-2(\frac{y_1-x_0}{\mathrm{\Σ}}+\frac{{\mathrm{\μ}}_0}{{\mathrm{\Λ}}_0}){\mathrm{\θ}}_0\left]\right\}---\left(1\right)$

其中，α′表示中间变量，可以利用如下公式获得α′：

${\mathrm{\α}}^{\′}=\mathrm{\α}\frac{1}{2\mathrm{\π}\sqrt{\mathrm{\Σ}{\mathrm{\Λ}}_0}}\exp \{-\frac{1}{2}[\frac{{(y_1-x_0)}^2}{\mathrm{\Σ}}+\frac{{{\mathrm{\μ}}_0}^2}{{\mathrm{\Λ}}_0}\left]\right\}$

因此，得到p(θ₀|y₁)是θ₀的二次函数的指数函数，所以P(θ₀|y₁)满足正态分布，设P(θ₀|y₁)～N(μ₁′，Λ₁)，则获得

$p\left({\mathrm{\θ}}_0\right|y_1)=\frac{1}{\sqrt{2\mathrm{\π}{\mathrm{\Λ}}_1}}\exp [-\frac{1}{2}\frac{{({\mathrm{\θ}}_0-{{\mathrm{\μ}}_1}^{\′})}^2}{{\mathrm{\Λ}}_1}]---\left(2\right)$

其中，μ₁′表示预设的待定系数。

依据公式(1)和公式(2)获得如下方程组：

$\left\{\begin{array}{c}\frac{1}{{\mathrm{\Λ}}_1}=\frac{1}{\mathrm{\Σ}}+\frac{1}{{\mathrm{\Λ}}_0}\\ \frac{{{\mathrm{\μ}}_1}^{\′}}{{\mathrm{\Λ}}_1}=\frac{y_1-x_0}{\mathrm{\Σ}}+\frac{{\mathrm{\μ}}_0}{{\mathrm{\Λ}}_0}\end{array}\right.$

解上述方程组，得到：

$\left\{\begin{array}{c}{{\mathrm{\μ}}_1}^{\′}=\frac{{\mathrm{\Σ}}^{-1}(y_1-x_0)+{{\mathrm{\Λ}}_0}^{-1}{\mathrm{\μ}}_0}{{\mathrm{\Σ}}^{-1}+{{\mathrm{\Λ}}_0}^{-1}}\\ {\mathrm{\Λ}}_1=\frac{\mathrm{\Σ}{\mathrm{\Λ}}_0}{\mathrm{\Σ}+{\mathrm{\Λ}}_0}\end{array}\right.$

依据θ_i＝θ_i-1+x_i-1，获得：

θ₁|y₁～N(μ₁，Λ₁)

其中，

${\mathrm{\μ}}_1={{\mathrm{\μ}}_1}^{\′}+x_0=\frac{{\mathrm{\Σ}}^{-1}{y}_1+{{\mathrm{\Λ}}_0}^{-1}({\mathrm{\μ}}_0+x_0)}{{\mathrm{\Σ}}^{-1}+{{\mathrm{\Λ}}_0}^{-1}}$

因此，依据每个控制周期结束后获得的调整量，进行迭代计算，获得第i个控制周期结束后空间机械臂末端的空间位置的实际误差θ_i的后验分布，即空间机械臂末端的空间位置误差概率分布：

θ_i|y_i～N(μ_i，Λ_i)

其中，

${\mathrm{\μ}}_i=\frac{{\mathrm{\Σ}}^{-1}{y}_i+{{\mathrm{\Λ}}_{i-1}}^{-1}({\mathrm{\μ}}_{i-1}+x_{i-1})}{{\mathrm{\Σ}}^{-1}+{{\mathrm{\Λ}}_{i-1}}^{-1}}$

θ_i|y_i表示空间机械臂末端的空间位置的检测误差为y_i时，空间机械臂末端的空间位置的实际误差，μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望，x_i-1为第i-1个控制周期结束后获得的调整量，Σ为预设的常数，y_i为第i个控制周期结束后空间机械臂末端的空间位置的检测误差。

其中，

${\mathrm{\Λ}}_i=\frac{\mathrm{\Σ}{\mathrm{\Λ}}_i}{\mathrm{\Σ}+{\mathrm{\Λ}}_{i-1}}$

Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差，Λ_i-1为第i-1个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差，Σ为预设的常数。

步骤102，依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度。

具体的，使用可靠度可以依据第i个控制周期结束后空间机械臂末端的空间位置的实际误差θ_i的后验概率进行评估，使用可靠度是空间机械臂的使用可靠性的量化，使用可靠度指的是第i个控制周期结束后械臂末端的空间位置的实际误差θ_i落在预设的精度范围内的概率。

首先，依据所述空间机械臂末端的空间位置误差概率分布θ_i|y_i，并利用如下公式，获得所述空间机械臂末端的空间位置误差概率密度函数f(θ_i|y_i)：

$f\left({\mathrm{\θ}}_i\right|y_i)=\frac{1}{\sqrt{2\mathrm{\π}{\mathrm{\Λ}}_i}}\exp \{-[\frac{{({\mathrm{\θ}}_i-{\mathrm{\μ}}_i)}^2}{{2\mathrm{\Λ}}_i}\left]\right\}$

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差，θ_i|y_i为空间机械臂末端的空间位置误差概率分布，μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望，Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差。

然后，依据所述空间机械臂末端的空间位置误差概率密度函数f(θ_i|y_i)，并利用如下公式，获得空间机械臂的使用可靠度：

$P\{{\mathrm{\θ}}_{i1}\≤{\mathrm{\θ}}_i\≤{\mathrm{\θ}}_{i2}\}={\∫}_{{\mathrm{\θ}}_{i1}}^{{\mathrm{\θ}}_{i2}}f\left({\mathrm{\θ}}_i\right|y_i){\mathrm{d\θ}}_i={\∫}_{{\mathrm{\θ}}_{i1}}^{{\mathrm{\θ}}_{i2}}\frac{1}{\sqrt{2\mathrm{\π}{\mathrm{\Λ}}_i}}\exp \{-\frac{{({\mathrm{\θ}}_i-{\mathrm{\μ}}_i)}^2}{{2\mathrm{\Λ}}_i}]\}{\mathrm{d\θ}}_i$

其中，θ_i1≤θ_i≤θ_i2为预设的精度范围，P{θ_i1≤θ_i≤θ_i2}为第i个控制周期结束后空间机械臂的使用可靠度，θ_i1为精度范围的第一阈值，即精度范围的下限值，θ_i2为精度范围的第二阈值，即精度范围的上限值，且θ_i2≥θ_i1。

步骤103，依据所述使用可靠度和预设的可靠度阈值，获得调整量。

具体的，比较获得的使用可靠度与预设的可靠度阈值的大小；若所述使用可靠度大于或者等于预设的可靠度阈值，则不进行目标空间位置信息的调整，因此，不需要计算调整量，保持空间机械臂当前运行状态继续运行；若所述使用可靠度小于预设的可靠度阈值，则需要依据空间机械臂末端的空间位置误差概率分布的期望，获得所述空间机械臂末端的调整量。

本发明实施例中，依据空间机械臂末端的空间位置误差概率分布的期望，获得所述空间机械臂末端的调整量的方法包括：

1)将第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i作为第i个控制周期结束后空间机械臂末端的空间位置的估计值

即：

${\widehat{\mathrm{\θ}}}_i={\mathrm{\μ}}_i=\frac{{\mathrm{\Σ}}^{-1}{y}_i+{{\mathrm{\Λ}}_{i-1}}^{-1}({\mathrm{\μ}}_{i-1}+x_{i-1})}{{\mathrm{\Σ}}^{-1}+{{\mathrm{\Λ}}_{i-1}}^{-1}}$

其中，i为大于或者等于1的整数，y_i为第i个控制周期结束后空间机械臂末端的空间位置的检测误差，x_i-1为第i-1个控制周期结束后空间机械臂的调整量，Λ_i-1为第i-1个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差，Σ为预设的常数，μ_i-1为第i-1个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望。

2)获得调整边界：

若为第i个控制周期结束后空间机械臂末端的空间位置的误差的估计值为μ_i时，进行空间机械臂末端的目标空间位置信息进行调整的情况下，从第i+1个控制周期至最后一个控制周期结束的最小期望损失。最小期望损失指的是绩效函数L的最小值。L_i(μ_i)为第i个控制周期结束后空间机械臂末端的空间位置的误差的估计值为μ_i时，不进行空间机械臂末端的目标空间位置信息进行调整的情况下，从第i+1个控制周期至最后一个控制周期结束的最小期望损失；其中，所述目标空间位置信息指的是在空间机械臂执行任务之前，预先设置的下一个控制周期结束后空间机械臂末端的空间位置信息。

当i＝N-1时，即第N-1个控制周期结束后，最小期望损失为：

$L_{N-1}^{*}\left({\mathrm{\μ}}_{N-1}\right)=\underset{x_{N-1}}{\min }\left\{E\right[y_N^T{y}_N+\mathrm{c\δ}\left(x_{N-1}\right)\left]\right\}$

其中，

y_N＝(y_N1，y_N2，y_N3)^T

其中，N表示第N个控制周期，T表示矩阵(y_N1，y_N2，y_N3)的转置，y_N表示一个三维矩阵。

因此，得到：

$\begin{array}{c}{L}_{N-1}^{*}\left({\mathrm{\μ}}_{N-1}\right)=\underset{x_{N-1}}{\min }\left\{E\right[\underset{j=1}{\overset{3}{\mathrm{\Σ}}}{y}_{\mathrm{Nj}}^2+\mathrm{c\δ}\left(x_{N-1}\right)\left]\right\}\\ =\underset{x_{N-1}}{\min }\left\{\underset{j=1}{\overset{3}{\mathrm{\Σ}}}\right[E^2\left(y_{\mathrm{Nj}}\right)+\mathrm{Var}\left(y_{\mathrm{Nj}}\right)]+\mathrm{c\δ}\left(x_{N-1}\right)\}\end{array}$

其中，E(·)为表示期望运算，Var(·)为表示方差运算；j为大于或者等于1的整数，c为归一化的调整成本。

由于，

$\begin{array}{c}f\left(y_i\right|y_{i-1},x_{i-1})=\∫f\left(y_i\right|{\mathrm{\θ}}_{i-1})f\left({\mathrm{\θ}}_{i-1}\right|y_{i-1},x_{i-1}){\mathrm{d\θ}}_{i-1}\\ =\frac{1}{2\mathrm{\π}\sqrt{\mathrm{\Σ}{\mathrm{\Λ}}_{i-1}}}f({\mathrm{\Λ}}_{i-1},\mathrm{\Σ})\exp (-{{\mathrm{\μ}}_{i-1}}^2)\exp \frac{{[y_i-(x_{i-1}+{\mathrm{\μ}}_{i-1})]}^2}{-2({\mathrm{\Λ}}_{i-1}+\mathrm{\Σ})}\end{array}$

其中，f(y_i|y_i-1，x_i-1)表示在第i-1个控制周期结束后，空间机械臂末端的空间位置的检测误差是y_i-1且调整量是x_i-1时，第i个控制周期结束后，空间机械臂末端的空间位置的检测误差是y_i。

其中， $f({\mathrm{\Λ}}_i,\mathrm{\Σ})=\∫\exp \{-\frac{{\mathrm{\Λ}}_{i-1}+\mathrm{\Σ}}{2\mathrm{\Σ}{\mathrm{\Λ}}_{i-1}}{({\mathrm{\θ}}_{i-1}-\frac{({\mathrm{\Λ}}_{i-1}{x}_{i-1}-{\mathrm{\Λ}}_{i-1}{y}_i-\mathrm{\Σ}{\mathrm{\μ}}_{i-1})}{{\mathrm{\Λ}}_{i-1}+\mathrm{\Σ}})}^2\}{\mathrm{d\θ}}_{i-1}$ 为高斯积分，与Λ_i-1和Σ有关，与x_i-1、y_i、μ_i-1无关，exp(-μ_i-1 ²)与y_i无关。

因此，得到：y_i|y_i-1～N(μ_i-1+x_i-1，Λ_i-1+Σ)，进而确定y_N服从3维的正态分布N(μ_N-1+x_N-1，Λ_i-1+Σ)。

因此， $L_{N-1}^{*}\left({\mathrm{\μ}}_{N-1}\right)={\min }_{x_{N-1}}\{{\left|\right|{\mathrm{\μ}}_{N-1}+x_{N-1}\left|\right|}^2+\mathrm{tr}(\mathrm{\Σ}+{\mathrm{\Λ}}_{N-1})+\mathrm{c\δ}\left(x_{N-1}\right)\}$

其中，||·||²表示范数的平方，例如，||μ_i||²为μ_i的平方；tr(·)为矩阵(Σ+Λ_N-1)的迹。

$L_{N-1}^{*}\left({\mathrm{\μ}}_{N-1}\right)=\mathrm{tr}(\mathrm{\Σ}+{\mathrm{\Λ}}_{N-1})+\underset{x_{N-1}}{\min }\left\{{\left|\right|{\mathrm{\μ}}_{N-1}+x_{N-1}\left|\right|}^2\mathrm{c\δ}\left(x_{N-1}\right)\right\}$

假设 $R\left(x_{N-1}\right)={\min }_{x_{N-1}}\{{\left|\right|{\mathrm{\μ}}_{N-1}+x_{N-1}\left|\right|}^2+\mathrm{c\δ}\left(x_{N-1}\right)\},$ 则：

x_N-1＝-μ_N-1时，R(x_N-1|x_N-1＝-μ_N-1)＝c

x_N-1＝0时，R(x_N-1|x_N-1＝0)＝||μ_N-1||²

x_N-1≠-μ_N-1且x_N-1≠0时，R(x_N-1|x_N-1≠-μ_N-1，x_N-1≠0)＝||μ_N-1+x_N-1||²+c

由于R(x_N-1|x_N-1≠-μ_N-1，x_N-1≠0)＞R(x_N-1|x_N-1＝-μ_N-1)，舍弃x_N-1≠-_μN-1且x_N-1≠0的情况。

因此，

$R\left(x_{N-1}\right)=\underset{x_{N-1}}{\min }\{{\left|\right|{\mathrm{\μ}}_{N-1}\left|\right|}^2,c\}$

获得：

$L_{N-1}^{*}\left({\mathrm{\μ}}_{N-1}\right)=\mathrm{tr}(\mathrm{\Σ}+{\mathrm{\Λ}}_{N-1})+\underset{x_{N-1}}{\min }\{{\left|\right|{\mathrm{\μ}}_{N-1}\left|\right|}^2,c\}$

由此获得第N-1个控制周期结束后，空间机械臂的调整策略是：

$x_{N-1}=\left\{\begin{array}{cc}-{\mathrm{\μ}}_{N-1},& {\left|\right|{\mathrm{\μ}}_{N-1}\left|\right|}^2>c\\ 0,& {\left|\right|{\mathrm{\μ}}_{N-1}\left|\right|}^2\≤c\end{array}\right.$

3)i∈[0，N-1)时，最小期望损失其中：

$\begin{array}{c}{L}_i^{*}\left({\mathrm{\μ}}_i\right)=\underset{x_i}{\min }\{{\left|\right|{\mathrm{\μ}}_i+x_i\left|\right|}^2+\mathrm{tr}(\mathrm{\Σ}+{\mathrm{\Λ}}_i)+\mathrm{c\δ}\left(x_i\right)\\ +\∫L_{i+1}^{*}\left({\mathrm{\μ}}_{i+1}\right)f\left({\mathrm{\μ}}_{i+1}\right|y_i,x_i){\mathrm{d\μ}}_{i+1}\}\end{array}$

其中，f(·)表示概率密度函数。

$\begin{array}{c}{L}_{N-2}^{*}\left({\mathrm{\&mu;}}_{N-2}\right)=\underset{x_{N-2}}{\min }\{{\left|\right|{\mathrm{\&mu;}}_{N-2}+x_{N-2}\left|\right|}^2+\mathrm{tr}(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_{N-2})+\mathrm{c\&delta;}\left(x_{N-2}\right)\\ +\&Integral;L_{N-1}^{*}\left({\mathrm{\&mu;}}_{N-1}\right)f\left({\mathrm{\&mu;}}_{N-1}\right|y_{N-2},x_{N-2}){\mathrm{d\&mu;}}_{N-1}\}\\ =\mathrm{tr}(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_{N-2})+\mathrm{tr}(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_{N-1})+c\\ +\underset{x_{N-2}}{\min }\{{\left|\right|{\mathrm{\&mu;}}_{N-2}+x_{N-2}\left|\right|}^2+\mathrm{c\&delta;}\left(x_{N-2}\right)\\ +{\&Integral;}_{[{\left|\right|{\mathrm{\&mu;}}_{N-1}\left|\right|}^2<c]}({\left|\right|{\mathrm{\&mu;}}_{N-1}\left|\right|}^2-c)f\left({\mathrm{\&mu;}}_{N-1}\right|y_{N-2},x_{N-2}){\mathrm{d\&mu;}}_{N-1}\}\end{array}$

依据积分中值定理，必然存在至少一个中间值满足如下公式：

$\begin{array}{c}{\&Integral;}_{[{\left|\right|{\mathrm{\&mu;}}_{N-1}\left|\right|}^2<c]}({\left|\right|{\mathrm{\&mu;}}_{N-1}\left|\right|}^2-c)f\left({\mathrm{\&mu;}}_{N-1}\right|y_{N-2},x_{N-2}){\mathrm{d\&mu;}}_{N-1}\\ ={({\left|\right|{\mathrm{\&mu;}}_{N-1}^0\left|\right|}^2-c)}_{[{\left|\right|{\mathrm{\&mu;}}_{N-1}\left|\right|}^2<c]}{\&Integral;}_{[{\left|\right|{\mathrm{\&mu;}}_{N-1}\left|\right|}^2<c]}f\left({\mathrm{\&mu;}}_{N-1}\right|y_{N-2},x_{N-2}){\mathrm{d\&mu;}}_{N-1}\end{array}$

由于y_i|y_i-1～N(μ_i-1+x_i-1，Λ_i-1+Σ)，且 ${\mathrm{\&mu;}}_i={({\mathrm{\&Lambda;}}_{i-1}^{-1}+{\mathrm{\&Sigma;}}^{-1})}^{-1}[{\mathrm{\&Lambda;}}_{i-1}^{-1}({\mathrm{\&mu;}}_{i-1}+$ $x_{i-1})+{\mathrm{\&Sigma;}}^{-1}{y}_i],$ 因此获得：

$\begin{array}{c}{\mathrm{\&mu;}}_{N-1}|Y^{N-2},X^{N-2}~N({\mathrm{\&mu;}}_{N-2}\\ +x_{N-2},{({\mathrm{\&Lambda;}}_{N-2}^{-1}+{\mathrm{\&Sigma;}}^{-1})}^{-1}{\mathrm{\&Sigma;}}^{-1}({\mathrm{\&Lambda;}}_{N-2}+\mathrm{\&Sigma;}){\left({({\mathrm{\&Lambda;}}_{N-2}^{-1}+{\mathrm{\&Sigma;}}^{-1})}^{-1}{\mathrm{\&Sigma;}}^{-1}\right)}^T)\end{array}$

因此，当μ_N-2+x_N-2＝0，即x_N-2＝-μ_N-2时， 可以取得最小值。

进而，获得：

$\begin{array}{c}{L}_{N-2}^{*}\left({\mathrm{\&mu;}}_{N-2}\right)=\underset{x_{N-2}}{\min }\{\mathrm{tr}(\mathrm{\&Sigma;}+A_{N-2})+{\left|\right|{\mathrm{\&mu;}}_{N-2}\left|\right|}^2\\ +\&Integral;L_{N-1}^{*}\left({\mathrm{\&mu;}}_{N-1}\right)f\left({\mathrm{\&mu;}}_{N-1}\right|y_{N-2},x_{N-2}=0){\mathrm{d\&mu;}}_{N-1},\mathrm{tr}(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_{N-2})+c\\ +\&Integral;L_{N-1}^{*}\left({\mathrm{\&mu;}}_{N-1}\right)f\left({\mathrm{\&mu;}}_{N-1}\right|y_{N-2},x_{N-2}=-{\mathrm{\&mu;}}_{N-2}){\mathrm{d\&mu;}}_{N-1}\}\end{array}$

由于，

$L_{N-2}\left({\mathrm{\&mu;}}_{N-2}\right)=L_{N-2}^{*}({\mathrm{\&mu;}}_{N-2},x_{N-2}=0)$

$={\left|\right|{\mathrm{\&mu;}}_{N-2}\left|\right|}^2+\mathrm{tr}(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_{N-2})+\&Integral;L_{N-1}^{*}\left({\mathrm{\&mu;}}_{N-1}\right)f\left({\mathrm{\&mu;}}_{N-1}\right|y_{N-2},x_{N-2}=0){\mathrm{d\&mu;}}_{N-1}$

即： $L_i\left({\mathrm{\&mu;}}_i\right)={\left|\right|{\mathrm{\&mu;}}_i\left|\right|}^2+\mathrm{tr}(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_i)+\&Integral;L_{i+1}^{*}\left({\mathrm{\&mu;}}_{i+1}\right)f\left({\mathrm{\&mu;}}_{i+1}\right|y_i,x_i=0){\mathrm{d\&mu;}}_{i+1}$

其中，tr(·)为矩阵(Σ+Λ_N-2)的迹，Σ为预设的常数，f(μ_i+1|y_i，x_i＝0)为概率密度函数。

因此，

$L_{N-2}^{*}\left({\mathrm{\&mu;}}_{N-2}\right)=\underset{x_{N-2}}{\min }\{L_{N-2}\left({\mathrm{\&mu;}}_{N-2}\right),c+L_{N-2}\left(0\right)\}$

假设：

$L_i^{*}\left({\mathrm{\&mu;}}_i\right)=\min \{L_i\left({\mathrm{\&mu;}}_i\right),c+L_i\left(0\right)\}$

已经证明i＝N-1、i＝N-2时都成立，依据数学归纳法，易证明第i-1个控制周期时，也成立，所以假设成立。

第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i越大，空间机械臂执行任务的执行结果的精度损失越大，L_i(μ_i)越小，因此，L_i(0)最小。因此，对于调整边界为满足L_i(μ_i)＝c+L_i(0)的||μ_i||；其中，||μ_i||为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i的模，L_i(0)为关于变量μ_i的函数L_i(μ_i)在变量μ_i等于0时的数值。

4)计算调整量：

依据所述空间机械臂的空间位置误差概率分布的期望μ_i，并利用如下公式，获得所述空间机械臂末端的调整量x_i(μ_i)：

$x_i\left({\mathrm{\&mu;}}_i\right)=\left\{\begin{array}{cc}-{\mathrm{\&mu;}}_i,& {\left|\right|{\mathrm{\&mu;}}_i\left|\right|}^2>{\left({\mathrm{\&mu;}}_i^{*}\right)}^2\\ 0,& {\left|\right|{\mathrm{\&mu;}}_i\left|\right|}^2\&le;{\left({\mathrm{\&mu;}}_i^{*}\right)}^2\end{array}\right.$

即：在第i个控制周期结束后，比较空间机械臂的空间位置误差概率分布的期望μ_i的模与调整边界值的模；若空间机械臂的空间位置误差概率分布的期望μ_i的模大于调整边界值的模，调整量等于-μ_i，若空间机械臂的空间位置误差概率分布的期望μ_i的模小于或等于调整边界值的模，调整量等于0，相当于不对目标空间位置信息进行调整。

其中，x_i(μ_i)为空间机械臂末端的调整量，μ_i为所述空间机械臂的空间位置误差概率分布的期望，为调整量边界值。这里，调整边界值不是恒定不变的，而是随着控制周期进行变化的。

步骤104，依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位置信息；所述第二目标空间位置信息为在第二控制周期结束后所述空间机械臂末端的目的空间位置信息。

具体的，预设的第一目标空间位置信息包括以下信息中至少一个：空间机械臂末端在空间坐标系的坐标值、所述空间机械臂末端与空间坐标系中坐标轴的夹角。预设的第一目标空间位置信息指的是为第i个控制周期空间机械臂执行任务预先规划好的目标空间位置信息，表示在第i个控制周期结束后，空间机械臂应该到达该目标空间位置信息所指示的位置。

本发明实施例中，依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位值信息的方法可以是：依据所述第一目标空间位置信息与所述调整量的和值，获得所述第二目标空间位置信息。

例如，第一目标空间位置信息包括6个维度，其中3个维度表示空间机械臂末端在空间坐标系的坐标值，另3个维度表示空间机械臂末端与空间坐标系中坐标轴的夹角，若第一目标空间位置信息包括空间机械臂末端在空间坐标系的坐标值g₁，则可以依据所述空间机械臂末端在空间坐标系的坐标值g₁与所述调整量x_i(μ_i)的和值，获得所述第二目标空间位置信息g′₁，即：

g′₁＝g₁+x_i(μ_i)

其中，第二目标空间位置信息g′₁中空间机械臂末端与空间坐标系中坐标轴的夹角，等于第一目标空间位置信息g₁中空间机械臂末端与空间坐标系中坐标轴的夹角，即仅对空间机械臂末端在空间坐标系的坐标值g₁进行调整，不调整空间机械臂末端与空间坐标系中坐标轴的夹角。

再例如，若第一目标空间位置信息包括空间机械臂末端与空间坐标系中坐标轴的夹角g₂，则可以依据所述空间机械臂末端与空间坐标系中坐标轴的夹角g₂与所述调整量x_i(μ_i)的和值，获得所述第二目标空间位置信息g′₂，即：

g′₂＝g₂+x_i(μ_i)

其中，第二目标空间位置信息g′₂中空间机械臂末端在空间坐标系的坐标值，等于第一目标空间位置信息g₂中空间机械臂末端在空间坐标系的坐标值，即仅对空间机械臂末端与空间坐标系中坐标轴的夹角g₂进行调整，不调整空间机械臂末端在空间坐标系的坐标值。

再例如，若第一目标空间位置信息中包括空间机械臂末端在空间坐标系的坐标值g₁和空间机械臂末端与空间坐标系中坐标轴的夹角g₂，则可以依据所述第一目标空间位置与调整量x_i(μ_i)的和值，获得第二目标空间位置信息g′₃，即：

g′₃＝g₃+x_i(μ_i)

依据本发明实施例提供的上述方法，对空间机械臂的控制进行了仿真，为一个具有9个控制周期的空间机械臂的空载转移任务，规定任务精度范围是±1mm，精度范围的第一阈值θ_i1等于-1mm，精度范围的第二阈值θ_i2等于+1mm，可靠度阈值可以为0.9。设置空间机械臂末端的空间位置的实际误差为7mm，空间机械臂末端的空间位置的实际误差的先验概率服从先验分布θ₀～N(0，1)。在每个控制周期结束后获得空间机械臂末端的空间位置的检测误差，引入高斯噪声v₀，高斯噪声v₀服从正态分布v₀～N(0，1)。分别使用本发明实施例的技术方案和不使用本发明实施例的技术方案对上述任务进行单次仿真，仿真结果如图2～图4所示。其中图2和图3中的横坐标轴表示控制周期。

请参考图2，其为利用本发明实施例提供的方法对目标空间位置信息进行调整的过程示意图。如图2所示，虚线11表示不同控制周期对应的精度范围的第一阈值θ_i1，虚线12表示不同控制周期对应的精度范围的第二阈值θ_i2，实线13表示空间机械臂末端的空间位置的误差的估计值，虚线14表示空间机械臂末端的空间位置的检测误差，实线15表示空间机械臂末端的空间位置的实际误差，空间机械臂末端的空间位置的误差的估计值逐渐向空间机械臂末端的空间位置的实际误差收敛；整个控制过程分别在第1控制周期、第2控制周期和第6控制周期对相应的目的空间位置信息进行了调整；空间机械臂末端的空间位置的实际误差逐渐向0收敛，收敛过程平缓且没有波动。

请参考图3，其为利用本发明实施例所提供的方法对目标空间位置信息进行调整的过程中使用可靠度的曲线图，如图3所示，可以控制方法中依据使用可靠度进行控制的过程中使用可靠度呈现增加趋势，且收敛于1。

请参考图4，其为基于现有技术的空间机械臂的控制过程的误差示意图，如图4中的实线，空间机械臂末端的空间位置的检测误差中存在噪声，即使在每个控制周期都对目的空间位置信息进行调整，如图4中的虚线，空间机械臂末端的空间位置的实际误差仍然持续波动，且不能收敛。

请参考图5，其为本发明实施例的执行结果的精度分布示意图，如图5所示，在重复完成10000次任务后，获得执行结果精度分布，图5中的横坐标轴是精度值，纵坐标轴是执行结果的精度落在横坐标轴对应精度的次数，规定执行结果的精度位于±1mm范围内。如图5中实线所示，统计得到使用本发明实施例的技术方案的执行任务的成功概率为99.03％，即利用本发明实施例的方法对空间机械臂进行控制后，空间机械臂的使用可靠度达到99.03％；如图5中虚线所示，未使用本发明实施例的方法对空间机械臂进行控制，空间机械臂的使用可靠度为71.03％。由图5的两条曲线看出，使用本发明所述控制方法执行任务的精度分布比未使用本发明所述控制方法执行任务的精度分布的方差小，空间机械臂执行任务结果的波动明显减小，有效的提高了空间机械臂的使用可靠性。

本发明实施例进一步给出实现上述方法实施例中各步骤及方法的装置实施例。

请参考图6，其为本发明实施例所提供的基于使用可靠度的空间机械臂控制系统的结构示意图。如图所示，该系统包括：

处理单元601，用于在任务的第一控制周期结束后，获得空间机械臂末端的空间位置误差概率分布；

评估单元602，用于依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度；

生成单元603，用于依据所述使用可靠度和预设的可靠度阈值，获得调整量；

控制单元604，用于依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位置信息；所述第二目标空间位置信息为在第二控制周期结束后所述空间机械臂末端的目标空间位置信息。

上述系统中，所述处理单元601具体用于：

所述空间机械臂末端的空间位置误差概率分布为：

θ_i|y_i～N(μ_i，Λ_i)

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差；i为大于或者等于1的整数；y_i为第i个控制周期结束后空间机械臂末端的空间位置的检测误差；θ_i|y_i表示空间机械臂末端的空间位置的检测误差为y_i时，空间机械臂末端的空间位置的实际误差；μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望；Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差。

其中，利用如下公式获得第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i：

${\mathrm{\&mu;}}_i=\frac{{\mathrm{\&Sigma;}}^{-1}{y}_i+{{\mathrm{\&Lambda;}}_{i-1}}^{-1}({\mathrm{\&mu;}}_{i-1}+x_{i-1})}{{\mathrm{\&Sigma;}}^{-1}+{{\mathrm{\&Lambda;}}_{i-1}}^{-1}}$

其中，x_i-1为第i-1个控制周期结束后获得的调整量；Σ为预设的常数；

利用如下公式获得第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差Λ_i：

${\mathrm{\&Lambda;}}_i=\frac{{\mathrm{\&Sigma;\&Lambda;}}_{i-1}}{\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_{i-1}}$

其中，Λ_i-1为第i-1个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差；Σ为预设的常数。

上述系统中，所述评估单元602具体用于：

依据所述空间机械臂末端的空间位置误差概率分布，并利用如下公式，获得所述空间机械臂末端的空间位置误差概率密度函数：

$f\left({\mathrm{\&theta;}}_i\right|y_i)=\frac{1}{\sqrt{2\mathrm{\&pi;}{\mathrm{\&Lambda;}}_i}}\exp \{-[\frac{{({\mathrm{\&theta;}}_i-{\mathrm{\&mu;}}_i)}^2}{{2\mathrm{\&Lambda;}}_i}\left]\right\}$

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差；θ_i|y_i表示空间机械臂末端的空间位置的检测误差为y_i时，空间机械臂末端的空间位置的实际误差；μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望；Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差；

依据所述空间机械臂末端的空间位置误差概率密度函数f(θ_i|y_i)，并利用如下公式，获得空间机械臂的使用可靠度：

$P\{{\mathrm{\&theta;}}_{i1}\&le;{\mathrm{\&theta;}}_i\&le;{\mathrm{\&theta;}}_{i2}\}={\&Integral;}_{{\mathrm{\&theta;}}_{i1}}^{{\mathrm{\&theta;}}_{i2}}f\left({\mathrm{\&theta;}}_i\right|y_i){\mathrm{d\&theta;}}_i={\&Integral;}_{{\mathrm{\&theta;}}_{i1}}^{{\mathrm{\&theta;}}_{i2}}\frac{1}{\sqrt{2\mathrm{\&pi;}{\mathrm{\&Lambda;}}_i}}\exp \{-\frac{{({\mathrm{\&theta;}}_i-{\mathrm{\&mu;}}_i)}^2}{{2\mathrm{\&Lambda;}}_i}]\}{\mathrm{d\&theta;}}_i$

其中，P{θ_i1≤θ_i≤θ_i2}为空间机械臂的使用可靠度；θ_i1为预设的第一阈值；θ_i2为预设的第二阈值，且θ_i2≥θ_i1。

上述系统中，所述生成单元603具体用于：

比较所述使用可靠度与所述可靠度阈值的大小；

若所述使用可靠度小于所述可靠度阈值，依据所述空间机械臂末端的空间位置误差概率分布的期望，获得所述空间机械臂末端的调整量。

其中，所述生成单元603具体用于：

依据所述空间机械臂的空间位置误差概率分布的期望，并利用如下公式，获得所述空间机械臂末端的调整量：

$x_i\left({\mathrm{\&mu;}}_i\right)=\left\{\begin{array}{cc}-{\mathrm{\&mu;}}_i,& {\left|\right|{\mathrm{\&mu;}}_i\left|\right|}^2>{\left({\mathrm{\&mu;}}_i^{*}\right)}^2\\ 0,& {\left|\right|{\mathrm{\&mu;}}_i\left|\right|}^2\&le;{\left({\mathrm{\&mu;}}_i^{*}\right)}^2\end{array}\right.$

其中，x_i(μ_i)为空间机械臂末端的调整量；μ_i为所述空间机械臂的空间位置误差概率分布的期望；为调整量边界值。

所述生成单元具体603用于：

依据满足L_i(μ_i)＝c+L_i(0)的||μ_i||，获得所述调整量边界值

其中，L_i(μ_i)为第i个控制周期结束后空间机械臂末端的空间位置的误差的估计值为μ_i时，不进行空间机械臂末端的目标空间位置信息进行调整的情况下，从第i+1个控制周期至最后一个控制周期结束的最小期望损失；c为归一化的调整成本；||μ_i||为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i的模；L_i(0)为关于变量μ_i的函数L_i(μ_i)在变量μ_i等于0时的数值；

其中， $L_i\left({\mathrm{\&mu;}}_i\right)={\left|\right|{\mathrm{\&mu;}}_i\left|\right|}^2+\mathrm{tr}(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_i)+\&Integral;L_{i+1}^{*}\left({\mathrm{\&mu;}}_{i+1}\right)f\left({\mathrm{\&mu;}}_{i+1}\right|y_i,x_i=0){\mathrm{d\&mu;}}_{i+1},;$ tr(·)为矩阵(Σ+Λ_i)的迹；Σ为预设的常数；f(μ_i+1|y_i，x_i＝0)为预设的概率密度函数；||μ_i||²为μ_i的平方。

上述系统中，所述第一目标空间位置信息包括以下信息中至少一个：空间机械臂末端在空间坐标系的坐标值、所述空间机械臂末端与空间坐标系中坐标轴的夹角；所述控制单元604具体用于：依据所述第一目标空间位置信息与所述调整量的和值，获得所述第二目标空间位置信息。

本发明实施例的技术方案具有以下有益效果：

本发明实施例的技术方案中，依据空间位置误差概率分布，获得空间机械臂的使用可靠度，进而依据使用可靠度获得调整量，依据调整量对下一个控制周期的目标空间位置进行调整，从而可以控制空间机械臂在下一个控制周期的任务执行，因此能够实现在空间机械臂的任务执行结果出现误差的情况下，及时地对空间机械臂的目标空间位置进行调整，以避免空间机械臂的任务执行结果与预习结果之间的误差越来越大，因此可以提高空间机械臂的使用可靠性，提高任务执行成功率，保证空间机械臂的任务执行成功率高。

以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明保护的范围之内。

Claims (9)

1.一种基于使用可靠度的空间机械臂控制方法，其特征在于，所述方法包括：

任务的第一控制周期结束后，获得空间机械臂末端的空间位置误差概率分布；

依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度；

依据所述使用可靠度和预设的可靠度阈值，获得调整量；

依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位置信息；所述第二目标空间位置信息为在第二控制周期结束后所述空间机械臂末端的目标空间位置信息。

2.根据权利要求1所述的方法，其特征在于，所述空间机械臂末端的空间位置误差概率分布为：

θ_i|y_i～N(μ_i,Λ_i)

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差；i为大于或者等于1的整数；y_i为第i个控制周期结束后空间机械臂末端的空间位置的检测误差；θ_i|y_i为表示空间机械臂末端的空间位置的检测误差为y_i时，空间机械臂末端的空间位置的实际误差；μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望；Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差。

3.根据权利要求2所述的方法，其特征在于，

利用如下公式获得第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i：

${\mathrm{\&mu;}}_i=\frac{{\mathrm{\&Sigma;}}^{-1}{y}_i+{{\mathrm{\&Lambda;}}_{i-1}}^{-1}({\mathrm{\&mu;}}_{i-1}+x_{i-1})}{{\mathrm{\&Sigma;}}^{-1}+{{\mathrm{\&Lambda;}}_{i-1}}^{-1}}$

其中，x_i-1为第i-1个控制周期结束后获得的调整量；Σ为预设的常数；

利用如下公式获得第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差Λ_i：

${\mathrm{\&Lambda;}}_i=\frac{{\mathrm{\&Sigma;\&Lambda;}}_{i-1}}{\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_{i-1}}$

其中，Λ_i-1为第i-1个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差；Σ为预设的常数。

4.根据权利要求1所述的方法，其特征在于，所述依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度，包括：

依据所述空间机械臂末端的空间位置误差概率分布，并利用如下公式，获得所述空间机械臂末端的空间位置误差概率密度函数：

$f\left({\mathrm{\&theta;}}_i\right|y_i)=\frac{1}{\sqrt{2{\mathrm{\&pi;\&Lambda;}}_i}}\exp \{-\&lsqb;\frac{{({\mathrm{\&theta;}}_i-{\mathrm{\&mu;}}_i)}^2}{2{\mathrm{\&Lambda;}}_i}\&rsqb;\}$

其中，θ_i为第i个控制周期结束后空间机械臂末端的空间位置的实际误差；θ_i|y_i表示空间机械臂末端的空间位置的检测误差为y_i时，空间机械臂末端的空间位置的实际误差；μ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望；Λ_i为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的方差；

依据所述空间机械臂末端的空间位置误差概率密度函数f(θ_i|y_i)，并利用如下公式，获得空间机械臂的使用可靠度：

$P\{{\mathrm{\&theta;}}_{i1}\&le;{\mathrm{\&theta;}}_i\&le;{\mathrm{\&theta;}}_{i2}\}={\&Integral;}_{{\mathrm{\&theta;}}_{i1}}^{{\mathrm{\&theta;}}_{i2}}f\left({\mathrm{\&theta;}}_i\right|y_i){\mathrm{d\&theta;}}_i={\&Integral;}_{{\mathrm{\&theta;}}_{i1}}^{{\mathrm{\&theta;}}_{i2}}\frac{1}{\sqrt{2{\mathrm{\&pi;\&Lambda;}}_i}}\exp \left\{-\&lsqb;\frac{{({\mathrm{\&theta;}}_i-{\mathrm{\&mu;}}_i)}^2}{2{\mathrm{\&Lambda;}}_i}\&rsqb;\right\}{\mathrm{d\&theta;}}_i$

其中，P{θ_i1≤θ_i≤θ_i2)为空间机械臂的使用可靠度；θ_i1为预设的第一阈值；θ_i2为预设的第二阈值，且θ_i2≥θ_i1。

5.根据权利要求1至4中任一项所述的方法，其特征在于，所述依据所述使用可靠度和预设的可靠度阈值，获得调整量，包括：

比较所述使用可靠度与所述可靠度阈值的大小；

若所述使用可靠度小于所述可靠度阈值，依据所述空间机械臂末端的空间位置误差概率分布的期望，获得所述空间机械臂末端的调整量。

6.根据权利要求5所述的方法，其特征在于，所述依据所述空间机械臂的空间位置误差概率分布的期望，获得所述空间机械臂末端的调整量，包括：

依据所述空间机械臂的空间位置误差概率分布的期望，并利用如下公式，获得所述空间机械臂末端的调整量：

$x_i\left({\mathrm{\&mu;}}_i\right)=\left\{\begin{array}{cc}-{\mathrm{\&mu;}}_i,& \left|\right|{\mathrm{\&mu;}}_i|{|}^2>{\left({\mathrm{\&mu;}}_i^{*}\right)}^2\\ 0,& \left|\right|{\mathrm{\&mu;}}_i|{|}^2\&le;{\left({\mathrm{\&mu;}}_i^{*}\right)}^2\end{array}\right.$

其中，x_i(μ_i)为空间机械臂末端的调整量；μ_i为所述空间机械臂的空间位置误差概率分布的期望；为调整量边界值。

7.根据权利要求6所述的方法，其特征在于，获得所述调整量边界值的方法包括：

依据满足L_i(μ_i)＝c+L_i(0)的||μ_i||，获得所述调整量边界值

其中，L_i(μ_i)为第i个控制周期结束后空间机械臂末端的空间位置的误差的估计值为μ_i时，不进行空间机械臂末端的目标空间位置信息进行调整的情况下，从第i+1个控制周期至最后一个控制周期结束的最小期望损失；c为归一化的调整成本；||μ_i||为第i个控制周期结束后空间机械臂末端的空间位置误差概率分布的期望μ_i的模；L_i(0)为关于变量μ_i的函数L_i(μ_i)在变量μ_i等于0时的数值；

其中， $L_i\left({\mathrm{\&mu;}}_i\right)=\left|\right|{\mathrm{\&mu;}}_i|{|}^2+tr(\mathrm{\&Sigma;}+{\mathrm{\&Lambda;}}_i)+\&Integral;L_{i+1}^{*}\left({\mathrm{\&mu;}}_{i+1}\right)f\left({\mathrm{\&mu;}}_{i+1}\right|y_i,x_i=0){\mathrm{d\&mu;}}_{i+1};$ tr(·)为矩阵(Σ+Λ_i)的迹；Σ为预设的常数；f(μ_i+1|y_i,x_i＝0)为预设的概率密度函数；||μ_i||²为μ_i的平方。

8.根据权利要求1所述的方法，其特征在于，

所述第一目标空间位置信息包括以下信息中至少一个：空间机械臂末端在空间坐标系的坐标值、所述空间机械臂末端与空间坐标系中坐标轴的夹角；

所述依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位值信息，包括：

依据所述第一目标空间位置信息与所述调整量的和值，获得所述第二目标空间位置信息。

9.一种基于使用可靠度的空间机械臂控制系统，其特征在于，所述系统包括：

处理单元，用于在任务的第一控制周期结束后，获得空间机械臂末端的空间位置误差概率分布；

评估单元，用于依据所述空间位置误差概率分布，获得空间机械臂的使用可靠度；

生成单元，用于依据所述使用可靠度和预设的可靠度阈值，获得调整量；

控制单元，用于依据预设的第一目标空间位置信息和所述调整量，获得第二目标空间位置信息；所述第二目标空间位置信息为在第二控制周期结束后所述空间机械臂末端的目标空间位置信息。