一种基于飞行时间三维相机的尺寸测量方法技术

本发明专利技术涉及一种基于飞行时间三维相机的尺寸测量方法，将光源进行射频调制，通过三维ToF相机收集反射光并与解调信号作相关运算，主动改变解调信号的初始相位延迟，得到四组相关值，据此解出深度值并消除环境光；本发明专利技术通过设置数据转换模块以及模块内的算法，将控制系统获取各点的相机坐标系三维坐标转换为箱体的长宽高，能快速准确得到箱体的尺寸与体积。

A method of dimension measurement based on time-of-flight 3D camera

The invention relates to a dimension measurement method based on a three-dimensional time-of-flight camera. The light source is modulated by radio frequency, the reflected light is collected by the three-dimensional ToF camera and correlated with the demodulated signal, the initial phase delay of the demodulated signal is changed actively, and four sets of correlated values are obtained, according to which the depth value is solved and the ambient light is eliminated. By setting the data conversion module and the algorithm in the module, the three-dimensional coordinates of the camera coordinate system obtained by the control system can be converted into the length, width and height of the box, so that the size and volume of the box can be quickly and accurately obtained.

【技术实现步骤摘要】
一种基于飞行时间三维相机的尺寸测量方法
本专利技术涉及物流体积测量
，具体的说是一种基于飞行时间三维相机的尺寸测量方法。
技术介绍
现有的用于物流领域的三维测量设备是基于结构光的方案，对环境光抗干扰能力差，特别是在太阳光直射时所投射的红外离散斑点会被太阳光淹没，导致测量算法失效。基于此，针对上述现状中存在的局限性，本专利技术提出了一种能够解决现有尺寸测量方案中受环境光干扰问题的基于飞行时间三维相机的尺寸测量方法。
技术实现思路
为了解决上述现有技术中存在的问题，本专利技术提供一种能够解决现有尺寸测量方案中受环境光干扰问题的基于飞行时间三维相机的尺寸测量方法。本专利技术解决其技术问题所采用的技术方案是：一种基于飞行时间三维相机的尺寸测量方法，包括以下步骤：步骤一、通过三维ToF相机中的控制系统对光源进行射频调制处理，并将调制处理后的光源发射到箱体上；步骤二、通过三维ToF相机中的成像系统观察反射回来的对应光，获取得到像素坐标系中箱体上各像素点点坐标(u，v)；步骤三、通过三维ToF相机中的数据处理模块，获取像素坐标系中箱体上各像素点点坐标(u，v)并通过计算转化得到各点的相机坐标系三维坐标(Xc，Yc，Zc)；步骤四、控制系统获取各点的相机坐标系三维坐标(Xc，Yc，Zc)后传输至终端，终端内的数据转换模块将各点的相机坐标系三维坐标(Xc，Yc，Zc)转换为箱体的长宽高(L，W，H)，并通过终端内的数据输出模块输出显示。进一步地，所述步骤一种调制处理后的光源为方波。进一步地，所述步骤三中转化过程具体为，设定k×l为像素点的大小，f为成像系统的焦距，θ为相机坐标系的倾斜度，d为光源至箱体的测量距离，为发射光与反射光的相位差，c为光速常量，则像素坐标系与相机坐标系之间的转换关系为，式(1)：式(2)：式(3)：联合式(1)、式(2)、式(3)，得到(Xc，Yc，Zc)。更进一步地，所述步骤三中，发射光与反射光的相位差的具体计算过程为，设定τ为每次测量中主动改变延迟量，通过四次测量，并在每次测量中改变延迟量τ，环境光为常量K，得到：对上述关系式通过差模的方式，消除常数项K，得到：进一步地，所述步骤四中，箱体的长宽高(L，W，H)的转化过程为，所述数据转换模块设置有判断准则模型，利用判断准则迭代剔除与所估计参数不一致的输入数据，通过输入正确的数据估计模型参数，具体为：S1、将控制系统获取各点的相机坐标系三维坐标的初始点云数据随机选择一些点，组成子集L1，用最小二乘法得到初始化平面模型的参数A、B、C，模型为AX+BY+CZ+D＝0；S2、用步骤S1得到的模型AX+BY+CZ+D＝0去测试子集L2，L2为子集L1之外的数据，设置阈值d，d为任一点到平面模型的距离，子集L2中与模型误差小于d的点集L’与L1构成集合L*，集合L*为内点集，其余为局外点；S3、统计内点集L*内点的个数，判断是否大于初始点云内点的个数的1/3，如果是，则用内点集L*内的数据估计新模型参数A’、B’、C’，作为新模型的输出，如果不是，则与当前最大的内点集L*内的点的个数对比，若大于，则取代当前最大内点集的个数，并存储当前模型的参数；S4、重复步骤S1-S3，进行迭代处理，对每次迭代产生的模型进行筛选，当内点集内点太少时则舍弃，当比当前模型更好时则进行替换，去除掉非箱体的点云，得到箱体的点云；S5、对箱体的点云进行滤波与聚类，得到更精确的箱体的点云P；S6、对获取的点云P进行边缘性检测，得到箱体边缘的点云p；S7、对获取的点云p进行直线检测得到箱体的直线边缘轮廓；S8、找到箱体的直线边缘轮廓的端点坐标，通过计算得到箱体的长宽高(L，W，H)；S9、通过长宽高之乘积计算箱体体积。更进一步地，所述步骤S2中，阈值d设置为0.01m。更进一步地，所述步骤S4中，迭代次数设置为50次。更进一步地，所述步骤S5中，滤波包括直通滤波和StatisOutlierRemoval滤波器滤波，所述直通滤波用于过滤左右噪声，所述StatisOutlierRemoval滤波器过滤离群点，计算每一个点到与该点所有临近点的平均距离，平均距离在一个标准差范围之外的点，即为离群点；聚类为距离聚类，用于分离出箱体和其他凝聚起来的噪声。更进一步地，所述步骤S6中，边缘性检测过程为：对于点云P中的一个点q及距离q最近的k个点进行拟合，得到一个最小二乘意义上的局部平面，记为ax+by+cz+d＝0，此面的法线(a，b，c)即为该点的法线，求出所有点的法线方向后，对k个邻近点的法线方向进行比较，将法线方向发生突变的点认作边界点。更进一步地，所述步骤S7中，具体过程为：通过采样一致性，得到多条线段的点云，线段的端点分别为x坐标最大最小点，通过两个端点的坐标可以计算出每条线段的方向向量，通过每条线段的方向向量夹角，对箱体的长宽高进行分类。与现有技术相比，本专利技术的有益效果是：1、本专利技术将光源进行射频调制，通过三维ToF相机收集反射光并与解调信号作相关运算，主动改变解调信号的初始相位延迟，得到四组相关值，据此解出深度值并消除环境光；2、本专利技术通过设置数据转换模块以及模块内的算法，将控制系统获取各点的相机坐标系三维坐标转换为箱体的长宽高，能快速准确得到箱体的尺寸与体积。附图说明下面结合附图和实施例对本专利技术进一步说明。图1为本专利技术实施的示意图；图2为本专利技术的工作流程图；图3为本专利技术的一个实施例中，为去除掉非箱体2的点云之前的图形；图4为本专利技术的一个实施例中，为去除掉非箱体2的点云后的图形；图5为对图4进行滤波与聚类后得到的图形；图6为对图5进行边缘性检测后得到的图形；图7为对图6进行直线检测后得到的图形。具体实施方式为了使本专利技术的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本专利技术进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本专利技术，并不用于限定本专利技术。如图1和图2所示，本专利技术所述的一种基于飞行时间三维相机的尺寸测量方法，包括以下步骤：步骤一、通过三维ToF相机1中的控制系统103对光源104进行射频调制处理，并将调制处理后的光源101发射到箱体2上；步骤二、通过三维ToF相机1中的成像系统105观察反射回来的对应光102，获取得到像素坐标系中箱体2上各像素点点坐标(u，v)；步骤三、通过三维ToF相机1中的数据处理模块106，获取像素坐标系中箱体2上各像素点点坐标(u，v)并通过计算转化得到各点的相机坐标系三维坐标(Xc，Yc，Zc)；步骤四、控制系统103获取各点的相机坐标系三维坐标(Xc，Yc，Zc)后传输至终端3，终端3内的数据转换模块301将各点的相机坐标系三维坐标(Xc，Yc，Zc)转换为箱体2的长宽高(L，W，H)，并通过终端3内的数据输出模块302输出显示。具体实施时，所述步骤一种调制处理后的光源101为方波。具体实施时，所述步骤三中转化过程具体为，设定k×l为像素点的大小，f为成像系统105的焦距，θ为相机坐标系的倾斜度，d为光源104至箱体2的测量距离，为发射光与反射光的相位差，c为光速常量，则像素坐标系与相机坐标系之间的转换关系为，式(1)：式(2)：式(3)：联合式(1)、式(2)、式(3)，得到(Xc，Yc，Zc)。具体实施时，所述步骤三本文档来自技高网...

【技术保护点】
1.一种基于飞行时间三维相机的尺寸测量方法，其特征在于，包括以下步骤：步骤一、通过三维ToF相机中的控制系统对光源进行射频调制处理，并将调制处理后的光源发射到箱体上；步骤二、通过三维ToF相机中的成像系统收集反射回来的对应光，获取得到像素坐标系中箱体上各像素点点坐标(u，v)；步骤三、通过三维ToF相机中的数据处理模块，获取像素坐标系中箱体上各像素点点坐标(u，v)并通过计算转化得到各点的相机坐标系三维坐标(Xc，Yc，Zc)；步骤四、控制系统获取各点的相机坐标系三维坐标(Xc，Yc，Zc)后传输至终端，终端内的数据转换模块将各点的相机坐标系三维坐标(Xc，Yc，Zc)转换为箱体的长宽高(L，W，H)，并通过终端内的数据输出模块输出显示。

【技术特征摘要】
1.一种基于飞行时间三维相机的尺寸测量方法，其特征在于，包括以下步骤：步骤一、通过三维ToF相机中的控制系统对光源进行射频调制处理，并将调制处理后的光源发射到箱体上；步骤二、通过三维ToF相机中的成像系统收集反射回来的对应光，获取得到像素坐标系中箱体上各像素点点坐标(u，v)；步骤三、通过三维ToF相机中的数据处理模块，获取像素坐标系中箱体上各像素点点坐标(u，v)并通过计算转化得到各点的相机坐标系三维坐标(Xc，Yc，Zc)；步骤四、控制系统获取各点的相机坐标系三维坐标(Xc，Yc，Zc)后传输至终端，终端内的数据转换模块将各点的相机坐标系三维坐标(Xc，Yc，Zc)转换为箱体的长宽高(L，W，H)，并通过终端内的数据输出模块输出显示。2.根据权利要求1所述的一种基于飞行时间三维相机的尺寸测量方法，其特征在于，所述步骤一种调制处理后的光源为方波。3.根据权利要求1所述的一种基于飞行时间三维相机的尺寸测量方法，其特征在于，所述步骤三中转化过程具体为，设定k×l为像素点的面积，f为成像系统的焦距，θ为相机坐标系的倾斜度，d为光源至箱体的测量距离，为发射光与反射光的相位差，c为光速常量，则像素坐标系与相机坐标系之间的转换关系为，式(1)：式(2)：式(3)：联合式(1)、式(2)、式(3)，得到(Xc，Yc，Zc)。4.根据权利要求3所述的一种基于飞行时间三维相机的尺寸测量方法，其特征在于，所述步骤三中，发射光与反射光的相位差的具体计算过程为，设定τ为每次测量中主动改变延迟量，通过四次测量，并在每次测量中改变延迟量τ，环境光为常量K，得到：对上述关系式通过差模的方式，消除常数项K，得到：5.根据权利要求1所述的一种基于飞行时间三维相机的尺寸测量方法，其特征在于，所述步骤四中，箱体的长宽高(L，W，H)的转化过程为，所述数据转换模块设置有判断准则模型，利用判断准则迭代剔除与所估计参数不一致的输入数据，通过输入正确的数据估计模型参数，具体为：S1、将控制系统获取各点的相机坐标系三维坐标的初始点云数据随机选择一些点，组成子集L1，用最小二乘法得到初始化平面模型的参数A、B、C，模型为AX+BY+CZ+D＝0；S2、用步骤S1得到的模型AX+BY+CZ+D＝0去测试子集L2，L2为子集L1之外的数据，设置阈值d，d为任一点到平面模型的距离，子集L2中与模型误差小于d的点集L’与L1构成集...

【专利技术属性】
技术研发人员：黄毛毛，余晨阳，郭云锋，付敏，
申请(专利权)人：武汉点睛三维科技有限公司，
类型：发明
国别省市：湖北,42