基于单台高速相机的双目测量装置对平地机空间坐标测量方法制造方法及图纸

本发明专利技术涉及基于单台高速相机的双目测量装置对平地机空间坐标测量方法，利用单台高速相机在带有毫米刻度的导轨相机架上进行平移，模拟双台相机双目测量原理，对水田平地机平地铲以及机身上的点进行点的三维重建，测出控制点在高速相机坐标系下的点的坐标，利用双目测量原理公式实现高速相机坐标系到世界坐标系下的转换，从而得出平地机上任意控制点的世界坐标，为平地机多体动力学位姿分析提供基础。本发明专利技术成本低、操作便利、实现高精度的空间物理点三维坐标的测量，属于工程测量技术领域。

【技术实现步骤摘要】
基于单台高速相机的双目测量装置对平地机空间坐标测量方法
本专利技术涉及一种空间三维坐标测量方法，尤其是基于单台高速相机的双目测量装置对平地机空间坐标测量方法，属于工程测量

技术介绍
随着机器视觉技术在农业工程领域的出现以及广泛的应用，在机器结构的世界坐标系测量时可以采用摄像机进行点的测量(张振杰，2018年)，机器视觉利用两幅或者更多的二维图像来获取物体三维可见表面的几何形状，此方法就是三维重构技术，其中最重要的就是摄像机模型与对极几何约束建立(杨景豪，2016年)。事实上，在机器结构中，刚体中控制点的三维坐标变换也可以视作线性变换。在刚体空间点研究中，机器视觉技术往往需要使用多台相机获取多幅图像，或单台相机进行移动测量，最后采用图像分析软件对数据进行处理(CappettiN，2016年)，此方法需要耗费大量成本与人力。因此，需要提出一种基于单台相机的测试方法，设计一种带刻度的导轨装置，方便相机的安装与测量，同时，需要提出一种简化算法，用以计算相机坐标系与空间三维坐标系的转换关系，来解决操作不便、价格昂贵等问题。
技术实现思路
针对现有技术中存在的技术问题，本专利技术的目的是：提供一种基于单台高速相机的双目测量装置对平地机空间坐标测量方法，该方法操作便利，采用单台高速相机即可模拟双台相机双目测量原理，实现高精度的空间物理点三维坐标的测量。为了达到上述目的，本专利技术采用如下技术方案：基于单台高速相机的双目测量装置对平地机空间坐标测量方法，双目测量装置包括带刻度导轨的相机架，单台高速相机在导轨上平移，模拟双台相机双目测量原理，高速相机上设置相机坐标系，得到控制点的相机坐标；部分控制点Pn位于平地机的平地铲上，平地铲上设置局部坐标系，测得Pn点的局部坐标，从而求得局部坐标系到相机坐标系的转化关系；部分控制点Qn位于平地机的机身上，机身上设置全局坐标系，测得Qn点的全局坐标，从而求得全局坐标系到相机坐标系之间的转化关系；根据局部坐标系到相机坐标系的转化关系、全局坐标系到相机坐标系之间的转化关系、控制点在相机坐标系下的坐标，求出任意控制点在局部坐标系和全局坐标系下的坐标。作为一种优选，对于机身上难以测得全局坐标的点Qn’以及平地铲上难以测得局部坐标的点Pn’,但是Pn’和Qn’点的相机坐标容易求得，根据求得的局部坐标系到相机坐标系的转化关系、求得的全局坐标系到相机坐标系之间的转化关系、测量的控制点在相机坐标系下的坐标，求出Pn’的局部坐标和Qn’点的全局坐标。作为一种优选，根据测得的控制点的全局坐标，以及Pn和Pn’点的局部坐标，求出局部坐标系到全局坐标系的转化关系，从而求出平地机上任意控制点的全局坐标。作为一种优选，双目测量装置包括导轨、滑块、架体；导轨安装在架体上，滑块沿着导轨平移，导轨上标有毫米级刻度，高速相机安装在滑块上；高速相机的中心轴线与导轨垂直，从而形成双目平行的效果，高速相机选定的两个位置之间的距离为T。作为一种优选，根据双目测量原理，相机坐标系建立在左侧高速相机的光心处，右侧高速相机用左侧高速相机平移来等效，单台高速相机实现双目测量，具体包括：相机坐标系的原点OCL在光心处，ZL轴沿光轴指向景深背侧，XL轴指向右侧且与导轨方向平行，右手定则确定YL轴，得到OCLXLYLZL；将原点沿XL轴进行平移，得到右侧高速相机坐标系OCRXRYRZR。作为一种优选，根据像素坐标转换得到控制点的相机坐标，具体包括：物理点P是空间待测物体上的控制点，PL指P点表示在左侧高速相机坐标系下的坐标，左侧高速相机的成像平面与相机坐标系平行，PL、PR是P在像平面上的成像点，于是:PLPR||OCLOCR其中，用表示对两点取模(长度)，则上述公式推导为:式中，T是指两台相机光心的水平距离，PLL是指P在左相机像平面的成像点，PL在OCLXLYLZL坐标系下的坐标，PRR是指P在右相机像平面的成像点，PR在OCLXLYLZL坐标系下的坐标；由公式(1)求出任意物理点在左侧高速相机坐标系下的坐标。作为一种优选，左右侧高速相机的像素距离由高速相机配套软件TEMA进行处理，具体包括：TEMA软件用来读取物理点的像素坐标，从而获取点在左右侧高速相机成像平面的像素距离因此公式(1)计算得到每一个物理点在左侧高速相机坐标系下的坐标。作为一种优选，水田平地机作为测试平台，静止时，视作平地机的机身固定不动，具体包括：在机身上建立全局坐标系XwYwZw，在平地铲的质心处建立局部坐标系XBYBZB，其中Pn点为局部坐标系下的容易用尺子测得局部坐标的控制点，个数为n，其中n≥3；；Pn’点是指局部坐标系中直接用尺子难以测得局部坐标的点，这里Pn与Pn’统称为P点；同理有，Qn点为全局坐标系下的容易用尺子测得全局坐标的控制点，Qn’点是指全局坐标系中直接用尺子难以测得全局坐标的点，这里Qn和Qn’点统称为Q点；以下分别用B、W、C来表示局部坐标系、全局坐标系、左侧相机坐标系，B、W中的点均用C测得；用PW表示P点在W坐标系下的坐标，则P’B表示P’点在B坐标系下的坐标，RBW表示由坐标系B到W的旋转矩阵，TB/C表示B坐标系原点在C坐标系下的坐标，这里的目的是求得PW、P’B、RBW、TB/C。作为一种优选，根据坐标转换公式得出B与W、B与C坐标系转换结果具体包括：由坐标转换关系可得：由(2)(3)可得到：又有：TB/W＝TB/C+TC/W＝TB/C-TW/C(7)将(6)(7)带入(5)中可得：由(3)带入(8)可得：若上述转换矩阵R与平移矩阵T用一个矩阵表示，引入齐次坐标，此时P、R均为齐次形式，P为4×1矩阵，R为4×4矩阵，则有：从而可得：作为一种优选，根据公式(13)，求出左侧高速相机坐标系与局部坐标系、左侧高速相机坐标系与全局坐标系，结合相机坐标系下各物理点的坐标，最终全部换算到全局坐标系下；具体包括：求出Pn、Pn’，Qn、Qn’任意点的全局坐标，其中Pn’、Qn’点的左侧高速相机坐标是容易获取的。本专利技术利用单台高速相机在带有毫米刻度的导轨相机架上进行平移，模拟双台相机双目测量原理，对水田平地机平地铲以及机身上的点进行点的三维重建，测出控制点在高速相机坐标系下的点的坐标，利用双目测量原理公式实现高速相机坐标系到世界坐标系下的转换，从而得出平地机上任意控制点的世界坐标，为平地机多体动力学位姿分析提供基础。总的说来，本专利技术具有如下优点：1.本专利技术采用单台高速相机，并设计制作出与之相配套的导轨式相机架，滑块能沿着导轨滑动并卡紧高速相机，直接显示刻度也有助于直接读取左右侧高速相机距离，避免了多台相机成本高、操作不便，或者单台相机移动过程中的精度不够、误差较大等问题。2.本专利技术在传统双目相机测量原理上进行了进一步地升华，更加直观地推导相机坐标与像素坐标之间的转化关系；通过齐次坐标变换矩阵的求解简化相机坐标系与全局、局部坐标系之间的转换关系，从而实现更加方便的坐标求解。3.本专利技术以水田平地机作为实验平台，当水田平地机不运作时可以将机身视为固定，从而平地铲等结构视为简单运动副、运动构件，从而简化部分结构，更加清晰明了。平地铲上建立局部坐标系，机身上建立全局坐标系，系统推导相机坐标系与全局、局部坐标系之间的关系，从而实现对于多体系统中能本文档来自技高网...

【技术保护点】
1.基于单台高速相机的双目测量装置对平地机空间坐标测量方法，其特征在于：双目测量装置包括带刻度导轨的相机架，单台高速相机在导轨上平移，模拟双台相机双目测量原理，高速相机上设置相机坐标系，得到控制点的相机坐标；部分控制点Pn位于平地机的平地铲上，平地铲上设置局部坐标系，测得Pn点的局部坐标，从而求得局部坐标系到相机坐标系的转化关系；部分控制点Qn位于平地机的机身上，机身上设置全局坐标系，测得Qn点的全局坐标，从而求得全局坐标系到相机坐标系之间的转化关系；根据局部坐标系到相机坐标系的转化关系、全局坐标系到相机坐标系之间的转化关系、控制点在相机坐标系下的坐标，求出任意控制点在局部坐标系和全局坐标系下的坐标。

【技术特征摘要】
1.基于单台高速相机的双目测量装置对平地机空间坐标测量方法，其特征在于：双目测量装置包括带刻度导轨的相机架，单台高速相机在导轨上平移，模拟双台相机双目测量原理，高速相机上设置相机坐标系，得到控制点的相机坐标；部分控制点Pn位于平地机的平地铲上，平地铲上设置局部坐标系，测得Pn点的局部坐标，从而求得局部坐标系到相机坐标系的转化关系；部分控制点Qn位于平地机的机身上，机身上设置全局坐标系，测得Qn点的全局坐标，从而求得全局坐标系到相机坐标系之间的转化关系；根据局部坐标系到相机坐标系的转化关系、全局坐标系到相机坐标系之间的转化关系、控制点在相机坐标系下的坐标，求出任意控制点在局部坐标系和全局坐标系下的坐标。2.按照权利要求1所述的基于单台高速相机的双目测量装置对平地机空间坐标测量方法，其特征在于：对于机身上难以测得全局坐标的点Qn’以及平地铲上难以测得局部坐标的点Pn’,但是Pn’和Qn’点的相机坐标容易求得，根据求得的局部坐标系到相机坐标系的转化关系、求得的全局坐标系到相机坐标系之间的转化关系、测量的控制点在相机坐标系下的坐标，求出Pn’的局部坐标和Qn’点的全局坐标。3.按照权利要求2所述的基于单台高速相机的双目测量装置对平地机空间坐标测量方法，其特征在于：根据测得的控制点的全局坐标，以及Pn和Pn’点的局部坐标，求出局部坐标系到全局坐标系的转化关系，从而求出平地机上任意控制点的全局坐标。4.按照权利要求1所述的基于单台高速相机的双目测量装置对平地机空间坐标测量方法，其特征在于：双目测量装置包括导轨、滑块、架体；导轨安装在架体上，滑块沿着导轨平移，导轨上标有毫米级刻度，高速相机安装在滑块上；高速相机的中心轴线与导轨垂直，从而形成双目平行的效果，高速相机选定的两个位置之间的距离为T。5.按照权利要求4所述的基于单台高速相机的双目测量装置对平地机空间坐标测量方法，其特征在于：根据双目测量原理，相机坐标系建立在左侧高速相机的光心处，右侧高速相机用左侧高速相机平移来等效，单台高速相机实现双目测量，具体包括：相机坐标系的原点OCL在光心处，ZL轴沿光轴指向景深背侧，XL轴指向右侧且与导轨方向平行，右手定则确定YL轴，得到OCLXLYLZL；将原点沿XL轴进行平移，得到右侧高速相机坐标系OCRXRYRZR。6.按照权利要求5所述的基于单台高速相机的双目测量装置对平地机空间坐标测量方法，其特征在于：根据像素坐标转换得到控制点的相机坐标，具体包括：物理点P是空间待测物体上的控制点，PL指P点表示在左侧高速相机坐标系下的坐标，左侧高速相机的成像平面与相机坐标系平行，PL、PR是P在像平面上的成像点，于是:PLPR|...

【专利技术属性】
技术研发人员：赵祚喜，宋俊文，谈婷，马昆鹏，罗阳帆，何振宇，徐伟诚，黎源鸿，
申请(专利权)人：华南农业大学，
类型：发明
国别省市：广东,44