一种空间定位方法及装置与流程

文档序号:14873588发布日期:2018-07-07 03:05阅读:204来源:国知局

本发明涉及空间定位技术领域,尤其涉及一种空间定位方法及装置。



背景技术:

利用图像传感器(摄像头)结合图形图像算法进行空间定位是一个有效的空间定位方案。此外,空间定位技术是一个应用很广辅助控制手段,该技术提供了一个用户不直接接触产品而对产品进行有效的反馈的方案,让产品在空间中产生的作用域更宽广,也让产品更人性化更智能。

其中,现有技术包括如下两种空间定位方案:

第一种,主动空间定位:利用计算机视觉对空间场景进行分析,即利用计算机视觉的相关算法分析出特征点,进而通过对摄像头内参和外参的标定,利用摄像头的内参和外参,配合视觉图像算法,对特征点进行追踪定位。

第二种,辅助空间定位:通过在场景中安装外部发射器,利用摄像头捕捉发射器,即通过捕捉发射器的图像,利用摄像头内参和外参,配合算法实现空间定位。

然而,现有技术的上述两种方案都要使用到摄像头的内参和外参,其中,内参表示相机内部参数,例如焦距、视场角、分辨率、畸变系数等,外参表示相机的相对位置及朝向等信息,例如平移矩阵旋转矩阵等。而内参和外参通常需要很复杂的数学体系进行运算,不易标定且标定准确度较难控制。此外,由于内参和外参标定标准不统一,标定方式多种,例如标定次数、标定用图片数量等等,所以空间定位结果受标定方式的影响也较大。而且,对于利用摄像头进行空间定位从而提供服务的产品来讲,出厂前是需要将摄像头内外参标定好的,但摄像头内参和外参标定较难标准化且较难量化,因此,现有定位方法并不适应产品的量产要求。

综上所述,现有技术的空间定位方法由于利用了摄像头的内参和外参,使得定位精确度较难把控。



技术实现要素:

本发明的实施例提供了一种空间定位方法及装置,通过将红外发射器在立体摄像模组拍摄的图像中的像素坐标转换为空间坐标来实现空间定位,其中不涉及摄像头内参和外参,易于标准化,解决了现有技术的空间定位方法由于利用了摄像头的内参和外参,使得定位精确度较难把控的问题。

本发明的实施例提供了一种空间定位方法,包括:

获取立体摄像头模组的第一摄像头拍摄的红外发射器发射红外线时的第一图像,并确定所述红外发射器在所述第一图像中的第一像素坐标;

获取所述立体摄像头模组的第二摄像头拍摄的所述红外发射器发射红外线时的第二图像,并确定所述红外发射器在所述第二图像中的第二像素坐标;

根据所述第一像素坐标、所述第二像素坐标和预先确定的与所述立体摄像头模组对应的空间坐标系的标定函数,获得所述红外发射器的空间坐标。

其中,上述方案中,所述确定所述红外发射器在所述第一图像中的第一像素坐标的步骤,包括:

获取所述第一图像中的红外点的像素坐标;

若所述第一图像中存在多个红外点,则将多个所述红外点在所述第一图像中的像素坐标的平均值作为所述红外发射器在所述第一图像中的第一像素坐标;

若所述第一图像中存在定位红外点,则将所述定位红外点在所述第一图像中的像素坐标作为所述红外发射器在所述第一图像中的第一像素坐标;

和/或

所述确定所述红外发射器在所述第二图像中的第二像素坐标的步骤,包括:

获取所述第二图像中的红外点的像素坐标;

若所述第二图像中存在多个红外点,则将多个所述红外点在所述第二图像中的像素坐标的平均值作为所述红外发射器在所述第二图像中的第二像素坐标;

若所述第二图像中存在定位红外点,则将所述定位红外点在所述第二图像中的像素坐标作为所述红外发射器在所述第二图像中的第二像素坐标。

其中,上述方案中,所述空间坐标系的标定函数包括空间z坐标的标定函数、空间x坐标的标定函数和空间y坐标的标定函数;

所述根据所述第一像素坐标、所述第二像素坐标和预先确定的与所述立体摄像头模组对应的空间坐标系的标定函数,获得所述红外发射器的空间坐标的步骤,包括:

获得所述第一像素坐标的横坐标与所述第二像素坐标的横坐标之差的绝对值,并作为目标视差;

将所述目标视差代入到空间z坐标的标定函数中,获得所述红外发射器的空间z坐标;

将所述第一像素坐标的横坐标以及所述空间z坐标代入空间x坐标的标定函数中,获得所述红外发射器的空间x坐标;

将所述第一像素坐标的纵坐标以及所述空间z坐标代入空间y坐标的标定函数中,获得所述红外发射器的空间y坐标。

其中,上述方案中,所述获取立体摄像头模组的第一摄像头拍摄的红外发射器发射红外线时的第一图像的步骤之前,所述方法还包括:

将所述立体摄像头模组设置在预定拍摄位置,并利用所述第一摄像头分别拍摄标定物设置在所述标定平台上的各个预设位置时的第三图像、利用所述第二摄像头拍摄标定物设置在所述标定平台上的各个预设位置时的第四图像,其中,所述标定物上设置有位于第一直线上的多个第一标注点、位于与所述第一直线垂直且相交的第二直线上的多个第二标注点以及位于所述第一直线和所述第二直线的交点处的目标标注点,所述预设位置位于第三直线上,且当所述标定物设置在所述标定平台上的任意预设位置时,所述第三直线与所述第一直线和所述第二直线均垂直,且所述拍摄位置使得所述第一摄像头和所述第二摄像头之间的中点与所述目标标注点之间的连线与所述第三直线平行;

分别获取所述第一摄像头拍摄的第三图像和所述第二摄像头拍摄的第四图像;

根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述第一标注点、所述第二标注点和所述目标标注点的像素坐标,确定与所述立体摄像头模组对应的空间坐标系的标定函数。

其中,上述方案中,所述空间坐标系的原点为所述第一摄像头和所述第二摄像头之间的中点,所述空间坐标系的z方向轴为所述原点与所述目标标注点所在的直线,所述空间坐标系的x方向轴为经过所述原点并与所述第一直线平行的直线,所述空间坐标系的y方向轴为经过所述原点并与所述第二直线平行的直线。

其中,上述方案中,所述根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述第一标注点、所述第二标注点和所述目标标注点的像素坐标,确定与所述立体摄像头模组对应的空间坐标系的标定函数的步骤,包括:

根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数;

根据与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素坐标,确定空间y坐标的标定函数;

根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述目标标注点的像素坐标,确定空间z坐标的标定函数。

其中,上述方案中,所述根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数的步骤,包括:

获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第一函数关系式f1(spacez);

根据所述第一函数关系式f1(spacez),获得空间x坐标的标定函数spacex=x*f1(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

其中,上述方案中,所述第一函数关系式为:f1(spacez)=a1*spacez2+b1*spacez+c1,其中,a1、b1、c1均为常量。

其中,上述方案中,所述根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数的步骤,包括:

获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第二函数关系式f2(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据第二预设公式获得与各个所述预设位置对应的所述目标标注点的空间x坐标,其中,xdj表示与第j个预设位置对应的所述目标标注点的空间x坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间x坐标,进行函数拟合,获得空间x坐标偏差与空间z坐标的第三函数关系式f3(spacez);

根据所述第二函数关系式f2(spacez)和所述第三函数关系式f3(spacez)获得空间x坐标的标定函数spacex=x*f2(spacez)-f3(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

其中,上述方案中,所述第二函数关系式为:f2(spacez)=a2*spacez2+b2*spacez+c2,所述第三函数关系式为:f3(spacez)=a3*spacez2+b3*spacez+c3,其中,a2、b2、c2、a3、b3、c3均为常量。

其中,上述方案中,所述根据与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素坐标,确定空间y坐标的标定函数的步骤,包括:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第四函数关系式f4(spacez);

根据所述第四函数关系式f4(spacez),获得空间y坐标的标定函数spacey=y*f4(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

其中,上述方案中,所述第四函数关系式为:f4(spacez)=a4*spacez2+b4*spacez+c4,其中,a4、b4、c4均为常量。

其中,上述方案中,所述根据与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素坐标,确定空间y坐标的标定函数的步骤,包括:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第五函数关系式f5(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据第五预设公式获得与各个所述预设位置对应的所述目标标注点的空间y坐标,其中,ydj表示与第j个预设位置对应的所述目标标注点的空间y坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间y坐标,进行函数拟合,获得空间y坐标偏差与空间z坐标的第六函数关系式f6(spacez);

根据所述第五函数关系式f5(spacez)和所述第六函数关系式f6(spacez),获得空间y坐标的标定函数,spacey=y*f5(spacez)-f6(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

其中,上述方案中,所述第五函数关系式为:f5(spacez)=a5*spacez2+b5*spacez+c5,所述第六函数关系式为:f6(spacez)=a6*spacez2+b6*spacez+c6,其中,a5、b5、c5、a6、b6、c6均为常量。

其中,上述方案中,所述根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述目标标注点的像素坐标,确定空间z坐标的标定函数的步骤,包括:

获取所述标定物位于各个所述预设位置上时,所述目标标注点在所述第三图像中的像素横坐标与在所述第四图像中的像素横坐标之差的绝对值,并作为所述目标标注点的视差;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的视差,进行函数拟合,获得空间z坐标与视差的第七函数关系式,并确定为空间z坐标的标定函数spacez=f(sx),其中,sx表示视差,spacez表示空间z坐标。

其中,上述方案中,所述空间z坐标的标定函数为:f(sx)=a7*sx2+b7*sx+c7,其中,a7、b7、c7均为常量。

本发明的实施例还提供了一种空间定位装置,包括:

第一像素坐标确定模块,用于获取立体摄像头模组的第一摄像头拍摄的红外发射器发射红外线时的第一图像,并确定所述红外发射器在所述第一图像中的第一像素坐标;

第二像素坐标确定模块,用于获取所述立体摄像头模组的第二摄像头拍摄的所述红外发射器发射红外线时的第二图像,并确定所述红外发射器在所述第二图像中的第二像素坐标;

空间坐标确定模块,用于根据所述第一像素坐标、所述第二像素坐标和预先确定的与所述立体摄像头模组对应的空间坐标系的标定函数,获得所述红外发射器的空间坐标。

其中,上述方案中,所述第一像素坐标确定模块包括:

第一红外点坐标获取单元,用于获取所述第一图像中的红外点的像素坐标;

第一确定单元,用于若所述第一图像中存在多个红外点,则将多个所述红外点在所述第一图像中的像素坐标的平均值作为所述红外发射器在所述第一图像中的第一像素坐标;

第二确定单元,用于若所述第一图像中存在定位红外点,则将所述定位红外点在所述第一图像中的像素坐标作为所述红外发射器在所述第一图像中的第一像素坐标;

和/或

所述第二像素坐标确定模块包括:

第二红外点坐标获取单元,用于获取所述第二图像中的红外点的像素坐标;

第三确定单元,用于若所述第二图像中存在多个红外点,则将多个所述红外点在所述第二图像中的像素坐标的平均值作为所述红外发射器在所述第二图像中的第二像素坐标;

第四确定单元,用于若所述第二图像中存在定位红外点,则将所述定位红外点在所述第二图像中的像素坐标作为所述红外发射器在所述第二图像中的第二像素坐标。

其中,上述方案中,所述空间坐标标定函数包括空间z坐标的标定函数、空间x坐标的标定函数和空间y坐标的标定函数;

所述空间坐标确定模块包括:

视差确定单元,用于获得所述第一像素坐标的横坐标与所述第二像素坐标的横坐标之差的绝对值,并作为目标视差;

z坐标确定单元,用于将所述目标视差代入到空间z坐标的标定函数中,获得所述红外发射器的空间z坐标;

x坐标确定单元,用于将所述第一像素坐标的横坐标以及所述空间z坐标代入空间x坐标的标定函数中,获得所述红外发射器的空间x坐标;

y坐标确定单元,用于将所述第一像素坐标的纵坐标以及所述空间z坐标代入空间y坐标的标定函数中,获得所述红外发射器的空间y坐标。

其中,上述方案中,所述装置还包括:

图像拍摄模块,用于将利用所述第一摄像头分别拍摄标定物设置在所述标定平台上的各个预设位置时的第三图像、利用所述第二摄像头拍摄标定物设置在所述标定平台上的各个预设位置时的第四图像,其中,所述立体摄像头模组设置在预定拍摄位置,所述标定物上设置有位于第一直线上的多个第一标注点、位于与所述第一直线垂直且相交的第二直线上的多个第二标注点以及位于所述第一直线和所述第二直线的交点处的目标标注点,所述预设位置位于第三直线上,且当所述标定物设置在所述标定平台上的任意预设位置时,所述第三直线与所述第一直线和所述第二直线均垂直,且所述拍摄位置使得所述第一摄像头和所述第二摄像头之间的中点与所述目标标注点之间的连线与所述第三直线平行;

图像获取模块,用于分别获取所述第一摄像头拍摄的第三图像和所述第二摄像头拍摄的第四图像;

标定函数确定模块,用于根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述第一标注点、所述第二标注点和所述目标标注点的像素坐标,确定与所述立体摄像头模组对应的空间坐标系的标定函数。

其中,上述方案中,所述空间坐标系的原点为所述第一摄像头和所述第二摄像头之间的中点,所述空间坐标系的z方向轴为所述原点与所述目标标注点所在的直线,所述空间坐标系的x方向轴为经过所述原点并与所述第一直线平行的直线,所述空间坐标系的y方向轴为经过所述原点并与所述第二直线平行的直线。

其中,上述方案中,所述标定函数确定模块包括:

第一标定单元,用于根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数;

第二标定单元,用于根据与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素坐标,确定空间y坐标的标定函数;

第三标定单元,用于根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述目标标注点的像素坐标,确定空间z坐标的标定函数。

其中,上述方案中,所述第一标定单元具体用于:获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第一函数关系式f1(spacez);

根据所述第一函数关系式f1(spacez),获得空间x坐标的标定函数spacex=x*f1(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

其中,上述方案中,所述第一函数关系式为:f1(spacez)=a1*spacez2+b1*spacez+c1,其中,a1、b1、c1均为常量。

其中,上述方案中,所述第一标定单元具体用于:

获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第二函数关系式f2(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据第二预设公式获得与各个所述预设位置对应的所述目标标注点的空间x坐标,其中,xdj表示与第j个预设位置对应的所述目标标注点的空间x坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间x坐标,进行函数拟合,获得空间x坐标偏差与空间z坐标的第三函数关系式f3(spacez);

根据所述第二函数关系式f2(spacez)和所述第三函数关系式f3(spacez)获得空间x坐标的标定函数spacex=x*f2(spacez)-f3(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

其中,上述方案中,所述第二函数关系式为:f2(spacez)=a2*spacez2+b2*spacez+c2,所述第三函数关系式为:f3(spacez)=a3*spacez2+b3*spacez+c3,其中,a2、b2、c2、a3、b3、c3均为常量。

其中,上述方案中,所述第二标定单元具体用于:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第四函数关系式f4(spacez);

根据所述第四函数关系式f4(spacez),获得空间y坐标的标定函数spacey=y*f4(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

其中,上述方案中,所述第四函数关系式为:f4(spacez)=a4*spacez2+b4*spacez+c4,其中,a4、b4、c4均为常量。

其中,上述方案中,所述第二标定单元具体用于:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第五函数关系式f5(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据第五预设公式获得与各个所述预设位置对应的所述目标标注点的空间y坐标,其中,ydj表示与第j个预设位置对应的所述目标标注点的空间y坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间y坐标,进行函数拟合,获得空间y坐标偏差与空间z坐标的第六函数关系式f6(spacez);

根据所述第五函数关系式f5(spacez)和所述第六函数关系式f6(spacez),获得空间y坐标的标定函数,spacey=y*f5(spacez)-f6(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

其中,上述方案中,所述第五函数关系式为:f5(spacez)=a5*spacez2+b5*spacez+c5,所述第六函数关系式为:f6(spacez)=a6*spacez2+b6*spacez+c6,其中,a5、b5、c5、a6、b6、c6均为常量。

其中,上述方案中,所述第三标定单元具体用于:

获取所述标定物位于各个所述预设位置上时,所述目标标注点在所述第三图像中的像素横坐标与在所述第四图像中的像素横坐标之差的绝对值,并作为所述目标标注点的视差;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的视差,进行函数拟合,获得空间z坐标与视差的第七函数关系式,并确定为空间z坐标的标定函数spacez=f(sx),其中,sx表示视差,spacez表示空间z坐标。

其中,上述方案中,所述空间z坐标的标定函数为:f(sx)=a7*sx2+b7*sx+c7,其中,a7、b7、c7均为常量。

本发明的实施例还提供了一种计算机可读存储介质,用于存储进行空间定位的计算机程序,所述计算机程序可被处理器执行如上述所述的空间定位方法。

本发明的实施例还提供了一种电子设备,所述电子设备包括一个或多个处理器,所述处理器被配置为执行如下方法:

获取立体摄像头模组的第一摄像头拍摄的红外发射器发射红外线时的第一图像,并确定所述红外发射器在所述第一图像中的第一像素坐标;

获取所述立体摄像头模组的第二摄像头拍摄的所述红外发射器发射红外线时的第二图像,并确定所述红外发射器在所述第二图像中的第二像素坐标;

根据所述第一像素坐标、所述第二像素坐标和预先确定的与所述立体摄像头模组对应的空间坐标系的标定函数,获得所述红外发射器的空间坐标。

本发明实施例的有益效果是:

本发明的实施例,通过确定红外发射器在立体摄像模组所拍摄的图像中的像素坐标,进而根据预先确定的该立体摄像头模组的空间坐标系的标定函数(即像素坐标与空间坐标的函数关系),获得红外发射器的空间坐标,从而实现空间定位。其中,由于本发明的实施例,不涉及摄像头内参和外参,所以本发明实施例的空间定位方法,能够准确把握定位精确度,而且易于标准化,可有效适应产品的量产要求。

附图说明

图1表示本发明第一实施例的空间定位方法的流程图;

图2表示本发明第一实施例中确定标定函数时所应用的标定物上的标注点的分布示意图;

图3表示本发明第一实施例中确定标定函数时所应用的标定平台上预设位置的分布示意图;

图4表示本发明第一实施例中确定标定函数时立体摄像头模组、标定平台、标定物之间的相对位置示意图;

图5表示本发明第二实施例的空间定位装置的结构框图之一;

图6表示本发明第二实施例的空间定位装置的结构框图之二。

具体实施方式

下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。

第一实施例

本发明的实施例提供了一种空间定位方法,如图1所示,该方法包括:

步骤101:获取立体摄像头模组的第一摄像头拍摄的红外发射器发射红外线时的第一图像,并确定所述红外发射器在所述第一图像中的第一像素坐标。

本发明实施例的空间定位方法,应用于立体摄像头模组,即确定红外发射器相对于立体摄像头模组的空间坐标。其中,立体摄像头模组包括两个摄像头,即第一摄像头(左摄像头)和第二摄像头(右摄像头)。另外,红外发射器具有至少一个红外发射点。因此,第一摄像头和第二摄像头拍摄的红外发射器发射红外线时的图像中,均具有至少一个红外点。

其中,由于红外发射器具有至少一个红外发射点,所以所述第一图像中具有至少一个红外点。因此,可根据所述第一图像中红外点的像素坐标,确定红外发射器在所述第一图像中的第一像素坐标。即上述确定所述红外发射器在所述第一图像中的第一像素坐标的步骤,包括:获取所述第一图像中的红外点的像素坐标;若所述第一图像中存在多个红外点,则将多个所述红外点在所述第一图像中的像素坐标的平均值作为所述红外发射器在所述第一图像中的第一像素坐标。

具体地,若所述第一图像中存在多个红外点,则将多个所述红外点在第一图像中的像素坐标的平均值作为所述红外发射器在所述第一图像中的第一像素坐标。例如,第一图像中存在两个红外点,且这两个红外点在第一图像中的像素坐标分别为(x1,y1)和(x2,y2),那么,红外发射器在第一图像中的第一像素坐标则为((x1+x2)/2,(y1+y2)/2)。

若所述第一图像中存在定位红外点,则将所述定位红外点的像素坐标作为所述红外发射器在所述第一图像中的第一像素坐标。例如,当第一图像中存在的多个红外点中有一个红外点起主要定位作用(即该红外点为定位红外点),则该定位红外点在第一图像中的像素坐标即为红外发射器在第一图像中的第一像素坐标,而与其他辅助红外点的像素坐标无关。

步骤102:获取所述立体摄像头模组的第二摄像头拍摄的所述红外发射器发射红外线时的第二图像,并确定所述红外发射器在所述第二图像中的第二像素坐标。

其中,确定红外发射器相对于第一摄像头和第二摄像头的空间坐标时,需要获取第一摄像头拍摄红外发射器发射红外线时的第一图像,以及第二摄像头拍摄的红外发射器发射红外线时的第二图像。其中,所述第一摄像头拍摄所述第一图像时,以及所述第二摄像头拍摄所述第二图像时,所述红外发射器的位置未发生变化。进一步地,所述第一图像和所述第二图像的拍摄时间相同。

另外,红外发射器在第二图像中的第二像素坐标的确定方法,与红外发射器在第一图像中的第一像素坐标的确定方法相同。即上述确定所述红外发射器在所述第二图像中的第二像素坐标步骤,包括:获取所述第二图像中的红外点的像素坐标;若所述第二图像中存在多个红外点,则将多个所述红外点在所述第二图像中的像素坐标的平均值作为所述红外发射器在所述第二图像中的第二像素坐标;若所述第二图像中存在定位红外点,则将所述定位红外点在所述第二图像中的像素坐标作为所述红外发射器在所述第二图像中的第二像素坐标

具体地,若所述第二图像中存在多个红外点,则将多个所述红外点在第二图像中的像素坐标的平均值作为所述红外发射器在所述第二图像中的第二像素坐标。例如,第二图像中存在两个红外点,且这两个红外点在第二图像中的像素坐标分别为(x3,y3)和(x42,y4),那么,红外发射器在第二图像中的第二像素坐标则为((x3+x4)/2,(y3+y4)/2)。

若所述第二图像中存在定位红外点,则将所述定位红外点在第二图像中的像素坐标作为所述红外发射器在所述第二图像中的第二像素坐标。例如,当第二图像中存在的多个红外点中有一个红外点起主要定位作用(即该红外点为定位红外点),则该定位红外点的像素坐标即为红外发射器在第二图像中的第二像素坐标,而与其他辅助红外点的像素坐标无关。

步骤103:根据所述第一像素坐标、所述第二像素坐标和预先确定的与所述立体摄像头模组对应的空间坐标系的标定函数,获得所述红外发射器的空间坐标。

其中,与所述立体摄像头模组对应的空间坐标系的标定函数是采用函数拟合方式确定的立体摄像头模组拍摄的图像中的像素坐标与空间坐标的函数关系,是预先获取并设定好的。因此,当获得红外发射器在第一摄像头拍摄的第一图像中的第一像素坐标和红外发射器在第二摄像头拍摄的第二图像中的第二像素坐标后,可以进一步根据该函数关系确定出红外发射器的空间坐标。

具体地,例如医生头部佩戴有红外发射器,面对裸眼3d手术屏,且该手术屏上部设置立体摄像头模组,那么利用本发明实施例的空间定位方法,可以确定出医生头部佩戴的红外发射器相对于立体摄像头模组的空间坐标。其中,当医生在手术屏前的位置发生移动后,红外发射器的位置发生变化,从而导致获得的红外发射器的空间坐标发生变化,从而使得裸眼3d手术屏能够配合医生的观看位置,即红外发射器的空间坐标进行立体显示。

其中,由于与所述立体摄像头模组对应的空间坐标系的标定函数是采用函数拟合方式,根据目标图像中的多个标注点确定的像素坐标与空间坐标的函数关系,其中,所述目标图像为设置有多个标注点的标定物位于标定平台上不同位置处时,立体摄像头模组拍摄的该标定物的图像,且上述第一像素坐标和第二像素坐标的确定过程均是通过图像处理获得的。因此,本发明实施例的空间定位方法并不涉及摄像头内参和外参,因此,本发明实施例的空间定位方法,易于标准化,且能够准确把握定位精确度。

进一步地,所述空间坐标系的标定函数包括空间z坐标的标定函数、空间x坐标的标定函数和空间y坐标的标定函数;且步骤103包括:获得所述第一像素坐标的横坐标与所述第二像素坐标的横坐标之差的绝对值,并作为目标视差;将所述目标视差代入到空间z坐标的标定函数中,获得所述红外发射器的空间z坐标;将所述第一像素坐标的横坐标以及所述空间z坐标代入空间x坐标的标定函数中,获得所述红外发射器的空间x坐标;将所述第一像素坐标的纵坐标以及所述空间z坐标代入空间y坐标的标定函数中,获得所述红外发射器的空间y坐标。

即本发明的实施例中,空间z坐标的标定函数为空间z坐标与视差之间的函数关系;空间x坐标的标定函数为空间x坐标与空间z坐标和x(即第一摄像头拍摄的目标对象的像素横坐标)之间的函数关系;空间y坐标的标定函数为空间y坐标与y(即第一摄像头拍摄的目标对象的像素纵坐标)之间的函数关系。因此,在获得红外发射器在第一图像中的第一像素坐标和第二像素坐标之后,可首先获得视差(即第一像素坐标的横坐标与第二像素坐标的横坐标之差),从而代入空间z坐标的标定函数,获得红外发射器的空间z坐标;然后,将获得的空间z坐标和第一像素坐标的横坐标,代入空间x坐标的标定函数,获得红外发射器的空间x坐标;最后,将获得的空间z坐标和第一像素坐标的纵坐标,代入空间y坐标的标定函数,获得红外发射器的空间y坐标。

此外,在步骤101之前,为了得到标定函数,本发明的实施例还包括:

将所述立体摄像头模组设置在预定拍摄位置,并利用所述第一摄像头分别拍摄标定物设置在所述标定平台上的各个预设位置时的第三图像、利用所述第二摄像头拍摄标定物设置在所述标定平台上的各个预设位置时的第四图像,其中,所述标定物上设置有位于第一直线上的多个第一标注点、位于与所述第一直线垂直且相交的第二直线上的多个第二标注点以及位于所述第一直线和所述第二直线的交点处的目标标注点,所述预设位置位于第三直线上,且当所述标定物设置在所述标定平台上的任意预设位置时,所述第三直线与所述第一直线和所述第二直线均垂直,且所述拍摄位置使得所述第一摄像头和所述第二摄像头之间的中点与所述目标标注点之间的连线与所述第三直线平行;

分别获取所述第一摄像头拍摄的第三图像和所述第二摄像头拍摄的第四图像;

根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述第一标注点、所述第二标注点和所述目标标注点的像素坐标,确定与所述立体摄像头模组对应的空间坐标系的标定函数。

即,在利用立体摄像头模组对红外发射器进行空间定位之前,需要确定与该立体摄像头模组对应的空间坐标系的标定函数,即对立体摄像头模组进行标定。其中,在确定所述标定函数时,需要标定物和标定平台的配合使用。

如图2所示,标定物3上设置有位于第一直线上的多个第一标注点(即标注点a、b、c、d、e)和位于第二直线上的多个第二标注点即(标注点f、g、c、h、i),以及位于第一直线和第二直线的交点处的目标标注点(即标注点c),其中,第一直线与第二直线相互垂直。可以理解的是,图2仅为示例,第一和第二标定点的个数不限,可以任意设置。

如图3所示,标定平台4上设置有多个预设位置401,且所述预设位置401位于第三直线上。其中,对于标定平台4的具体覆盖范围,可根据实际需求进行确定。例如,在确定位于裸眼3d手术屏上方设置的立体摄像头模组的标定函数时,医生通常站在距离手术屏1.8m到2.2m的距离处,水平移动范围为左右30厘米,则以立体摄像头模组中心点(即两个摄像头所在位置之间的中点)为原点,场景区域可以为z为1.8m到2.2m,x为-30cm到+30cm里面。

其中,在利用标定物3和标定平台4对立体摄像头模组进行标定时,需要将标定物3与标定平台4垂直放置,即将标定物3放置于标定平台4上的预设位置401处,并使得预设位置401所在的第三直线,与第一标注点所在的第一直线和第二标注点所在的第二直线均垂直。将立体摄像头模组设置在预定拍摄位置,该拍摄位置需要使得在标定物在预定位置时,第一摄像头1所在位置和第二摄像头2所在位置之间的中点o正对目标标注点,即标定物3上的目标标注点与第一摄像头1所在位置和第二摄像头2所在位置之间的中点o之间的连线与第三直线平行,如图4所示。

为了便于标定,标注点通常为红外发射器,而第一摄像头1和第二摄像头2为红外摄像头或者,第一摄像头1和第二摄像头2的镜头外面设置有红外滤波片,使得后续从第一摄像头1和第二摄像头2拍摄的照片中,仅包括红外发射器的光点图像,便于标注点的像素坐标的获取。

另外,确定出立体摄像头模组、标定物和标定平台的相对位置后,还需要建立空间坐标系。如图4所示,优选地,所述空间坐标系的原点为所述第一摄像头1和所述第二摄像头2之间的中点(即所述第一摄像头1所在位置和所述第二摄像头2所在位置之间的中点,即o点),所述空间坐标系的z方向轴为所述原点与所述目标标注点301所在的直线,所述空间坐标系的x方向轴为经过所述原点并与所述第一直线平行的直线,所述空间坐标系的y方向轴为经过所述原点并与所述第二直线平行的直线。当然,以上建立的空间坐标系的方式仅为示例,本领域技术人员可以合理修改,以不同位置为原点建立坐标系。

进一步地,建立空间坐标系后,为了利于空间坐标的获取和确认,可根据标定平台的具体覆盖范围,在平台上设置对应与各个预设位置401的标线(如图3和图4所示垂直于第三直线的第一标示线a、第二标示线b和第三标示线c),并标示出各个标线的空间z坐标。例如,第一标示线a的z坐标为1.9m,第二标示线b的z坐标为2.0m,第三标示线的z坐标为2.1m,从而使得各个预设位置的空间z坐标可以一目了然。

将立体摄像头模组放置于标定平台上的拍摄位置上后,需要利用第一摄像头拍摄标定物位于标定平台上各个预设位置处的第三图像。其中,第一摄像头拍摄的第三图像的总数量与预设位置相对应,每个预设位置对应一张或多张标定物的第三图像。例如,在标注点为红外发射器时,可以将红外发射器同时点亮或者将按照一定顺序依次点亮红外发射器,并且每一次点亮均获取一张第三图像,从而基于这些第三图像获取每个预设位置处每个标注点的像素坐标。

同理,将立体摄像头模组放置于标定平台上的拍摄位置上后,还需要利用第二摄像头拍摄标定物位于标定平台上各个预设位置处的第四图像。其中,第二摄像头拍摄的第四图像的总数量与预设位置的数量相对应,每个预设位置对应一张或多张标定物的第四图像。

其中,当按照如图4所示建立空间坐标系时,上述根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述第一标注点、所述第二标注点和所述目标标注点的像素坐标,确定与所述立体摄像头模组对应的空间坐标系的标定函数的步骤,包括:根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数;根据与各个所述预设位置对应所述第三图像中的所述第二标注点的像素坐标,确定所述空间y坐标的标定函数;根据与各个所述预设位置对应所述第三图像和所述第四图像中的所述目标标注点的像素坐标,确定空间z坐标的标定函数。

其中,由于第一标注点位于空间x方向上,所以可根据第一标注点的像素坐标确定空间x坐标的标定函数;由于第二标注点位于空间y方向上,所以可根据第二标注点的像素坐标确定空间y坐标的标定函数;由于空间坐标系的z轴穿过目标标注点,所以目标标注点的空间x坐标和空间y坐标均为零,但z坐标不为零,且目标标注点在第三图像和第四图像中的视差与其空间z坐标相关,所以可根据第三图像和第四图像中的目标标注点的像素坐标确定空间z坐标的标定函数。

另外,由于与立体摄像头模组对应的空间坐标系的标定函数是根据标定物上的各个标注点的像素坐标进行确定的,所以获取各个标注点的像素坐标的过程十分重要。其中,普通摄像头所拍摄的标定物的图像中不仅仅包含标注点,还包含其他位于拍摄范围内的拍摄对象,会使得后续从图像中获取标注点的像素坐标的过程比较复杂。

因此,为了能够更加容易,更加精确地获得各个标注点的像素坐标,可在第一摄像头和第二摄像头上分别设置红外滤波片,并在标定物上设置标注点的位置处均设置一红外发射器,从而通过确定红外点的像素坐标来确定对应标注点的像素坐标。对应地,在步骤101之前,还需要将设置在各个标注点位置处的红外发射器打开,从而分别利用设置有红外滤波片的第一摄像头和第二摄像头拍摄这些红外发射器发射红外线的图像。

其中,在利用设置有红外滤波片的第一摄像头和第二摄像头拍摄标定物的图像时,只有标注点位置处的红外发射器发射的红外线可以进入红外滤波片,从而有效防止拍摄范围内的其他拍摄对象进入图像中。因此,通过设置有红外滤波片的第一摄像头和第二摄像头拍摄的标定物的图像为黑色背景上分布有白色亮点(即标注点)的图像,从而更加容易更加精确地获得各个标注点的像素坐标。

第一方面:

上述所述根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数的步骤,包括:

获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第一函数关系式f1(spacez);

根据所述第一函数关系式f1(spacez),获得空间x坐标的标定函数spacex=x*f1(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

具体地,例如设第一摄像头拍摄的第三图像中的像素横坐标用x1表示,第二摄像头拍摄的第四图像中的像素横坐标用x2表示,则当第一标注点包括标注点a、b、c、d、e时(如图2所示)时,若标定物3位于第一标示线a上的预设位置处,则按照标注点a、b、c、d、e的顺序,获得的各个第一标注点的像素横坐标为:x1a、x1b、x1c、x1d、x1e。此时,可以确定出对应与第一标示线a上的预设位置的空间x方向上空间距离与像素距离之比其中,ab表示标注点a和标注点b之间的空间距离,bc表示标注点b和标注点c之间的空间距离,cd表示标注点d和标注点d之间的空间距离,de表示标注点d和标注点e之间的空间距离。

同理,可以确定出对应与第二标示线b上的预设位置的空间x方向上空间距离与像素距离之比kbx,以及对应与第三标示线c上的预设位置的空间x方向上空间距离与像素距离之比kcx。

另外,已知第一标示线a的空间z坐标为z1,第二标示线b的空间z坐标为z2,第三标示线c的空间z坐标为z3,则获得数据(kax,z1)、(kbx,z2)、(kcx,z3),进而对这些数据进行函数拟合,可以获得出空间x方向上空间距离与像素距离之比与空间z坐标的第一函数关系式f1(spacez),进而获得空间x坐标的标定函数spacex=x*f1(spacez)。优选地,所述第一函数关系式为:f1(spacez)=a1*spacez2+b1*spacez+c1,其中,a1、b1、c1均为常量。即第一函数关系式,从而使得本发明的实施例获得的空间x坐标更加精确。其中,第一函数关系式并不局限于此,方程越复杂表示越精确。需要强调的,本发明实施例中,标定函数均按照一元二次方程这种函数关系进行拟合,但本发明不限于此,本领域技术人员可以合理选择拟合函数关系。

其中,由于上述第一函数关系式是根据第一摄像头拍摄的第三图像中的第一标注点进行确定的,而且,空间距离与像素距离的比可等价于空间x坐标与像素x坐标的比,所以,若已知某一目标对象在第一摄像头拍摄的图像中的像素横坐标时,就可以将该像素横坐标与f1(spacez)相乘,获得该目标对象的空间x坐标。

然而,由于硬件设备的固有差异,会使不同的立体模组在定位的时候有一些固定的差异,因此,还需要进一步确定空间x坐标偏差,才能进一步获得更加准确的空间x坐标的标定函数。

因此,上述根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数的步骤,还可包括:

获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第二函数关系式f2(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据第二预设公式获得与各个所述预设位置对应的所述目标标注点的空间x坐标,其中,xdj表示与第j个预设位置对应的所述目标标注点的空间x坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间x坐标,进行函数拟合,获得空间x坐标偏差与空间z坐标的第三函数关系式f3(spacez);

根据所述第二函数关系式f2(spacez)和所述第三函数关系式f3(spacez)获得空间x坐标的标定函数spacex=x*f2(spacez)-f3(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

即本发明的实施例,在获得空间x方向的空间距离与像素距离之比与空间z坐标的函数关系式后,还需要进一步确定空间x坐标偏差。其中,目标标注点的空间x坐标为多少,则代表空间x坐标偏差为多少。因此,通过确定目标标注点的空间x坐标,来确定空间x坐标偏差。如图2所示,标注点c为目标标注点,且该目标标注点在与第一标示线a上的预设位置对应的第三图像中的像素横坐标为x1ac,在与第二标示线b上的预设位置对应的第三图像中的像素横坐标为x1bc,在与第三标示线c上的预设位置对应的第三图像中的像素横坐标为x1cc,则当标定物3位于第一标示线a上的预设位置处时,目标标注点的空间x坐标xac=x1ac*kax。同理,可以获得当标定物3位于第二标示线b上的预设位置处时,目标标注点的空间x坐标xbc=x1bc*kbx,以及当标定物位于第三标示线c上的预设位置处时,目标标注点的空间x坐标xcc=x1cc*kcx。

另外,由于已知第一标示线a的空间z坐标为z1,第二标示线b的空间z坐标为z2,第三标示线c的空间z坐标为z3,则获得数据(xac,z1)、(xbc,z2)、(xcc,z3),进而对这些数据进行函数拟合,即可获得空间x坐标偏差与空间z坐标第三函数关系式f3(spacez)。

最后,由第二函数关系式和第三函数关系式获得空间x坐标的标定函数spacex=x*f2(spacez)-f3(spacez)。其中,优选地,所述第二函数关系式为:f2(spacez)=a2*spacez2+b2*spacez+c2,所述第三函数关系式为:f3(spacez)=a3*spacez2+b3*spacez+c3,其中,a2、b2、c2、a3、b3、c3均为常量。即第二函数关系式和第三函数关系式均为一元二次方程,从而使得本发明的实施例获得的空间x坐标更加精确。其中,第二函数关系式和第三函数关系式并不局限于此,方程越复杂表示越精确。

第二方面

上述根据与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素坐标,确定空间y坐标的标定函数的步骤,包括:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第四函数关系式f4(spacez);

根据所述第四函数关系式f4(spacez),获得空间y坐标的标定函数spacey=y*f4(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

具体地,例如设第一摄像头拍摄的第三图像中的像素纵坐标用y1表示,第二摄像头拍摄的第四图像中的像素纵坐标用y2表示,则当第二标注点包括标注点f、g、c、h、i时(如图2所示)时,若标定物3位于第一标示线a上的预设位置处,则按照标注点f、g、c、h、i的顺序,获得的各个第二标注点的像素纵坐标为:y1f、y1g、y1c、y1h、y1i。此时,可以确定出对应与第一标示线a上的预设位置的空间y方向上空间距离与像素距离之比其中,fg表示标注点f和标注点g之间的空间距离,gc表示标注点g和标注点c之间的空间距离,ch表示标注点c和标注点h之间的空间距离,hi表示标注点h和标注点i之间的空间距离。

同理,可以确定出对应与第二标示线b上的预设位置的空间y方向上空间距离与像素距离之比kby,以及对应与第三标示线c上的预设位置的空间y方向上空间距离与像素距离之比kcy。

另外,已知第一标示线a的空间z坐标为z1,第二标示线b的空间z坐标为z2,第三标示线c的空间z坐标为z3,则获得数据(kay,z1)、(kby,z2)、(kcy,z3),进而对这些数据进行函数拟合,可以获得出空间y方向上空间距离与像素距离之比与空间z坐标的第四函数关系式f4(spacez),进而获得空间y坐标的标定函数spacey=y*f4(spacez)。优选地,所述第四函数关系式为:f4(spacez)=a4*spacez2+b4*spacez+c4其中,a4、b4、c4均为常量。即第四函数关系式,从而使得本发明的实施例获得的空间y坐标更加精确。其中,第四函数关系式并不局限于此,方程越复杂表示越精确。

其中,由于上述第四函数关系式是根据第一摄像头拍摄的第三图像中的第二标注点进行确定的,而且,空间距离与像素距离的比可等价于空间y坐标与像素y坐标的比,所以,若已知某一目标对象在第一摄像头拍摄的图像中的像素纵坐标时,就可以将该像纵横坐标与f4(spacez)相乘,获得该目标对象的空间y坐标。

然而,由于硬件设备的固有差异,会使不同的立体模组在定位的时候有一些固定的差异,因此,还需要进一步确定空间y坐标偏差,才能进一步获得更加准确的空间y坐标的标定函数。

因此,上述根据与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素坐标,确定空间y坐标的标定函数的步骤,还可包括:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第五函数关系式f5(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据第五预设公式获得与各个所述预设位置对应的所述目标标注点的空间y坐标,其中,ydj表示与第j个预设位置对应的所述目标标注点的空间y坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间y坐标,进行函数拟合,获得空间y坐标偏差与空间z坐标的第六函数关系式f6(spacez);

根据所述第五函数关系式f5(spacez)和所述第六函数关系式f6(spacez),获得空间y坐标的标定函数,spacey=y*f5(spacez)-f6(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

即本发明的实施例,在获得空间y方向的空间距离与像素距离之比与空间z坐标的函数关系式后,还需要进一步确定空间y坐标偏差。其中,目标标注点的空间y坐标为多少,则代表空间y坐标偏差为多少。因此,通过确定目标标注点的空间y坐标,来确定空间y坐标偏差。

如图2所示,标注点c为目标标注点,且该目标标注点在与第一标示线a上的预设位置对应的第三图像中的像素纵坐标为y1ac,在与第二标示线b上的预设位置对应的第三图像中的像素纵坐标为y1bc,在与第三标示线c上的预设位置对应的第三图像中的像素纵坐标为y1cc,则当标定物位于第一标示线a上的预设位置处时,目标标注点的空间y坐标yac=y1ac*kay。同理,可以获得当标定物位于第二标示线b上的预设位置处时,目标标注点的空间y坐标ybc=y1bc*kby,以及当标定物位于第三标示线c上的预设位置处时,目标标注点的空间y坐标ycc=y1cc*kcy。

另外,由于已知第一标示线a的空间z坐标为z1,第二标示线b的空间z坐标为z2,第三标示线c的空间z坐标为z3,则获得数据(yac,z1)、(ybc,z2)、(ycc,z3),进而对这些数据进行函数拟合,可以获得目标标注点的空间y坐标与空间z坐标的函数关系式,即获得空间y坐标偏差与空间z坐标第六函数关系式f6(spacez)。

最后,由第五函数关系式和第六函数关系式获得空间y坐标的标定函数spacey=y*f5(spacez)-f6(spacez)。其中,优选地,所述第五函数关系式为:f5(spacez)=a5*spacez2+b5*spacez+c5,所述第六函数关系式为:f6(spacez)=a6*spacez2+b6*spacez+c6,其中,a5、b5、c5、a6、b6、c6均为常量。即第五函数关系式和第六函数关系式均为一元二次方程,从而使得本发明的实施例获得的空间y坐标更加精确。其中,第五函数关系式和第六函数关系式并不局限于此,方程越复杂表示越精确。

第三方面

上述根据与各个所述预设位置对应所述第三图像和所述第四图像中的所述目标标注点的像素坐标,确定空间z坐标的标定函数的步骤,包括:

获取所述标定物位于各个所述预设位置上时,所述目标标注点在所述第三图像中的像素横坐标与在所述第四图像中的像素横坐标之差的绝对值,并作为所述目标标注点的视差;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的视差,进行函数拟合,获得空间z坐标与视差的第七函数关系式,并确定为空间z坐标的标定函数spacez=f(sx),其中,sx表示视差,spacez表示空间z坐标。

其中,设当标定物位于第一标示线a上的预设位置处时,目标标注点在x方向的视差为sxa,当标定物位于第二标示线b上的预设位置处时,目标标注点在x方向的视差为sxb,当标定物位于第三标示线c上的预设位置处时,目标标注点在x方向的视差为sxc。又由于已知第一标示线a的空间z坐标为z1,第二标示线b的空间z坐标为z2,第三标示线c的空间z坐标为z3,则获得数据(sxa,z1)、(sxb,z2)、(sxc,z3),进而对这些数据进行函数拟合,可以获得出空间z坐标与视差的函数关系式spacez(sx)。

优选地,所述空间z坐标的标定函数为:f(sx)=a7*sx2+b7*sx+c7,其中,a7、b7、c7均为常量。即空间z坐标的标定函数为一元二次方程,从而使得本发明的实施例获得的空间z坐标更加精确。其中,f(sx)并不局限于此,方程越复杂表示越精确。

其中,需要注意的是,在确定空间x坐标的标定函数和空间y坐标的标定函数时,仅仅需要依据立体摄像模组的其中一个摄像头拍摄的标定物在标定平台上的各个预设位置处的图像。即可以按照上述描述的过程根据第一摄像头拍摄的第三图像中的第一标注点确定空间x坐标的标定函数,并根据该第三图像中的第二标注点确定空间y坐标的标定函数。或者,也可根据第二摄像头拍摄的第四图像中的第一标注点确定空间x坐标的标定函数,并根据该第四图像中的第二标注点确定空间y坐标的标定函数。

由上述可知,立体摄像头模组按照上述标定方法进行标定后,其空间坐标系的标定函数中,空间z坐标的标定函数与目标对象的像素横坐标视差相关,空间x坐标与目标对象的像素横坐标和空间z坐标相关,空间y坐标与目标对象的像素纵坐标和空间z坐标相关。因此,具体地步骤103包括:获得所述第一像素坐标的横坐标与所述第二像素坐标的横坐标之差的绝对值,并作为目标视差;将所述目标视差代入到空间z坐标的标定函数中,获得所述红外发射器的空间z坐标;将所述第一像素坐标的横坐标以及所述空间z坐标代入空间x坐标的标定函数中,获得所述红外发射器的空间x坐标;将所述第一像素坐标的纵坐标以及所述空间z坐标代入空间y坐标的标定函数中,获得所述红外发射器的空间y坐标。

其中,需要注意的是,空间x坐标的标定函数和空间y坐标的标定函数由哪一个摄像头拍摄的图像进行标定的,则代入到空间x坐标标定函数和空间y坐标的标定函数中的目标对象的像素横坐标和像素纵坐标则为哪一个摄像头拍摄的该目标对象的图像中的。

综上所述,本发明的实施例,通过确定红外发射器在立体摄像模组所拍摄的图像中的像素坐标,进而根据预先确定的该立体摄像头模组的空间坐标系的标定函数(即像素坐标与空间坐标的函数关系),获得红外发射器的空间坐标,从而实现空间定位。其中,由于本发明的实施例,不涉及摄像头内参和外参,所以本发明实施例的空间定位方法,易于标准化,从而能够准确把握定位精确度。

此外,与现有标定技术相比,本发明的实施例的每一步做法和评判结果都是确定的,只要按照要求把平台(即标定物与标定平台)搭建好,并按照上述步骤可以在很短的时间内把参数采集下来,不需要重复哪个步骤。与现有空间定位技术由于标定结果正确与否不易确定,需要专业人员利用标定物进行数次以上的采集,铺之人工分析结果,本发明实施例的空间定位方法易于标准化和量化,更适合应用于批量的定位设备的生产。

第二实施例

本发明的实施例提供了一种空间定位装置,如图5所示,该装置500包括:

第一像素坐标确定模块504,用于获取立体摄像头模组的第一摄像头拍摄的红外发射器发射红外线时的第一图像,并确定所述红外发射器在所述第一图像中的第一像素坐标;

第二像素坐标确定模块505,用于获取所述立体摄像头模组的第二摄像头拍摄的所述红外发射器发射红外线时的第二图像,并确定所述红外发射器在所述第二图像中的第二像素坐标;

空间坐标确定模块506,用于根据所述第一像素坐标、所述第二像素坐标和预先确定的与所述立体摄像头模组对应的空间坐标系的标定函数,获得所述红外发射器的空间坐标。

优选地,所述第一像素坐标确定模块504包括:

第一红外点坐标获取单元5041,用于获取所述第一图像中的红外点的像素坐标;

第一确定单元5042,用于若所述第一图像中存在多个红外点,则将多个所述红外点在所述第一图像中的像素坐标的平均值作为所述红外发射器在所述第一图像中的第一像素坐标;

第二确定单元5043,用于若所述第一图像中存在定位红外点,则将所述定位红外点在所述第一图像中的像素坐标作为所述红外发射器在所述第一图像中的第一像素坐标;

和/或

所述第二像素坐标确定模块505包括:

第二红外点坐标获取单元5051,用于获取所述第二图像中的红外点的像素坐标;

第三确定单元5052,用于若所述第二图像中存在多个红外点,则将多个所述红外点在所述第二图像中的像素坐标的平均值作为所述红外发射器在所述第二图像中的第二像素坐标;

第四确定单元5053,用于若所述第二图像中存在定位红外点,则将所述定位红外点在所述第二图像中的像素坐标作为所述红外发射器在所述第二图像中的第二像素坐标。

优选地,所述空间坐标标定函数包括空间z坐标的标定函数、空间x坐标的标定函数和空间y坐标的标定函数;如图6所示,所述空间坐标确定模块506包括:

视差确定单元5061,用于获得所述第一像素坐标的横坐标与所述第二像素坐标的横坐标之差的绝对值,并作为目标视差;

z坐标确定单元5062,用于将所述目标视差代入到空间z坐标的标定函数中,获得所述红外发射器的空间z坐标;

x坐标确定单元5063,用于将所述第一像素坐标的横坐标以及所述空间z坐标代入空间x坐标的标定函数中,获得所述红外发射器的空间x坐标;

y坐标确定单元5064,用于将所述第一像素坐标的纵坐标以及所述空间z坐标代入空间y坐标的标定函数中,获得所述红外发射器的空间y坐标。

优选地,如图6所示,所述装置还包括:

图像拍摄模块501,用于利用所述第一摄像头分别拍摄标定物设置在所述标定平台上的各个预设位置时的第三图像、利用所述第二摄像头拍摄标定物设置在所述标定平台上的各个预设位置时的第四图像,其中,所述立体摄像头模组设置在预定拍摄位置,所述标定物上设置有位于第一直线上的多个第一标注点、位于与所述第一直线垂直且相交的第二直线上的多个第二标注点以及位于所述第一直线和所述第二直线的交点处的目标标注点,所述预设位置位于第三直线上,且当所述标定物设置在所述标定平台上的任意预设位置时,所述第三直线与所述第一直线和所述第二直线均垂直,且所述拍摄位置使得所述第一摄像头和所述第二摄像头之间的中点与所述目标标注点之间的连线与所述第三直线平行;

图像获取模块502,用于分别获取所述第一摄像头拍摄的第三图像和所述第二摄像头拍摄的第四图像;

标定函数确定模块503,用于根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述第一标注点、所述第二标注点和所述目标标注点的像素坐标,确定与所述立体摄像头模组对应的空间坐标系的标定函数。

优选地,所述空间坐标系的原点为所述第一摄像头和所述第二摄像头之间的中点,所述空间坐标系的z方向轴为所述原点与所述目标标注点所在的直线,所述空间坐标系的x方向轴为经过所述原点并与所述第一直线平行的直线,所述空间坐标系的y方向轴为经过所述原点并与所述第二直线平行的直线。

优选地,如图6所示,所述标定函数确定模块503包括:

第一标定单元5031,用于根据与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素坐标,确定空间x坐标的标定函数;

第二标定单元5032,用于根据与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素坐标,确定空间y坐标的标定函数;

第三标定单元5033,用于根据与各个所述预设位置对应的所述第三图像和所述第四图像中的所述目标标注点的像素坐标,确定空间z坐标的标定函数。

优选地,所述第一标定单元5031具体用于:获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第一函数关系式f1(spacez);

根据所述第一函数关系式f1(spacez),获得空间x坐标的标定函数spacex=x*f1(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

优选地,所述第一函数关系式为:f1(spacez)=a1*spacez2+b1*spacez+c1,其中,a1、b1、c1均为常量。

优选地,所述第一标定单元5031具体用于:

获取与各个所述预设位置对应的所述第三图像中的所述第一标注点的像素横坐标;

根据第一预设公式确定与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,其中,kjx表示与第j个预设位置对应的空间x方向上空间距离与像素距离之比,pipi+1表示第i个第一标注点与第i+1个第一标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第一标注点的像素横坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第一标注点的像素横坐标,n表示所述第一标注点的总数量,且n大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间x方向上空间距离与像素距离之比,进行函数拟合,获得空间x方向的空间距离与像素距离之比与空间z坐标的第二函数关系式f2(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据第二预设公式获得与各个所述预设位置对应的所述目标标注点的空间x坐标,其中,xdj表示与第j个预设位置对应的所述目标标注点的空间x坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素横坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间x坐标,进行函数拟合,获得空间x坐标偏差与空间z坐标的第三函数关系式f3(spacez);

根据所述第二函数关系式f2(spacez)和所述第三函数关系式f3(spacez)获得空间x坐标的标定函数spacex=x*f2(spacez)-f3(spacez),其中,x为所述第一摄像头拍摄的目标对象的像素横坐标,spacex表示空间x坐标,spacez表示空间z坐标。

优选地,所述第二函数关系式为:f2(spacez)=a2*spacez2+b2*spacez+c2,所述第三函数关系式为:f3(spacez)=a3*spacez2+b3*spacez+c3,其中,a2、b2、c2、a3、b3、c3均为常量。

优选地,所述第二标定单元5032具体用于:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第四函数关系式f4(spacez);

根据所述第四函数关系式f4(spacez),获得空间y坐标的标定函数spacey=y*f4(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

优选地,所述第四函数关系式为:f4(spacez)=a4*spacez2+b4*spacez+c4,其中,a4、b4、c4均为常量。

优选地,所述第二标定单元5032具体用于:

获取与各个所述预设位置对应的所述第三图像中的所述第二标注点的像素纵坐标;

根据第四预设公式确定与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,其中,kjy表示与第j个预设位置对应的空间y方向上空间距离与像素距离之比,qiqi+1表示第i个第二标注点与第i+1个第二标注点的空间距离,表示与第j个预设位置对应的所述第三图像中的第i个第二标注点的像素纵坐标,表示与第j个预设位置对应的所述第三图像中的第i+1个第二标注点的像素纵坐标,m表示所述第二标注点的总数量,且m大于1;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的空间y方向上空间距离与像素距离之比,进行函数拟合,获得空间y方向的空间距离与像素距离之比与空间z坐标的第五函数关系式f5(spacez);

获取与各个所述预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据第五预设公式获得与各个所述预设位置对应的所述目标标注点的空间y坐标,其中,ydj表示与第j个预设位置对应的所述目标标注点的空间y坐标,表示与第j个预设位置对应的所述第三图像中的所述目标标注点的像素纵坐标;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的空间y坐标,进行函数拟合,获得空间y坐标偏差与空间z坐标的第六函数关系式f6(spacez);

根据所述第五函数关系式f5(spacez)和所述第六函数关系式f6(spacez),获得空间y坐标的标定函数,spacey=y*f5(spacez)-f6(spacez),其中,y为所述第一摄像头拍摄的目标对象的像素纵坐标,spacey表示空间y坐标,spacez表示空间z坐标。

优选地,所述第五函数关系式为:f5(spacez)=a5*spacez2+b5*spacez+c5,所述第六函数关系式为:f6(spacez)=a6*spacez2+b6*spacez+c6,其中,a5、b5、c5、a6、b6、c6均为常量。

优选地,所述第三标定单元5033具体用于:

获取所述标定物位于各个所述预设位置上时,所述目标标注点在所述第三图像中的像素横坐标与在所述第四图像中的像素横坐标之差的绝对值,并作为所述目标标注点的视差;

根据各个所述预设位置的空间z坐标,以及与各个所述预设位置对应的所述目标标注点的视差,进行函数拟合,获得空间z坐标与视差的第七函数关系式,并确定为空间z坐标的标定函数spacez=f(sx),其中,sx表示视差,spacez表示空间z坐标。

优选地,所述空间z坐标的标定函数为:f(sx)=a7*sx2+b7*sx+c7,其中,a7、b7、c7均为常量。

本发明的实施例,通过确定红外发射器在立体摄像模组所拍摄的图像中的像素坐标,进而根据预先确定的该立体摄像头模组的空间坐标系的标定函数(即像素坐标与空间坐标的函数关系),获得红外发射器的空间坐标,从而实现空间定位。其中,由于本发明的实施例,不涉及摄像头内参和外参,所以本发明实施例的空间定位方法,能够准确把握定位精确度,而且易于标准化,可有效适应产品的量产要求。

第三实施例

本发明的实施例提供了一种计算机可读存储介质,用于存储进行空间定位的计算机程序,所述计算机程序可被处理器执行如上述所述的空间定位方法。

第四实施例

本发明的实施例提供了一种电子设备,所述电子设备包括一个或多个处理器,所述处理器被配置为执行如下方法:

获取立体摄像头模组的第一摄像头拍摄的红外发射器发射红外线时的第一图像,并确定所述红外发射器在所述第一图像中的第一像素坐标;

获取所述立体摄像头模组的第二摄像头拍摄的所述红外发射器发射红外线时的第二图像,并确定所述红外发射器在所述第二图像中的第二像素坐标;

根据所述第一像素坐标、所述第二像素坐标和预先确定的与所述立体摄像头模组对应的空间坐标系的标定函数,获得所述红外发射器的空间坐标。

以上所述的是本发明的优选实施方式,应当指出对于本技术领域的普通人员来说,在不脱离本发明所述的原理前提下还可以作出若干改进和润饰,这些改进和润饰也在本发明的保护范围内。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1