CN111220130B - 可对空间任意位置的物体测量的聚焦测量方法及终端 - Google Patents

可对空间任意位置的物体测量的聚焦测量方法及终端 Download PDF

Info

Publication number
CN111220130B
CN111220130B CN202010064115.2A CN202010064115A CN111220130B CN 111220130 B CN111220130 B CN 111220130B CN 202010064115 A CN202010064115 A CN 202010064115A CN 111220130 B CN111220130 B CN 111220130B
Authority
CN
China
Prior art keywords
holder
rotation angle
target object
detected
space coordinate
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010064115.2A
Other languages
English (en)
Other versions
CN111220130A (zh
Inventor
黄宗荣
林大甲
江世松
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jinqianmao Technology Co ltd
Original Assignee
Jinqianmao Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jinqianmao Technology Co ltd filed Critical Jinqianmao Technology Co ltd
Priority to CN202010064115.2A priority Critical patent/CN111220130B/zh
Publication of CN111220130A publication Critical patent/CN111220130A/zh
Application granted granted Critical
Publication of CN111220130B publication Critical patent/CN111220130B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
    • G01C11/02—Picture taking arrangements specially adapted for photogrammetry or photographic surveying, e.g. controlling overlapping of pictures
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
    • G01C11/04—Interpretation of pictures

Landscapes

  • Engineering & Computer Science (AREA)
  • Multimedia (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本发明涉及测量技术领域，尤其涉及一种可对空间任意位置的物体测量的聚焦测量方法及终端。其包括：获取待测目标物体上预设的目标点的空间坐标；旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值。本发明提供的一种可对空间任意位置的物体测量的聚焦测量方法及终端，能够实现待测目标物体在空间任意位置的测量。

Description

可对空间任意位置的物体测量的聚焦测量方法及终端
本案是以申请号为201910109939.4，申请日为2019年1月31日，名称为《一种聚焦测量方法及终端》的专利申请为母案的分案申请。
技术领域
本发明涉及测量技术领域，尤其涉及一种可对空间任意位置的物体测量的聚焦测量方法及终端。
背景技术
图像测量应用于各个领域。单目视觉系统结构简单，应用方便，在不借助已知标准物的前提下，只能对图像中已标定的单个物理平面上的目标进行测量。但实际应用场景中，由于待测目标物体处于空间任意位置，甚至不处于任何物理平面上，上述的单目视觉系统无法实现对待测目标物体的测量。
发明内容
本发明所要解决的技术问题是：本发明提供了一种可对空间任意位置的物体测量的聚焦测量方法及终端，能够实现待测目标物体在空间任意位置的测量。
为了解决上述技术问题，本发明提供了一种可对空间任意位置的物体测量的聚焦测量方法，包括以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值。
本发明还提供了一种聚焦测量终端，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值。
本发明的有益效果为：
本发明提供的一种可对空间任意位置的物体测量的聚焦测量方法和终端，获取待测目标物体上目标点的空间坐标；旋转云台，使所述待测目标物体位于云台上的摄像机的可视区域内，并确定所述待测目标物体的聚焦平面；拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系，从而计算得到待测目标物体的测量值。本发明通过上述方法确定的聚焦平面，并计算得到待测目标物体的图像与聚焦平面的映射关系，并根据所述映射关系，所述把待测目标物体的图像映射到聚焦平面上，能够实现对空间任意位置的待测目标物体的测量。
附图说明
图1为根据本发明实施例的一种可对空间任意位置的物体测量的聚焦测量方法的主要步骤示意图；
图2为根据本发明实施例的一种聚焦测量终端的结构示意图；
图3为根据本发明实施例一中的坐标系示意图；
图4为根据本发明实施例二中的坐标系示意图；
图5为根据本发明实施例三中的坐标系示意图；
标号说明：
1、存储器；2、处理器。
具体实施方式
为详细说明本发明的技术内容、所实现目的及效果，以下结合实施方式并配合附图详予说明。
本发明最关键的构思为：获取待测目标物体上目标点的空间坐标；旋转云台，使所述待测目标物体位于云台上的摄像机的可视区域内，并确定所述待测目标物体的聚焦平面；拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系，从而计算得到待测目标物体的测量值。
请参照图1，本发明提供了一种可对空间任意位置的物体测量的聚焦测量方法，包括以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值。
从上述描述可知，本发明提供的一种可对空间任意位置的物体测量的聚焦测量方法，获取待测目标物体上目标点的空间坐标；旋转云台，使所述待测目标物体位于云台上的摄像机的可视区域内，并确定所述待测目标物体的聚焦平面；拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系，从而计算得到待测目标物体的测量值。本发明通过上述方法确定的聚焦平面，并计算得到待测目标物体的图像与聚焦平面的映射关系，并根据所述映射关系，所述把待测目标物体的图像映射到聚焦平面上，能够实现对空间任意位置的待测目标物体的测量。
进一步的，所述S1具体为：
旋转云台，使云台上设置的激光器对准所述目标点，并记录云台的旋转角度，得到第一云台旋转角度；
通过所述激光器对所述目标点进行测距，得到激光距离；
根据所述激光距离和第一云台旋转角度，计算得到所述目标点的空间坐标。
从上述描述可知，通过上述方法，能够快速准确地计算得到目标点的空间坐标，提高了聚焦测量的效率。
进一步的，所述S2具体为：
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第二云台旋转角度；
根据所述目标点的空间坐标及第二云台旋转角度，确定当前状态下所述待测目标物体的聚焦平面。
从上述描述可知，通过上述方法，能够确定处于任何空间位置下的待测目标物体的聚焦平面，从而确定拍摄的图像与聚焦平面之间的映射关系，从而实现对空间任意位置的待测目标物体的测量。
进一步的，所述S3具体为：
通过所述摄像头拍摄所述待测目标物体的图像，并根据所述摄像机的内部参数、目标点的空间坐标、第一云台旋转角度及第二云台旋转角度，计算所述图像与所述聚焦平面之间的映射关系。
从上述描述可知，通过上述方法，能够快速精确地确定计算得到图像与所述聚焦平面的映射关系，从而确保处于空间任意某个位置的待测目标物体的测量。
进一步的，所述S1具体为：
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第一目标点，并记录云台的旋转角度，得到第三云台旋转角度；通过所述激光器对所述第一目标点进行测距，得到第一激光距离；根据所述第一激光距离和第三云台旋转角度，计算得到所述目标点的第一空间坐标；
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第二目标点，并记录云台的旋转角度，得到第四云台旋转角度；通过所述激光器对所述第二目标点进行测距，得到第二激光距离；根据所述第二激光距离和第四云台旋转角度，计算得到所述目标点的第二空间坐标；
所述S2具体为：
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第五云台旋转角度；根据所述第一空间坐标、所述第二空间坐标及第五云台旋转角度，确定当前状态下所述待测目标物体的聚焦平面；
所述S3具体为：
通过所述摄像头拍摄所述待测目标物体的图像，并根据所述摄像机的内部参数、第一空间坐标、第二空间坐标、第三云台旋转角度、第四云台旋转角度和第五云台旋转角度，计算所述图像与所述聚焦平面之间的映射关系。
从上述描述可知，通过上述方法，能够实现对空间任意位置的待测目标物体的测量，且能够保证测量的精度。
请参照图2，本发明还提供了一种聚焦测量终端，包括存储器1、处理器2及存储在存储器1上并可在处理器2上运行的计算机程序，所述处理器2执行所述计算机程序时实现以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值。
从上述描述可知，本发明提供的一种聚焦测量终端，获取待测目标物体上目标点的空间坐标；旋转云台，使所述待测目标物体位于云台上的摄像机的可视区域内，并确定所述待测目标物体的聚焦平面；拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系，从而计算得到待测目标物体的测量值。本发明通过上述方法确定的聚焦平面，并计算得到待测目标物体的图像与聚焦平面的映射关系，并根据所述映射关系，所述把待测目标物体的图像映射到聚焦平面上，能够实现对空间任意位置的待测目标物体的测量。
进一步的，所述的一种聚焦测量终端，所述S1具体为：
旋转云台，使云台上设置的激光器对准所述目标点，并记录云台的旋转角度，得到第一云台旋转角度；
通过所述激光器对所述目标点进行测距，得到激光距离；
根据所述激光距离和第一云台旋转角度，计算得到所述目标点的空间坐标。
从上述描述可知，通过上述终端，能够快速准确地计算得到目标点的空间坐标，提高了聚焦测量的效率。
进一步的，所述的一种聚焦测量终端，所述S2具体为：
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第二云台旋转角度；
根据所述目标点的空间坐标及第二云台旋转角度，确定当前状态下所述待测目标物体的聚焦平面。
从上述描述可知，通过上述终端，能够确定处于任何空间位置下的待测目标物体的聚焦平面，从而确定拍摄的图像与聚焦平面之间的映射关系，从而实现对空间任意位置的待测目标物体的测量。
进一步的，所述的一种聚焦测量终端，所述S3具体为：
通过所述摄像头拍摄所述待测目标物体的图像，并根据所述摄像机的内部参数、目标点的空间坐标、第一云台旋转角度及第二云台旋转角度，计算所述图像与所述聚焦平面之间的映射关系。
从上述描述可知，通过上述终端，能够快速精确地确定计算得到图像与所述聚焦平面的映射关系，从而确保处于空间任意某个位置的待测目标物体的测量。
进一步的，所述的一种聚焦测量终端，所述S1具体为：
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第一目标点，并记录云台的旋转角度，得到第三云台旋转角度；通过所述激光器对所述第一目标点进行测距，得到第一激光距离；根据所述第一激光距离和第三云台旋转角度，计算得到所述目标点的第一空间坐标；
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第二目标点，并记录云台的旋转角度，得到第四云台旋转角度；通过所述激光器对所述第二目标点进行测距，得到第二激光距离；根据所述第二激光距离和第四云台旋转角度，计算得到所述目标点的第二空间坐标；
所述S2具体为：
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第五云台旋转角度；根据所述第一空间坐标、所述第二空间坐标及第五云台旋转角度，确定当前状态下所述待测目标物体的聚焦平面；
所述S3具体为：
通过所述摄像头拍摄所述待测目标物体的图像，并根据所述摄像机的内部参数、第一空间坐标、第二空间坐标、第三云台旋转角度、第四云台旋转角度和第五云台旋转角度，计算所述图像与所述聚焦平面之间的映射关系。
从上述描述可知，通过上述终端，能够实现对空间任意位置的待测目标物体的测量，且能够保证测量的精度。
请参照图1和图3，本发明的实施例一为：
本发明提供了一种可对空间任意位置的物体测量的聚焦测量方法，包括以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
其中，所述S1具体为：
云台上设有摄像机和激光器，所述云台为二轴旋转云台，可绕水平方向进行旋转(即绕云台的预设第二旋转轴进行旋转)，以及可绕竖直方向进行旋转(即绕云台的预设第一旋转轴进行旋转)，先旋转云台，使云台处于初始位置(水平方向与竖直方向的旋转角均为0度)，以当前状态下，激光器的激光束所在的方向为ZO轴，云台绕竖直方向旋转的第一旋转轴所在的方向为XO轴，云台绕水平方向旋转的第二旋转轴所在的方向为YO轴，建立初始坐标系O-XOYOZO，O为坐标原点；
旋转云台，使云台上设置的激光器对准所述目标点A，并记录云台的旋转角度，得到第一云台旋转角度，所述第一旋转角度包括云台绕竖直方向(第一旋转轴)旋转的角度αa和云台绕水平方向(第二旋转轴)旋转的角度βa；
通过所述激光器对所述目标点进行测距，得到激光距离
Figure BDA0002375436800000081
根据所述激光距离和第一云台旋转角度，计算得到所述目标点A在坐标系O-XoYoZo下的坐标
Figure BDA0002375436800000082
其中，
Figure BDA0002375436800000083
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
其中，所述S2具体为：
旋转云台，使云台处于初始位置；
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第二云台旋转角度，所述第二云台旋转角度包括云台绕第一旋转轴旋转的角度αe和云台绕第二旋转轴旋转的角度βe；
以当前状态下，云台第一旋转轴所在的方向为Xe轴，云台第二旋转轴所在的方向为Ye轴，激光器的激光束所在的方向为Ze轴，建立坐标系Oe-XeYeZe；根据A在坐标系XoYoZo下的坐标
Figure BDA0002375436800000084
和第二云台旋转角度，计算得到A点在XeYeZe下的坐标
Figure BDA0002375436800000085
其中，
Figure BDA0002375436800000086
以聚焦点A点为Ow原点，以平行于Xo轴作Xw轴，以平行于Zo轴作Zw轴，由OwXwZw组成聚焦平面π，Yw垂直于聚焦平面π，建立坐标系Ow-XwYwZw；得到坐标系Ow-XwYwZw与Oe-XeYeZe之间的转换关系：
Figure BDA0002375436800000091
其中
Figure BDA0002375436800000092
Figure BDA0002375436800000093
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
其中，所述S3具体为：
通过所述摄像头拍摄所述待测目标物体的图像，并建立图像坐标系，所述图像坐标系是以图像最左上角的点为原点，水平向右方向为u轴，竖直向下方向为v轴，所创建的坐标系为uv坐标系；
根据摄像机内部参数K，得到坐标系uv与坐标系Oe-XeYeZe之间的映射关系：
Figure BDA0002375436800000094
由于聚焦平面π上Yw＝0，可得坐标系uv与坐标系Ow-XwYwZw映射关系：
Figure BDA0002375436800000095
其中，所述
Figure BDA0002375436800000096
是摄像头的固有矩阵，(u0,v0)是摄像头光学中心在CCD成像平面上的投影位置，f是摄像头的焦距，dx和dy分别是CCD每个像素在水平方向和垂直方向上的物理尺寸。所述γ为预设的缩放因子，当γ＝1时，得到的测量尺寸大小与待测目标物体的尺寸大小相同；当γ＝2时，得到的测量尺寸大小为待测目标物体的尺寸的两倍；当γ＝3时，得到的测量尺寸大小为待测目标物体的尺寸的三倍；当γ＝0.5时，得到的测量尺寸大小为待测目标物体的尺寸的0.5倍
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值；
其中，所述S4具体为：
在图像上选取待测目标的图像坐标，由步骤S3得到的坐标系uv与Ow-XwYwZw之间的映射关系，转换为坐标系Ow-XwYwZw下的坐标，即实现待测目标物体的测量。
请参照图1和图4，本发明的实施例二为：
本发明提供了一种可对空间任意位置的物体测量的聚焦测量方法，包括以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
其中，所述S1具体为：
云台上设有摄像机和激光器，所述云台为二轴旋转云台，可绕水平方向进行旋转，以及可绕竖直方向进行旋转，先旋转云台，使云台处于初始位置(水平方向与竖直方向的旋转角均为0度)，以当前状态下，激光器的激光束所在的方向为ZO轴，云台绕竖直方向旋转的第一旋转轴所在的方向为XO轴，云台绕水平方向旋转的第二旋转轴所在的方向为YO轴，建立初始坐标系O-XOYOZO，O为坐标原点；
旋转云台，使云台上设置的激光器对准预设的第一目标点A，并记录云台的旋转角度，得到第三云台旋转角度，所述第三旋转角度包括云台绕竖直方向(第一旋转轴)旋转的角度αa和云台绕水平方向(第二旋转轴)旋转的角度βa；
通过所述激光器对所述目标点进行测距，得到激光距离
Figure BDA0002375436800000101
根据所述激光距离和第三云台旋转角度，计算得到所述第一目标点A在坐标系XoYoZo下的坐标
Figure BDA0002375436800000102
其中，
Figure BDA0002375436800000103
旋转云台，使云台处于初始位置；
旋转云台，使云台上设置的激光器对准预设的第二目标点B，并记录云台的旋转角度，得到第四云台旋转角度，所述第四旋转角度包括云台绕竖直方向(第一旋转轴)旋转的角度αb和云台绕水平方向(第二旋转轴)旋转的角度βb；
通过所述激光器对所述第二目标点B进行测距，得到激光距离
Figure BDA0002375436800000111
根据所述激光距离和第四云台旋转角度，计算得到所述第二目标点B在坐系O-XoYoZo下的坐标
Figure BDA0002375436800000112
其中，
Figure BDA0002375436800000113
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
其中，所述S2具体为：
旋转云台，使云台处于初始位置；
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第五云台旋转角度，所述第五云台旋转角度包括云台绕第一旋转轴旋转的角度αe和云台绕第二旋转轴旋转的角度βe；
以当前状态下，云台第一旋转轴所在的方向为Xe轴，云台第二旋转轴所在的方向为Ye轴，激光器的激光束所在的方向为Ze轴，建立坐标系Oe-XeYeZe；根据A在坐标系XoYoZo下的坐标
Figure BDA0002375436800000114
和第五云台旋转角度，计算得到A点在XeYeZe下的坐标
Figure BDA0002375436800000115
其中，
Figure BDA0002375436800000116
根据B在坐标系XoYoZo下的坐标
Figure BDA0002375436800000117
和第五云台旋转角度，计算得到B点在XeYeZe下的坐标
Figure BDA0002375436800000119
其中，
Figure BDA0002375436800000118
连接A、B两点，得到直线AB；穿过A点或B点，得到平行于Ye轴的直线L；由直线AB和直线L组成聚焦平面π，得到Ze轴与聚焦平面π的交点Ow；以Ow为原点，以平行于Ye轴方向为Yw方向，使Zw垂直于聚焦平面π，根据Yw和Zw确定Xw方向，从而建立坐标系Ow-XwYwZw；得到坐标系Ow-XwYwZw与Oe-XeYeZe之间的转换关系：
Figure BDA0002375436800000121
其中
Figure BDA0002375436800000122
Figure BDA0002375436800000123
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
其中，所述S3具体为：
通过所述摄像头拍摄所述待测目标物体的图像，并建立图像坐标系，所述图像坐标系是以图像最左上角的点为原点，水平向右方向为u轴，竖直向下方向为v轴，所创建的坐标系为uv坐标系；
根据摄像机内部参数K，得到坐标系uv与坐标系Oe-XeYeZe之间的映射关系：
Figure BDA0002375436800000124
由于聚焦平面π上Zw＝0，可得坐标系uv与坐标系Ow-XwYwZw映射关系：
Figure BDA0002375436800000125
其中，所述
Figure BDA0002375436800000126
是摄像头的固有矩阵，(u0,v0)是摄像头光学中心在CCD成像平面上的投影位置，f是摄像头的焦距，dx和dy分别是CCD每个像素在水平方向和垂直方向上的物理尺寸。所述γ为预设的缩放因子，当γ＝1时，得到的测量尺寸大小与待测目标物体的尺寸大小相同；当γ＝2时，得到的测量尺寸大小为待测目标物体的尺寸的两倍；当γ＝3时，得到的测量尺寸大小为待测目标物体的尺寸的三倍；当γ＝0.5时，得到的测量尺寸大小为待测目标物体的尺寸的0.5倍
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值；
其中，所述S4具体为：
在图像上选取待测目标的图像坐标，由步骤S3得到的坐标系uv与Ow-XwYwZw之间的映射关系，转换为坐标系Ow-XwYwZw下的坐标，即实现待测目标物体的测量。
请参照图1和图5，本发明的实施例三为：
本发明提供了一种可对空间任意位置的物体测量的聚焦测量方法，包括以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
其中，所述S1具体为：
云台上设有摄像机和激光器，所述云台为二轴旋转云台，可绕水平方向进行旋转，以及可绕竖直方向进行旋转，先旋转云台，使云台处于初始位置(水平方向与竖直方向的旋转角均为0度)，以当前状态下，激光器的激光束所在的方向为ZO轴，云台绕竖直方向旋转的第一旋转轴所在的方向为XO轴，云台绕水平方向旋转的第二旋转轴所在的方向为YO轴，建立初始坐标系O-XOYOZO，O为坐标原点；
旋转云台，使云台上设置的激光器对准预设的第一目标点A，并记录云台的旋转角度，得到第六云台旋转角度，所述第六旋转角度包括云台绕竖直方向(第一旋转轴)旋转的角度αa和云台绕水平方向(第二旋转轴)旋转的角度βa；
通过所述激光器对所述目标点进行测距，得到激光距离
Figure BDA0002375436800000131
根据所述激光距离和第六云台旋转角度，计算得到所述第一目标点A在坐标系XoYoZo下的坐标
Figure BDA0002375436800000132
其中，
Figure BDA0002375436800000133
旋转云台，使云台处于初始位置；
旋转云台，使云台上设置的激光器对准预设的第二目标点B，并记录云台的旋转角度，得到第七云台旋转角度，所述第七旋转角度包括云台绕竖直方向(第一旋转轴)旋转的角度αb和云台绕水平方向(第二旋转轴)旋转的角度βb；
通过所述激光器对所述第二目标点B进行测距，得到激光距离
Figure BDA0002375436800000141
根据所述激光距离和第七云台旋转角度，计算得到所述第二目标点B在坐系O-XoYoZo下的坐标
Figure BDA0002375436800000142
其中，
Figure BDA0002375436800000143
旋转云台，使云台处于初始位置；
旋转云台，使云台上设置的激光器对准预设的第三目标点C，并记录云台的旋转角度，得到第八云台旋转角度，所述第八旋转角度包括云台绕竖直方向(第一旋转轴)旋转的角度αc和云台绕水平方向(第二旋转轴)旋转的角度βc；
通过所述激光器对所述第三目标点C进行测距，得到激光距离
Figure BDA0002375436800000144
根据所述激光距离和第八云台旋转角度，计算得到所述第三目标点C在坐系O-XoYoZo下的坐标
Figure BDA0002375436800000145
其中，
Figure BDA0002375436800000146
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
其中，所述S2具体为：
旋转云台，使云台处于初始位置；
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第九云台旋转角度，所述第九云台旋转角度包括云台绕第一旋转轴旋转的角度αe和云台绕第二旋转轴旋转的角度βe；本发明中云台旋转角度均是相对于云台初始状态下的旋转角度；
以当前状态下，云台第一旋转轴所在的方向为Xe轴，云台第二旋转轴所在的方向为Ye轴，激光器的激光束所在的方向为Ze轴，建立坐标系Oe-XeYeZe；根据A在坐标系XoYoZo下的坐标
Figure BDA0002375436800000151
和第九云台旋转角度，计算得到A点在XeYeZe下的坐标
Figure BDA0002375436800000152
其中，
Figure BDA0002375436800000153
根据B在坐标系XoYoo下的坐标
Figure BDA0002375436800000154
和第九云台旋转角度，计算得到B点在XeYeZe下的坐标
Figure BDA0002375436800000155
其中，
Figure BDA0002375436800000156
根据C在坐标系XoYoZo下的坐标
Figure BDA0002375436800000157
和第九云台旋转角度，计算得到C点在XeYeZe下的坐标
Figure BDA0002375436800000158
其中，
Figure BDA0002375436800000159
由A、B、C三点组成聚焦平面π，得到Ze轴与聚焦平面π的交点Ow；以Ow为原点，使Zw垂直于聚焦平面π，在聚焦平面π上垂直于预设的交线的方向为Yw方向，所述交线为聚焦平面π与平面OeXeZe的交线，根据Yw和Zw确定Xw，从而建立坐标系Ow-XwYwZw；得到坐标系Ow-XwYwZw与Oe-XeYeZe之间的转换关系：
Figure BDA00023754368000001510
其中
Figure BDA00023754368000001511
Figure BDA00023754368000001512
ω为Yw轴和平面OeXeZe夹角的余角，
Figure BDA00023754368000001513
为聚焦平面π与平面OeXeZe的交线和Ze轴的夹角；
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
其中，所述S3具体为：
通过所述摄像头拍摄所述待测目标物体的图像，并建立图像坐标系，所述图像坐标系是以图像最左上角的点为原点，水平向右方向为u轴，竖直向下方向为v轴，所创建的坐标系为uv坐标系；
根据摄像机内部参数K，得到坐标系uv与坐标系Oe-XeYeZe之间的映射关系：
Figure BDA0002375436800000161
由于聚焦平面π上Zw＝0，可得坐标系uv与坐标系Ow-XwYwZw映射关系：
Figure BDA0002375436800000162
其中，所述
Figure BDA0002375436800000163
是摄像头的固有矩阵，(u0,v0)是摄像头光学中心在CCD成像平面上的投影位置，f是摄像头的焦距，dx和dy分别是CCD每个像素在水平方向和垂直方向上的物理尺寸。所述γ为预设的缩放因子，当γ＝1时，得到的测量尺寸大小与待测目标物体的尺寸大小相同；当γ＝2时，得到的测量尺寸大小为待测目标物体的尺寸的两倍；当γ＝3时，得到的测量尺寸大小为待测目标物体的尺寸的三倍；当γ＝0.5时，得到的测量尺寸大小为待测目标物体的尺寸的0.5倍
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值；
其中，所述S4具体为：
在图像上选取待测目标的图像坐标，由步骤S3得到的坐标系uv与Ow-XwYwZw之间的映射关系，转换为坐标系Ow-XwYwZw下的坐标，即实现待测目标物体的测量。
请参照图2，本发明的实施例四为：
本发明提供的一种聚焦测量终端，包括存储器1、处理器2及存储在存储器1上并可在处理器2上运行的计算机程序，所述处理器2执行所述计算机程序时实现实施例一中的所有步骤。
本发明的实施例五为：
本发明提供的一种聚焦测量终端，包括存储器1、处理器2及存储在存储器1上并可在处理器2上运行的计算机程序，所述处理器2执行所述计算机程序时实现实施例二中的所有步骤。
本发明的实施例六为：
本发明提供的一种聚焦测量终端，包括存储器1、处理器2及存储在存储器1上并可在处理器2上运行的计算机程序，所述处理器2执行所述计算机程序时实现实施例三中的所有步骤。
综上所述，本发明提供的一种可对空间任意位置的物体测量的聚焦测量方法和终端，获取待测目标物体上目标点的空间坐标；旋转云台，使所述待测目标物体位于云台上的摄像机的可视区域内，并确定所述待测目标物体的聚焦平面；拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系，从而计算得到待测目标物体的测量值。本发明通过上述方法确定的聚焦平面，并计算得到待测目标物体的图像与聚焦平面的映射关系，并根据所述映射关系，所述把待测目标物体的图像映射到聚焦平面上，能够实现对空间任意位置的待测目标物体的测量。
以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等同变换，或直接或间接运用在相关的技术领域，均同理包括在本发明的专利保护范围内。

Claims (2)

1.一种可对空间任意位置的物体测量的聚焦测量方法，其特征在于，包括以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值；
所述S1具体为：
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第一目标点，并记录云台的旋转角度，得到第六云台旋转角度；通过所述激光器对所述第一目标点进行测距，得到第一激光距离；根据所述第一激光距离和第六云台旋转角度，计算得到所述第一目标点的第一空间坐标；
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第二目标点，并记录云台的旋转角度，得到第七云台旋转角度；通过所述激光器对所述第二目标点进行测距，得到第二激光距离；根据所述第二激光距离和第七云台旋转角度，计算得到所述第二目标点的第二空间坐标；
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第三目标点，并记录云台的旋转角度，得到第八云台旋转角度；通过所述激光器对所述第三目标点进行测距，得到第三激光距离；根据所述第三激光距离和第八云台旋转角度，计算得到所述第三目标点的第三空间坐标；
所述S2具体为：
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第九云台旋转角度；
由所述第一空间坐标、第二空间坐标和第三空间坐标组成聚焦平面，所述第一空间坐标、第二空间坐标和第三空间坐标不共线；
所述步骤S3包括：
通过摄像头拍摄所述待测目标物体的图像，并根据所述摄像机的内部参数、第一空间坐标、第二空间坐标、第三空间坐标、第六云台旋转角度、第七云台旋转角度、第八云台旋转角度和第九云台旋转角度，计算所述图像与所述聚焦平面之间的映射关系。
2.一种可对空间任意位置的物体测量的聚焦测量终端，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述计算机程序时实现以下步骤：
S1：获取待测目标物体上预设的目标点的空间坐标；
S2：旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并确定当前状态下所述待测目标物体的聚焦平面；
S3：拍摄所述待测目标物体的图像，并根据所述目标点的空间坐标以及云台的旋转角度，计算所述图像与所述聚焦平面之间的映射关系；
S4：获取所述图像上待测目标物体的坐标值，并代入所述映射关系，计算得到所述待测目标物体的测量值；
所述S1具体为：
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第一目标点，并记录云台的旋转角度，得到第六云台旋转角度；通过所述激光器对所述第一目标点进行测距，得到第一激光距离；根据所述第一激光距离和第六云台旋转角度，计算得到所述第一目标点的第一空间坐标；
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第二目标点，并记录云台的旋转角度，得到第七云台旋转角度；通过所述激光器对所述第二目标点进行测距，得到第二激光距离；根据所述第二激光距离和第七云台旋转角度，计算得到所述第二目标点的第二空间坐标；
旋转云台，使云台上设置的激光器对准待测目标物体上预设的第三目标点，并记录云台的旋转角度，得到第八云台旋转角度；通过所述激光器对所述第三目标点进行测距，得到第三激光距离；根据所述第三激光距离和第八云台旋转角度，计算得到所述第三目标点的第三空间坐标；
所述S2具体为：
旋转云台，使所述待测目标物体位于云台上设置的摄像机的可视区域内，并记录云台的旋转角度，得到第九云台旋转角度；
由所述第一空间坐标、第二空间坐标和第三空间坐标组成聚焦平面，所述第一空间坐标、第二空间坐标和第三空间坐标不共线；
所述步骤S3包括：
通过摄像头拍摄所述待测目标物体的图像，并根据所述摄像机的内部参数、第一空间坐标、第二空间坐标、第三空间坐标、第六云台旋转角度、第七云台旋转角度、第八云台旋转角度和第九云台旋转角度，计算所述图像与所述聚焦平面之间的映射关系。
CN202010064115.2A 2019-01-31 2019-01-31 可对空间任意位置的物体测量的聚焦测量方法及终端 Active CN111220130B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010064115.2A CN111220130B (zh) 2019-01-31 2019-01-31 可对空间任意位置的物体测量的聚焦测量方法及终端

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202010064115.2A CN111220130B (zh) 2019-01-31 2019-01-31 可对空间任意位置的物体测量的聚焦测量方法及终端
CN201910109939.4A CN109855603B (zh) 2019-01-31 2019-01-31 一种聚焦测量方法及终端

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
CN201910109939.4A Division CN109855603B (zh) 2019-01-31 2019-01-31 一种聚焦测量方法及终端

Publications (2)

Publication Number Publication Date
CN111220130A CN111220130A (zh) 2020-06-02
CN111220130B true CN111220130B (zh) 2022-09-13

Family

ID=66897722

Family Applications (5)

Application Number Title Priority Date Filing Date
CN202010064114.8A Active CN111220129B (zh) 2019-01-31 2019-01-31 一种带旋转云台的聚焦测量方法及终端
CN202010062399.1A Active CN111220127B (zh) 2019-01-31 2019-01-31 一种激光聚焦测量方法及终端
CN202010062400.0A Active CN111220128B (zh) 2019-01-31 2019-01-31 一种单目聚焦的测量方法及终端
CN201910109939.4A Active CN109855603B (zh) 2019-01-31 2019-01-31 一种聚焦测量方法及终端
CN202010064115.2A Active CN111220130B (zh) 2019-01-31 2019-01-31 可对空间任意位置的物体测量的聚焦测量方法及终端

Family Applications Before (4)

Application Number Title Priority Date Filing Date
CN202010064114.8A Active CN111220129B (zh) 2019-01-31 2019-01-31 一种带旋转云台的聚焦测量方法及终端
CN202010062399.1A Active CN111220127B (zh) 2019-01-31 2019-01-31 一种激光聚焦测量方法及终端
CN202010062400.0A Active CN111220128B (zh) 2019-01-31 2019-01-31 一种单目聚焦的测量方法及终端
CN201910109939.4A Active CN109855603B (zh) 2019-01-31 2019-01-31 一种聚焦测量方法及终端

Country Status (1)

Country Link
CN (5) CN111220129B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111114814B (zh) * 2020-01-16 2022-04-08 四川川测研地科技有限公司 基于无人飞行器对线性工程对象的自适应聚焦云台
CN111811794B (zh) * 2020-06-18 2022-05-20 浙江大华技术股份有限公司 一种云台自检方法、装置、计算设备及存储介质
CN111867214B (zh) * 2020-07-28 2023-05-05 广东艾罗照明科技股份有限公司 一种灯光照射角度控制系统、方法及装置
CN114688996B (zh) * 2020-12-31 2023-11-03 北京华航无线电测量研究所 一种转台回转精度角度的测量方法
CN113027075A (zh) * 2021-03-10 2021-06-25 成都昊图新创科技有限公司 一种标线装置和标线方法
CN113124819B (zh) * 2021-06-17 2021-09-10 中国空气动力研究与发展中心低速空气动力研究所 一种基于平面镜的单目测距方法
CN113737798B (zh) * 2021-08-09 2023-03-14 中交第三航务工程局有限公司 一种打桩船用打桩定位测高系统
CN115143930B (zh) * 2022-06-27 2024-05-24 徐州徐工挖掘机械有限公司 一种单目摄像头测距方法、系统及挖掘机

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100506533B1 (ko) * 2003-01-11 2005-08-05 삼성전자주식회사 이동로봇 및 그에 따른 자율주행 시스템 및 방법
CN101839692B (zh) * 2010-05-27 2012-09-05 西安交通大学 单相机测量物体三维位置与姿态的方法
CN102445183B (zh) * 2011-10-09 2013-12-18 福建汇川数码技术科技有限公司 基于激光与摄像机平行实现的远程测距系统测距激光点的定位方法
US9335415B2 (en) * 2012-10-31 2016-05-10 The Boeing Company Modulated laser range finder and method
MY184651A (en) * 2014-01-20 2021-04-14 Pillay Venkateshwara A system for mapping and tracking ground targets
CN106441278A (zh) * 2016-09-29 2017-02-22 长沙开元仪器股份有限公司 一种无人机室内定位系统及方法
CN107101580B (zh) * 2017-05-18 2018-04-20 金钱猫科技股份有限公司 一种基于激光的图像测量方法、系统及装置
CN109100382B (zh) * 2018-07-27 2021-05-28 北京矿冶科技集团有限公司 Bpma的分区聚焦测量方法
CN110838164B (zh) * 2018-08-31 2023-03-24 金钱猫科技股份有限公司 基于物体点深度的单目图像三维重建方法、系统及装置

Also Published As

Publication number Publication date
CN111220128B (zh) 2022-10-25
CN111220127B (zh) 2022-07-26
CN109855603A (zh) 2019-06-07
CN111220130A (zh) 2020-06-02
CN111220128A (zh) 2020-06-02
CN109855603B (zh) 2019-12-13
CN111220129B (zh) 2022-10-25
CN111220129A (zh) 2020-06-02
CN111220127A (zh) 2020-06-02

Similar Documents

Publication Publication Date Title
CN111220130B (zh) 可对空间任意位置的物体测量的聚焦测量方法及终端
CN110057295B (zh) 一种免像控的单目视觉平面距离测量方法
CN108844456B (zh) 一种快速图像测量方法及系统
JP6573419B1 (ja) 位置決め方法、ロボット及びコンピューター記憶媒体
US20150116691A1 (en) Indoor surveying apparatus and method
CN108429908B (zh) 一种摄像模组的测试方法、装置、设备及介质
CN109544628B (zh) 一种指针式仪表的准确读数识别系统及方法
JP2004163292A (ja) 測量装置と電子的記憶媒体
CN109272555B (zh) 一种rgb-d相机的外部参数获得及标定方法
TW201520508A (zh) 探針補點系統及方法
CN110779491A (zh) 一种水平面上目标测距的方法、装置、设备及存储介质
CN109931906B (zh) 摄像机测距方法、装置以及电子设备
CN104807405B (zh) 一种基于光线角度标定的三维坐标测量方法
CN108180888A (zh) 一种基于可转动摄像头的距离检测方法
CN109493378B (zh) 一种基于单目视觉与双目视觉相结合的垂直度检测方法
CN109990801B (zh) 基于铅垂线的水平仪装配误差标定方法
CN109712200B (zh) 一种基于最小二乘原理及边长推算的双目定位方法及系统
CN105809685A (zh) 一种基于单幅同心圆图像的摄像机定标方法
TW565736B (en) Method for determining the optical parameters of a camera
CN107167109A (zh) 两点激光测量平面空间偏角的方法及装置
CN105333818B (zh) 基于单目摄像机的3d空间测量方法
CN113405532B (zh) 基于视觉系统结构参数的前方交会测量方法及系统
CN114663486A (zh) 一种基于双目视觉的建筑物测高方法及系统
CN112762829B (zh) 基于联动偏转式主动视觉系统的目标坐标测量方法及系统
CN109945840B (zh) 三维影像摄取方法及系统

Legal Events

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