CN113689391B - ToF设备的安装参数获取方法、系统和ToF设备 - Google Patents

ToF设备的安装参数获取方法、系统和ToF设备 Download PDF

Info

Publication number
CN113689391B
CN113689391B CN202110936705.4A CN202110936705A CN113689391B CN 113689391 B CN113689391 B CN 113689391B CN 202110936705 A CN202110936705 A CN 202110936705A CN 113689391 B CN113689391 B CN 113689391B
Authority
CN
China
Prior art keywords
cloud data
point cloud
tof
installation
coordinate system
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
CN202110936705.4A
Other languages
English (en)
Other versions
CN113689391A (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.)
Ruyu Intelligent Technology Suzhou Co ltd
Original Assignee
Ruyu Intelligent Technology Suzhou 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 Ruyu Intelligent Technology Suzhou Co ltd filed Critical Ruyu Intelligent Technology Suzhou Co ltd
Priority to CN202110936705.4A priority Critical patent/CN113689391B/zh
Publication of CN113689391A publication Critical patent/CN113689391A/zh
Application granted granted Critical
Publication of CN113689391B publication Critical patent/CN113689391B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/0002—Inspection of images, e.g. flaw detection
    • G06T7/0004—Industrial image inspection
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/70—Determining position or orientation of objects or cameras
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/10—Image acquisition modality
    • G06T2207/10028—Range image; Depth image; 3D point clouds
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/30—Subject of image; Context of image processing
    • G06T2207/30108—Industrial image inspection

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Quality & Reliability (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本申请公开一种ToF设备的安装参数获取方法、系统、ToF设备和智能产品，其中ToF设备的安装参数获取方法，包括：S100，获取ToF设备探测的点云数据；S200，根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面；所述第一参考面为限定所述ToF设备安装高度的平面；S300，根据所述映射面和所述点云数据获取所述ToF设备的安装参数。本申请能够提高所获取的安装参数的准确性，简化安装参数的获取过程。

Description

ToF设备的安装参数获取方法、系统和ToF设备
技术领域
本申请涉及智能控制技术领域，具体涉及一种ToF设备的安装参数获取方法、系统、ToF设备和智能产品。
背景技术
包括TOF(飞行时间法)传感模块的设备可以称为ToF设备，上述TOF传感模块可以拍摄探测区域的深度图数据，以供ToF设备使用。上述ToF设备通常可以设置在一些智能产品(如空调、电视机、电冰箱等智能家居产品)中，使这些智能产品的功能更为完善。
在安装ToF设备的时候，需要将其安装高度与角度等安装参数作为ToF设备输入，使该ToF设备响应用户各项需求。如果缺乏安装参数，或者安装参数不正确，可能影响其中运行算法的准确度。因此，有些TOF设备需要根据每一个终端客户的安装位置，输入相应的安装参数，这个方式操作繁琐，且输入的安装参数还可能存在准确性低的问题。
发明内容
鉴于此，本申请提供一种ToF设备的安装参数获取方法、系统、ToF设备和智能产品，以解决现有的安装参数获取过程繁琐，且准确性低的问题。
本申请第一方面提供一种ToF设备的安装参数获取方法，包括：
S100，获取ToF设备探测的点云数据；
S200，根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面；所述第一参考面为限定所述ToF设备安装高度的平面；
S300，根据所述映射面和所述点云数据获取所述ToF设备的安装参数。
可选地，所述获取ToF设备拍摄的点云数据包括：
获取所述ToF设备拍摄的深度图；
对所述深度图进行坐标转换得到所述点云数据。
可选地，所述深度图对应的坐标系为TOF坐标系，所述点云数据对应的坐标系为直角坐标系；
所述对所述深度图进行坐标转换得到所述点云数据包括：将所述深度图进从所述TOF坐标系转换至所述直角坐标系，得到所述点云数据。
可选地，所述TOF坐标系与所述直角坐标系之间的转换公式包括：
其中，(u，u，z)表示TOF坐标系的坐标，(x，y，z)表示(u，u，z)在直角坐标系对应的坐标，fx表示ToF设备的第一内部参数，fy表示ToF设备的第二内部参数，cx表示ToF设备的第三内部参数，cy表示ToF设备的第四内部参数。
可选地，所述根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面包括：
S210，从所述点云数据中提取K个表征所述第一参考面的目标点；
S220，对K个目标点进行平面拟合，得到所述映射面。
可选地，所述点云数据包括N个原始点；所述从所述点云数据中提取K个表征所述第一参考面的目标点包括：
S211，从所述N个原始点随机抽取M个代表点，对所述M个代表点进行平面拟合，得到第二参考面；
S212，在所述M个代表点中获取属于所述第二参考面的K个选定点；
S213，若K大于点数阈值，则将所述K个选定点确定为所述K个目标点。
可选地，上述ToF设备的安装参数获取方法，还包括：
S214，若K小于或者等于点数阈值，且抽取M个代表点的次数小于或者等于次数阈值，则返回执行步骤S211。
可选地，所述根据所述映射面和所述点云数据获取所述ToF设备的安装参数包括：
获取所述映射面的第一法向量和所述点云数据投影至所述第一法向量的投影距离；
根据所述第一法向量和所述投影距离确定所述安装参数。
可选地，所述安装参数包括安装高度和安装角度；所述安装高度为：hi＝D；所述安装角度为：其中，hi表示安装高度，D表示投影距离，α表示安装角度，ny表示第一法向量的第二维直角坐标，nz表示第一法向量的第三维直角坐标。
本申请第二方面提供一种ToF设备的安装参数获取系统，包括：
第一获取模块，用于获取ToF设备探测的点云数据；
确定模块，用于根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面；所述第一参考面为限定所述ToF设备安装高度的平面；
第二获取模块，用于根据所述映射面和所述点云数据获取所述ToF设备的安装参数。
本申请第三方面提供一种ToF设备，包括处理器和存储介质；所述存储介质上存储有程序代码；所述处理器用于调用所述存储介质存储的程序代码，以执行上述任一种ToF设备的安装参数获取方法。
本申请第四方面提供一种智能产品，其特征在于，包括上述任一种ToF设备。
可选地，所述ToF设备获取当前安装参数，在所述当前安装参数与预存安装参数之间的差值超过差值阈值时，将所述预存安装参数更新为所述当前安装参数。
本申请提供的ToF设备的安装参数获取方法、系统、ToF设备和智能产品，通过获取ToF设备探测的点云数据，根据点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面，使点云数据与映射面位于相同的直角坐标系，再依据该映射面、相应点云数据以及两者之间的相对关系获取ToF设备的安装参数，可以提高所获取的安装参数的准确性，还可以简化安装参数的获取过程，将更为准确的安装参数直接写入ToF设备的相应存储位置，以供其运行的相关算法调用，能够保证相应算法的性能，提高ToF设备的工作效果，从而提高上述ToF设备所处智能产品的性能。
附图说明
为了更清楚地说明本申请实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请的一些实施例，对于本领域技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1a和图1b是ToF设备的安装位置示意图；
图2是本申请一实施例的ToF设备的安装参数获取方法流程示意图；
图3a和图3b是本申请一实施例的点云数据示意图；
图4是本申请一实施例的坐标关系示意图；
图5是本申请一实施例中K个目标点确定过程示意图；
图6a和图6b是本申请一实施例的法向量示意图；
图7是本申请一实施例的ToF设备的安装参数获取系统结构示意图；
图8是本申请一实施例的ToF设备结构示意图。
具体实施方式
ToF设备或其所在智能产品安装后的示意图可以参考图1a和图1b所示，图1a为俯视图，图1b侧视图，根据这两个图可知，ToF设备所在的世界坐标系为直角坐标系，包括x、y和z三个方向，x方向的视场角为FOVx，y方向的视场角为FOVy，l为ToF设备的最远探测距离，w为ToF设备的探测宽度。hi为ToF设备的安装高度，α为ToF设备的参考线(如摄像头光轴等)与z方向之间的夹角，也可以称为安装角度，其大小取决于应用场景，取值范围通常为0≤α≤90°。其中安装高度hi与安装角度α等安装参数为ToF设备输入，以用于其中运行的相关算法。现有方案往往需要依据安装特征测量或估算这些安装参数，手动输入至对应的ToF设备，这个方式操作繁琐，且输入的安装参数准确性低。
针对上述问题，本申请通过获取ToF设备探测的点云数据，根据点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面，使点云数据与映射面位于相同的直角坐标系，再依据该映射面、相应点云数据以及两者之间的相对关系获取ToF设备的安装参数，可以提高所获取的安装参数的准确性，还可以简化安装参数的获取过程。
下面结合附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本申请一部分实施例，而非全部实施例。基于本申请中的实施例，本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。在不冲突的情况下，下述各个实施例及其技术特征可以相互组合。
本申请第一方面提供一种ToF设备的安装参数获取方法，参考图2所示，上述ToF设备的安装参数获取方法包括：
S100，获取ToF设备探测的点云数据。
上述ToF设备包括TOF传感模块，TOF传感模块可以拍摄探测区域的深度图数据，对该深度图数据进行相应转换，可以得到所需点云数据。在一个示例中，若以底面作为探测区域的参考面，对该探测区域进行拍摄，在底面无障碍物时，所得点云数据可以参考图3a所示，在地面存在箱子等其它物体时，所得点云数据可以参考图3b所示，图3a和图3b示出的坐标系为直角坐标系，其具体示出了X轴、Y轴和Z轴。
在一个实施例中，所述获取ToF设备拍摄的点云数据包括：获取所述ToF设备拍摄的深度图；对所述深度图进行坐标转换得到所述点云数据。本实施例中，ToF设备拍摄的深度图通常以矩阵形式表征，其所处的坐标系为TOF坐标系，该TOF坐标系可以限定像素位置(u,v)和深度信息z。点云数据对应的坐标系为能够检测第一参考面对应的映射面的坐标系(如直角坐标系等等)，其中第一参考面为限定ToF设备安装高度的平面，在很多情况下，ToF设备的安装高度为相对于地面计算的高度，此时该第一参考面为地面。
具体地，所述深度图对应的坐标系为TOF坐标系，所述点云数据对应的坐标系为直角坐标系；所述对所述深度图进行坐标转换得到所述点云数据包括：将所述深度图进从所述TOF坐标系转换至所述直角坐标系，得到所述点云数据。其中直角坐标系包括第一维坐标轴X轴，第二维坐标轴Y轴和第三维坐标轴Z轴，各个坐标轴两两垂直，点云数据在第三维坐标轴上的坐标参数z与深度图中对应点的深度信息z相同，因而采用相同的符号表征，以简化坐标转换时的计算过程。
在一个示例中，TOF坐标系的像素位置与对应直角坐标系中空间点直角的坐标关系可以参考图4所示，图4以一个(x,y,z)位置的物体示例，TOF设备是采集FOV内(探测区域)的可视数据，包括可视的地面，一个平面的物体；其采用ToF设备的各个内部参数：第一内部参数fx，第二内部参数fy，第三内部参数cx和第四内部参数cy表征找出像素位置(u,v)和空间点(x,y,z)之间的坐标关系。其中第一内部参数fx，第二内部参数fy为ToF设备两个轴方向焦距，第三内部参数cx和第四内部参数cy为ToF设备两个轴方向的中心位置，四者分别可以通过标定等方式确定。表征上述坐标关系的公式包括：
若以矩阵形式表征上述坐标关系，此时TOF坐标系与直角坐标系之间的转换公式包括：
其中，(u，u，z)表示TOF坐标系的坐标，(x，y，z)表示(u，u，z)在直角坐标系对应的坐标，fx表示ToF设备的第一内部参数，fy表示ToF设备的第二内部参数，cx表示ToF设备的第三内部参数，cy表示ToF设备的第四内部参数。
S200，根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面；所述第一参考面为限定所述ToF设备安装高度的平面。
上述第一参考面为限定ToF设备安装高度的平面，在很多情况下，ToF设备的安装高度为相对于地面计算的高度，此时该第一参考面为地面。上述步骤获取第一参考面在点云数据所处坐标系的映射面，便能够在点云数据所处坐标系进行安装参数的获取，以简化安装参数的获取过程。该步骤可以采用随机抽样一致算法(Random Sample Consensus，RANSAC)等平面拟合算法获取映射面，在拟合得到上述映射面的同时，还能够获得该映射面的第一法向量等相关平面参数；比如可以在点云数据中提取表征第一参考面的多个点，对这些提取的点进行平面拟合，以得到所需映射面。
在一个实施例中，所述根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面包括：
S210，从所述点云数据中提取K个表征所述第一参考面的目标点；
S220，对K个目标点进行平面拟合，得到所述映射面。
本实施例从点云数据中提取K个表征第一参考面的目标点，对K个目标点进行平面拟合，得到映射面，在保证所得映射面准确性的基础上，可以简化映射面的获取过程，进而简化安装参数的获取过程。
具体地，所述点云数据包括N个原始点；参考图5所示，所述从所述点云数据中提取K个表征所述第一参考面的目标点包括：
S211，从所述N个原始点随机抽取M个代表点，对所述M个代表点进行平面拟合，得到第二参考面；
S212，在所述M个代表点中获取属于所述第二参考面的K个选定点；
S213，若K大于点数阈值，则将所述K个选定点确定为所述K个目标点。
其中M可以依据N的大小设置，比如M为N的20％等值。点数阈值可以设有M的一定比例，比如设为M的40％等值。若K大于点数阈值，表明K个选定点能够表征相应映射表，此时可以将其确定为目标点进行平面拟合得到映射面。
进一步地，参考图5所示，上述从点云数据中提取K个表征所述第一参考面的目标点还包括：S214，若K小于或者等于点数阈值，且抽取M个代表点的次数小于或者等于次数阈值，则返回执行步骤S211。其中点数阈值可以依据计算精度等因素设置，比如设为100等值。若K小于或者等于点数阈值，且抽取M个代表点的次数大于次数阈值，则可以输出FAIL等目标点获取失败的提示信息，以退出当前循环。
S300，根据所述映射面和所述点云数据获取所述ToF设备的安装参数。
上述映射面能够表征地面等第一参考面，点云数据为ToF获取的数据点，两者位于相同的直角坐标系。依据该映射面、相应点云数据以及两者之间的相对关系能够准确获取ToF设备的安装参数，还能够简化安装参数的获取过程，将更为准确的安装参数直接写入ToF设备的相应位置，以供其运行的相关算法调用，能够保证相应算法的性能，提高ToF设备的工作效果。
在一个实施例中，所述根据所述映射面和所述点云数据获取所述ToF设备的安装参数包括：
获取所述映射面的第一法向量和所述点云数据投影至所述第一法向量的投影距离；
根据所述第一法向量和所述投影距离确定所述安装参数。
上述映射面的第一法向量和点云数据投影至第一法向量的投影距离通常可以在拟合得到映射面的过程中获取。第一法向量n、点云数据p以及云数据投影至第一法向量的投影距离D之间的关系为pTn＝D。具体地，所述安装参数包括安装高度和安装角度；所述安装高度为：hi＝D；所述安装角度为：其中，hi表示安装高度，D表示投影距离，α表示安装角度，ny表示第一法向量的第二维直角坐标，nz表示第一法向量的第三维直角坐标。
在一个示例中，以图1所安装的ToF设备为例对其安装参数的获取过程进一步说明，这里第一参考面为地面，如图6a所示在世界坐标系中，地面对应的第二法向量(地面法向量)为n′＝(0,0,1)，第一法向量为n＝(nx,ny,nz)，从点云数据所在直角坐标系观察(因为TOF设备是安装在hi高度，带有α倾角)，地面所在世界坐标系与点云数据所在直角坐标系各自的第三维坐标参数(距离等z坐标值)是不一样的。如图6b所示，在点云数据所在直角坐标系，第一法向量n与相应z方向所呈现的角度是α。通过随机抽样一致算法平面拟合可以获取第一法向量n。由于安装后的ToF设备是x方向对称的，所以nx约等于0，
以上ToF设备的安装参数获取方法，通过获取ToF设备探测的点云数据，根据点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面，使点云数据与映射面位于相同的直角坐标系，再依据该映射面、相应点云数据以及两者之间的相对关系获取ToF设备的安装参数，可以提高所获取的安装参数的准确性，还可以简化安装参数的获取过程，将更为准确的安装参数直接写入ToF设备的相应存储位置，以供其运行的相关算法调用，能够保证相应算法的性能，提高ToF设备的工作效果。
本申请在第二方面提供一种ToF设备的安装参数获取系统，参考图7所示，包括：
第一获取模块100，用于获取ToF设备探测的点云数据；
确定模块200，用于根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面；所述第一参考面为限定所述ToF设备安装高度的平面；
第二获取模块300，用于根据所述映射面和所述点云数据获取所述ToF设备的安装参数。
关于ToF设备的安装参数获取系统的具体限定可以参见上文中对于ToF设备的安装参数获取方法的限定，在此不再赘述。上述ToF设备的安装参数获取系统中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的运算模组中，也可以以软件形式存储于计算机设备中的存储器中，以便于计算机设备的运算模组调用执行以上各个模块对应的操作。
本申请在第三方面提供一种ToF设备，参考图8所示，该ToF设备包括处理器620和存储介质630；所述存储介质630上存储有程序代码；所述处理器620用于调用所述存储介质630存储的程序代码，以执行上述任一实施例提供的ToF设备的安装参数获取方法。
具体地，参考图8所示，上述ToF设备还可以包括TOF传感模块610，TOF传感模块610可以拍摄探测区域的深度图，使ToF设备对该深度图数据进行相应转换，得到点云数据，以用于所需安装参数的获取。
上述ToF设备采用上述任一实施例提供的ToF设备的安装参数获取安装参数，可以提高所得安装参数的准确性，简化安装参数的获取过程，将安装参数自动写入相应存储位置，以供其运行的相关算法调用，能够保证所运行算法的性能，提高ToF设备的工作效果。
本申请在第四方面提供一种智能产品，包括上述任一实施例提供的ToF设备。
在一个实施例中，所述ToF设备获取当前安装参数，在所述当前安装参数与预存安装参数之间的差值超过差值阈值时，将所述预存安装参数更新为所述当前安装参数。
上述差值阈值可以依据安装参数的特征设置，通常可以设为相应安装参数的一定比例，比如为相应安装参数的3％等值。预存安装参数可以为ToF设备获取并写入的安装参数。
具体地，对于一些位置可能发生移动的智能产品(如音响等)，其中ToF设备可以定时获取当前安装参数，检测当前安装参数与预存安装参数之间的差值，若该差值超过差值阈值，表征预存安装参数不能准确表征当前的安装位置，将预存安装参数更新为当前安装参数，以使预存安装参数能够准确表征相应智能产品当前的安装状态，从而保证智能产品相应功能的效果。
尽管已经相对于一个或多个实现方式示出并描述了本申请，但是本领域技术人员基于对本说明书和附图的阅读和理解将会想到等价变型和修改。本申请包括所有这样的修改和变型，并且仅由所附权利要求的范围限制。特别地关于由上述组件执行的各种功能，用于描述这样的组件的术语旨在对应于执行所述组件的指定功能(例如其在功能上是等价的)的任意组件(除非另外指示)，即使在结构上与执行本文所示的本说明书的示范性实现方式中的功能的公开结构不等同。
即，以上所述仅为本申请的实施例，并非因此限制本申请的专利范围，凡是利用本申请说明书及附图内容所作的等效结构或等效流程变换，例如各实施例之间技术特征的相互结合，或直接或间接运用在其他相关的技术领域，均同理包括在本申请的专利保护范围内。
另外，在本申请的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本申请和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本申请的限制。另外，对于特性相同或相似的结构元件，本申请可采用相同或者不相同的标号进行标识。此外，术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个特征。在本申请的描述中，“多个”的含义是两个或两个以上，除非另有明确具体的限定。
在本申请中，“示例性”一词是用来表示“用作例子、例证或说明”。本申请中被描述为“示例性”的任何一个实施例不一定被解释为比其它实施例更加优选或更加具优势。为了使本领域任何技术人员能够实现和使用本申请，本申请给出了以上描述。在以上描述中，为了解释的目的而列出了各个细节。应当明白的是，本领域普通技术人员可以认识到，在不使用这些特定细节的情况下也可以实现本申请。在其它实施例中，不会对公知的结构和过程进行详细阐述，以避免不必要的细节使本申请的描述变得晦涩。因此，本申请并非旨在限于所示的实施例，而是与符合本申请所公开的原理和特征的最广范围相一致。

Claims (10)

1.一种ToF设备的安装参数获取方法，其特征在于，包括：
S100，获取ToF设备探测的点云数据；
S200，根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面；所述第一参考面为限定所述ToF设备安装高度的平面；
S300，根据所述映射面和所述点云数据获取所述ToF设备的安装参数；
所述根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面包括：S210，从所述点云数据中提取K个表征所述第一参考面的目标点；S220，对K个目标点进行平面拟合，得到所述映射面；
所述点云数据包括N个原始点；所述从所述点云数据中提取K个表征所述第一参考面的目标点包括：S211，从所述N个原始点随机抽取M个代表点，对所述M个代表点进行平面拟合，得到第二参考面；S212，在所述M个代表点中获取属于所述第二参考面的K个选定点；S213，若K大于点数阈值，则将所述K个选定点确定为所述K个目标点；S214，若K小于或者等于点数阈值，且抽取M个代表点的次数小于或者等于次数阈值，则返回执行步骤S211。
2.根据权利要求1所述的ToF设备的安装参数获取方法，其特征在于，所述获取ToF设备拍摄的点云数据包括：
获取所述ToF设备拍摄的深度图；
对所述深度图进行坐标转换得到所述点云数据。
3.根据权利要求2所述的ToF设备的安装参数获取方法，其特征在于，所述深度图对应的坐标系为TOF坐标系，所述点云数据对应的坐标系为直角坐标系；
所述对所述深度图进行坐标转换得到所述点云数据包括：将所述深度图进从所述TOF坐标系转换至所述直角坐标系，得到所述点云数据。
4.根据权利要求3所述的ToF设备的安装参数获取方法，其特征在于，所述TOF坐标系与所述直角坐标系之间的转换公式包括：
其中，(u，u，z)表示TOF坐标系的坐标，(x，y，z)表示(u，u，z)在直角坐标系对应的坐标，fx表示ToF设备的第一内部参数，fy表示ToF设备的第二内部参数，cx表示ToF设备的第三内部参数，cy表示ToF设备的第四内部参数。
5.根据权利要求1所述的ToF设备的安装参数获取方法，其特征在于，所述根据所述映射面和所述点云数据获取所述ToF设备的安装参数包括：
获取所述映射面的第一法向量和所述点云数据投影至所述第一法向量的投影距离；
根据所述第一法向量和所述投影距离确定所述安装参数。
6.根据权利要求5所述的ToF设备的安装参数获取方法，其特征在于，所述安装参数包括安装高度和安装角度；所述安装高度为：hi＝D；所述安装角度为：其中，hi表示安装高度，D表示投影距离，α表示安装角度，ny表示第一法向量的第二维直角坐标，nz表示第一法向量的第三维直角坐标。
7.一种ToF设备的安装参数获取系统，其特征在于，包括：
第一获取模块，用于获取ToF设备探测的点云数据；
确定模块，用于根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面；所述第一参考面为限定所述ToF设备安装高度的平面；
第二获取模块，用于根据所述映射面和所述点云数据获取所述ToF设备的安装参数；
所述根据所述点云数据确定探测区域的第一参考面在所述点云数据所处坐标系的映射面包括：S210，从所述点云数据中提取K个表征所述第一参考面的目标点；S220，对K个目标点进行平面拟合，得到所述映射面；
所述点云数据包括N个原始点；所述从所述点云数据中提取K个表征所述第一参考面的目标点包括：S211，从所述N个原始点随机抽取M个代表点，对所述M个代表点进行平面拟合，得到第二参考面；S212，在所述M个代表点中获取属于所述第二参考面的K个选定点；S213，若K大于点数阈值，则将所述K个选定点确定为所述K个目标点；S214，若K小于或者等于点数阈值，且抽取M个代表点的次数小于或者等于次数阈值，则返回执行步骤S211。
8.一种ToF设备，其特征在于，包括处理器和存储介质；所述存储介质上存储有程序代码；所述处理器用于调用所述存储介质存储的程序代码，以执行如权利要求1至6任一项所述的ToF设备的安装参数获取方法。
9.一种智能产品，其特征在于，包括权利要求8所述的ToF设备。
10.根据权利要求9所述的智能产品，其特征在于，所述ToF设备获取当前安装参数，在所述当前安装参数与预存安装参数之间的差值超过差值阈值时，将所述预存安装参数更新为所述当前安装参数。
CN202110936705.4A 2021-08-16 2021-08-16 ToF设备的安装参数获取方法、系统和ToF设备 Active CN113689391B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110936705.4A CN113689391B (zh) 2021-08-16 2021-08-16 ToF设备的安装参数获取方法、系统和ToF设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110936705.4A CN113689391B (zh) 2021-08-16 2021-08-16 ToF设备的安装参数获取方法、系统和ToF设备

Publications (2)

Publication Number Publication Date
CN113689391A CN113689391A (zh) 2021-11-23
CN113689391B true CN113689391B (zh) 2024-07-19

Family

ID=78580260

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110936705.4A Active CN113689391B (zh) 2021-08-16 2021-08-16 ToF设备的安装参数获取方法、系统和ToF设备

Country Status (1)

Country Link
CN (1) CN113689391B (zh)

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112541950A (zh) * 2019-09-20 2021-03-23 杭州海康机器人技术有限公司 一种深度相机外参的标定方法、及装置

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100234196B1 (ko) * 1996-12-31 1999-12-15 윤종용 2차원 비디오 영상으로부터 높이 맵 생성방법
EP2154650A1 (en) * 2008-08-12 2010-02-17 IEE INTERNATIONAL ELECTRONICS & ENGINEERING S.A. 3D time-of-flight camera system and position/orientation calibration method therefor
CN110136203B (zh) * 2018-02-08 2022-02-18 浙江舜宇智能光学技术有限公司 Tof设备的标定方法及其标定系统
CN110852180B (zh) * 2019-10-17 2022-08-02 上海快仓智能科技有限公司 用于自动引导车的tof相机标定方法及自动引导车
CN112198528A (zh) * 2020-09-30 2021-01-08 上海炬佑智能科技有限公司 参考平面调整及障碍物检测方法、深度相机、导航设备
CN112233187B (zh) * 2020-10-20 2022-06-03 深圳无境智能机器人有限公司 一种方便稳定的rgbd相机外参数标定方法
CN113205549B (zh) * 2021-05-07 2023-11-28 深圳市商汤科技有限公司 深度估计方法及装置、电子设备和存储介质

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112541950A (zh) * 2019-09-20 2021-03-23 杭州海康机器人技术有限公司 一种深度相机外参的标定方法、及装置

Also Published As

Publication number Publication date
CN113689391A (zh) 2021-11-23

Similar Documents

Publication Publication Date Title
US8588512B2 (en) Localization method for a moving robot
KR102354299B1 (ko) 단일 영상을 이용한 카메라 캘리브레이션 방법 및 이를 위한 장치
CN110111388B (zh) 三维物体位姿参数估计方法及视觉设备
CN110568447A (zh) 视觉定位的方法、装置及计算机可读介质
CN103377471B (zh) 物体定位方法和装置、最优摄像机对确定方法和装置
KR20160003776A (ko) 자세 추정 방법 및 로봇
CN112083403B (zh) 用于虚拟场景的定位追踪误差校正方法及系统
JP2018524657A (ja) 電子デバイス上における環境マッピング用のフィーチャ・データの管理
WO2022217988A1 (zh) 传感器配置方案确定方法、装置、计算机设备、存储介质及程序
CN113052907B (zh) 一种动态环境移动机器人的定位方法
CN102450006A (zh) 物体位置推定装置、物体位置推定方法及物体位置推定程序
JP2020149641A (ja) 物体追跡装置および物体追跡方法
CN111025330B (zh) 一种基于深度图的目标倾斜角检测方法及设备
WO2020007323A1 (zh) 商超购物车定位方法、商超购物车定位系统及商超购物车
CN114661049A (zh) 一种巡检方法、装置及计算机可读介质
KR102547333B1 (ko) 깊이 영상 기반 실시간 바닥 검출방법
JP5267100B2 (ja) 運動推定装置及びプログラム
CN113689391B (zh) ToF设备的安装参数获取方法、系统和ToF设备
CN114034303A (zh) 一种基于卡尔曼滤波的移动目标物定位方法、装置
CN112344966A (zh) 一种定位失效检测方法、装置、存储介质及电子设备
CN111586299B (zh) 一种图像处理方法和相关设备
CN117523010B (zh) 车辆的相机位姿确定方法、装置、计算机设备和存储介质
CN117308967B (zh) 一种目标对象位置信息的确定方法、装置及设备
CN113029166B (zh) 定位方法、装置、电子设备及存储介质
CN110176034B (zh) 用于vslam的定位方法及扫描终端

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