CN109933096A - 一种云台伺服控制方法及系统 - Google Patents

Abstract

本公开提供了一种云台伺服控制方法及系统，执行：采集云台位姿并获取目标点坐标，依据空间坐标变换关系，进行坐标转换，确定目标点在云台坐标系内的坐标；在云台坐标系内，根据目标点在云台坐标系内的坐标计算云台水平和垂直两自由度目标转角；将计算得到的云台目标转角作为控制量输出至云台执行，实现对云台的第一阶段伺服控制，待控制完成后进行待追踪目标区域图像的采集；对图像中待追踪目标进行识别，若识别成功，依据目标点距采集图像中心偏差，计算云台水平和垂直两自由度相对于当前角度的相对转角，并输出至云台执行，对云台进行第二阶段的伺服控制。

Description

一种云台伺服控制方法及系统

技术领域

本公开涉及一种云台伺服控制方法及系统。

背景技术

本部分的陈述仅仅是提供了与本公开相关的背景技术信息，不必然构成在先技术。

目前云台视觉伺服控制已在机器人领域得到了广泛应用，其通过采集目标区域的图像并识别待追踪目标后，依据目标区域与采集图像中心的偏差控制云台以实现对目标的追踪。

然而，在云台视觉伺服控制室外机器人应用过程中，所采集的目标区域图像不可避免的会受到光照、天气等因素影响，从而给后续目标识别带来困难，导致伺服控制性能下降。另外，室外环境中的各种障碍物也可能随机或连续性遮挡待追踪目标，从而无法从采集图像中提取关于目标的有效信息，导致对目标追踪失败。

发明内容

本公开为了解决上述问题，提出了一种云台伺服控制方法及系统，本公开在已有云台视觉伺服研究成果基础上，通过将依据待追踪目标中心点(即目标点)的空间坐标信息计算云台伺服控制量与现有云台视觉伺服控制结合，克服了单一视觉伺服控制方法室外应用时易受环境因素影响的问题。

为了实现上述目的，本公开采用如下技术方案：

一种云台伺服控制方法，执行以下步骤：

(1)采集云台位姿并获取目标点坐标，依据空间坐标变换关系，进行坐标转换，确定目标点在云台坐标系内的坐标；

(2)在云台坐标系内，根据目标点在云台坐标系内的坐标计算云台水平和垂直两自由度目标转角；

(3)将计算得到的云台目标转角作为控制量输出至云台执行，实现对云台的第一阶段伺服控制，待控制完成后进行待追踪目标区域图像的采集；

(4)对图像中待追踪目标进行识别，若识别成功，依据目标点距采集图像中心偏差，计算云台水平和垂直两自由度相对于当前角度的相对转角，并输出至云台执行，对云台进行第二阶段的伺服控制；若识别失败则直接返回步骤(1)。

上述步骤可以只执行一次，也可以周期性的循环执行。

作为进一步的限定，所述步骤(1)中的目标点和云台位置三维空间的坐标为世界坐标系。

作为进一步的限定，所述步骤(1)中的云台坐标系是指坐标原点在云台水平和垂直转动轴线交点且X轴与水平垂直旋转轴垂直且指向云台正前方，Y轴与云台垂直旋转轴重合的坐标系。

作为进一步的限定，所述步骤(1)中，分别构建目标点在世界坐标系及云台坐标系下的齐次坐标转换矩阵，以及云台坐标系到世界坐标系的齐次坐标转换矩阵，利用齐次坐标转换矩阵进行坐标的转换。

作为更进一步的限定，目标点在世界坐标系的齐次坐标转换矩阵为：

其中，(e,n,h)为目标点在世界坐标系的坐标，(e,n)为目标的平面坐标，h为目标点的高程。

作为更进一步的限定，目标点在云台坐标系下的齐次坐标转换矩阵为：

其中，(x,y,z)为目标点在云台坐标系内的坐标。

作为更进一步的限定，云台坐标系到世界坐标系的齐次坐标转换矩阵为：

其中，c代表cos运算，s代表sin运算，各个脚标则代表对应的姿态角，(a,b,c)为车辆三维空间位置，(o,p,r)为则分别代表了云台X轴方向以及相对于水平面的俯仰角和滚动角度。

作为进一步的限定，所述步骤(2)中，云台水平和垂直两自由度目标转角α和β的计算过程为：

α＝tan^-1(y/x)

其中，(x,y,z)为目标点在云台坐标系内的坐标。

一种云台伺服控制系统，运行于处理器或存储器上，被配置为执行以下指令：

(1)采集云台位姿并获取目标点坐标，依据空间坐标变换关系，进行坐标转换，确定目标点在云台坐标系内的坐标；

(2)在云台坐标系内，根据目标点在云台坐标系内的坐标计算云台水平和垂直两自由度目标转角；

(3)将计算得到的云台目标转角作为控制量输出至云台执行，实现对云台的第一阶段伺服控制，待控制完成后进行待追踪目标区域图像的采集；

(4)对图像中待追踪目标进行识别，若识别成功，依据目标点距采集图像中心偏差，计算云台水平和垂直两自由度相对于当前角度的相对转角，并输出至云台执行，对云台进行第二阶段的伺服控制。

一种巡检机器人，包括上述云台伺服控制系统。

与现有技术相比，本公开的有益效果为：

与现有单一视觉伺服控制相比，本公开提出的云台伺服控制方法，可有效抵御外部光照、天气以及各种障碍物对待追踪目标遮挡等因素影响。通过将云台伺服控制分为两个阶段，第一阶段伺服控制可实现对目标区域的对准，从而为第二阶段对目标图像采集和识别提供更加良好的基础，有效提升整个云台伺服控制的精度和鲁棒性。

附图说明

构成本申请的一部分的说明书附图用来提供对本申请的进一步理解，本申请的示意性实施例及其说明用于解释本申请，并不构成对本申请的不当限定。

图1为检测点的空间坐标位置示意图；

图2为云台伺服控制流程示意图；

具体实施方式：

下面结合附图与实施例对本公开作进一步说明。

应该指出，以下详细说明都是例示性的，旨在对本申请提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。

需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本申请的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。

在本公开中，术语如“上”、“下”、“左”、“右”、“前”、“后”、“竖直”、“水平”、“侧”、“底”等指示的方位或位置关系为基于附图所示的方位或位置关系，只是为了便于叙述本公开各部件或元件结构关系而确定的关系词，并非特指本公开中任一部件或元件，不能理解为对本公开的限制。

本公开中，术语如“固接”、“相连”、“连接”等应做广义理解，表示可以是固定连接，也可以是一体地连接或可拆卸连接；可以是直接相连，也可以通过中间媒介间接相连。对于本领域的相关科研或技术人员，可以根据具体情况确定上述术语在本公开中的具体含义，不能理解为对本公开的限制。

本实施例提供了一种云台伺服控制方法。在已有云台视觉伺服研究成果基础上，通过将依据待追踪目标中心点(为方便叙述，以下称为目标点)的空间坐标信息计算云台伺服控制量与现有云台视觉伺服控制结合，克服了单一视觉伺服控制方法室外应用时易受环境因素影响的问题。

为方便后续说明，此处预先定义如下两个坐标系：

表示目标点及云台位置三维空间位置的世界坐标系O_WX_WY_WZ_W；

坐标原点在云台水平和垂直转动轴线交点且X轴与水平垂直旋转轴垂直且指向云台正前方，Y轴与云台垂直旋转轴重合的云台坐标系O_YX_YY_YZ_Y；

云台伺服控制过程中需追踪的某个目标点的空间坐标位置如图1所示。

假设某一目标点在世界坐标系的坐标为(e,n,h)，其中：(e,n)为目标的平面坐标，h为目标点的高程；云台在世界坐标系中的空间位姿(位置和姿态，下同)为(a,b,c,o,p,r)，其中：(a,b,c)为车辆三维空间位置，(o,p,r)为则分别代表了云台X轴方向以及相对于水平面的俯仰角和滚动角度；目标点在云台坐标系内的坐标为(x,y,z)。

另外，图1中T₀和T₁分别为目标点在世界坐标系及云台坐标系下的齐次坐标转换矩阵，T₂为云台坐标系到世界坐标系的齐次坐标转换矩阵。上述坐标转换矩阵具体表示形式如下所示：

为简化书写，在T₂的表达式中：c代表cos运算，s代表sin运算，而脚标则代表了对对应的姿态角进行运算。

作为一种典型的实施方式，当需要对目标进行追踪时，云台伺服控制将按设定控制周期性循环执行，一个周期内的云台伺服控制流程如图2所示，具体包括：

(步骤1)采集云台位姿并获取目标点坐标；

(步骤2)依据空间坐标变换关系，列写坐标转换方程，求解目标点在云台坐标系内的坐标(x,y,z)，所列方程如下：

T₀＝T₂T₁

(步骤3)在云台坐标系内，计算云台水平和垂直两自由度目标转角α和β，公式如下：

α＝tan^-1(y/x)

(步骤4)将计算得到的云台目标转角作为控制量输出至云台执行，实现对云台的第1阶段伺服控制。

(步骤5)待第一阶段云台伺服控制完成后，再采集待追踪目标区域图像。

(步骤6)利用模式识别方法对图像中待追踪目标进行识别，并生成识别成功和失败标志；

(步骤7)若识别成功，则在依据目标点距采集图像中心偏差，计算云台水平和垂直两自由度相对于当前角度的相对转角，并输出至云台执行，以实现对云台的第2阶段伺服控制。若识别失败则直接返回(步骤1)执行。

其中，(步骤1)中的云台位姿可由外部惯性模块提供；而对于目标点的空间坐标，则可依据具体的伺服控制任务，通过测量方式得到。

(步骤6)和(步骤7)中的对待检区域进行识别并计算云台相对转角的方法可参考已有专利和文献实现，具体过程在此不再赘述。

以上所述仅为本申请的优选实施例而已，并不用于限制本申请，对于本领域的技术人员来说，本申请可以有各种更改和变化。凡在本申请的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本申请的保护范围之内。

上述虽然结合附图对本公开的具体实施方式进行了描述，但并非对本公开保护范围的限制，所属领域技术人员应该明白，在本公开的技术方案的基础上，本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本公开的保护范围以内。

Claims (10)

1.一种云台伺服控制方法，其特征是：执行以下步骤：

(1)采集云台位姿并获取目标点坐标，依据空间坐标变换关系，进行坐标转换，确定目标点在云台坐标系内的坐标；

(2)在云台坐标系内，根据目标点在云台坐标系内的坐标计算云台水平和垂直两自由度目标转角；

(3)将计算得到的云台目标转角作为控制量输出至云台执行，实现对云台的第一阶段伺服控制，待控制完成后进行待追踪目标区域图像的采集；

(4)对图像中待追踪目标进行识别，若识别成功，依据目标点距采集图像中心偏差，计算云台水平和垂直两自由度相对于当前角度的相对转角，并输出至云台执行，对云台进行第二阶段的伺服控制。

2.如权利要求1所述的一种云台伺服控制方法，其特征是：所述步骤(1)中的目标点和云台位置三维空间的坐标为世界坐标系。

3.如权利要求1所述的一种云台伺服控制方法，其特征是：所述步骤(1)中的云台坐标系是指坐标原点在云台水平和垂直转动轴线交点且X轴与水平垂直旋转轴垂直且指向云台正前方，Y轴与云台垂直旋转轴重合的坐标系。

4.如权利要求1所述的一种云台伺服控制方法，其特征是：所述步骤(1)中，分别构建目标点在世界坐标系及云台坐标系下的齐次坐标转换矩阵，以及云台坐标系到世界坐标系的齐次坐标转换矩阵，利用齐次坐标转换矩阵进行坐标的转换。

5.如权利要求4所述的一种云台伺服控制方法，其特征是：目标点在世界坐标系的齐次坐标转换矩阵为：

其中，(e,n,h)为目标点在世界坐标系的坐标，(e,n)为目标的平面坐标，h为目标点的高程。

6.如权利要求4所述的一种云台伺服控制方法，其特征是：目标点在云台坐标系下的齐次坐标转换矩阵为：

其中，(x,y,z)为目标点在云台坐标系内的坐标。

7.如权利要求4所述的一种云台伺服控制方法，其特征是：云台坐标系到世界坐标系的齐次坐标转换矩阵为：

其中，c代表cos运算，s代表sin运算，各个脚标则代表对应的姿态角，(a,b,c)为车辆三维空间位置，(o,p,r)为则分别代表了云台X轴方向以及相对于水平面的俯仰角和滚动角度。

8.如权利要求1所述的一种云台伺服控制方法，其特征是：所述步骤(2)中，云台水平和垂直两自由度目标转角α和β的计算过程为：

α＝tan^-1(y/x)

其中，(x,y,z)为目标点在云台坐标系内的坐标。

9.一种云台伺服控制系统，其特征是：运行于处理器或存储器上，被配置为执行以下指令：

(1)采集云台位姿并获取目标点坐标，依据空间坐标变换关系，进行坐标转换，确定目标点在云台坐标系内的坐标；

(2)在云台坐标系内，根据目标点在云台坐标系内的坐标计算云台水平和垂直两自由度目标转角；

(3)将计算得到的云台目标转角作为控制量输出至云台执行，实现对云台的第一阶段伺服控制，待控制完成后进行待追踪目标区域图像的采集；

(4)对图像中待追踪目标进行识别，若识别成功，依据目标点距采集图像中心偏差，计算云台水平和垂直两自由度相对于当前角度的相对转角，并输出至云台执行，对云台进行第二阶段的伺服控制。

10.一种巡检机器人，其特征是：包括如权利要求9所述的云台伺服控制系统。