基于单点TOF的点云数据获取方法、芯片和移动机器人

技术领域

本发明涉及电子技术领域，具体涉及一种基于单点TOF的点云数据获取方法、芯片和移动机器人。

背景技术

移动机器人在进行移动前，会先对自身的位置进行建图和定位，然后在根据建立的地形图和自身所处的位置进行移动，目前对于现有的机器人来说，都是采用视觉、激光雷达或惯性导航来进行建图和定位，如果设置的传感器少，获取到的检测数据需要经过复杂的计算才可以用于机器人的建图、定位或沿边，计算难度大；如果设置的传感器多，生产成本过高。

发明内容

为解决上述问题，本发明提供了一种基于单点TOF的点云数据获取方法、芯片和移动机器人，采用单点TOF传感器进行点云信息获取，精度高、成本低。本发明的具体技术方案如下：

一种基于单点TOF的点云数据获取方法，该方法包括以下步骤：S1：移动机器人设置基础坐标，获取IMU数据和TOF数据；S2：移动机器人基于基础坐标和IMU数据确定当前的机器人坐标；S3：移动机器人基于当前的机器人坐标来获取TOF坐标；S4：移动机器人基于当前的机器人坐标、TOF坐标和TOF数据确定点云数据。移动机器人通过设置基础坐标来获取移动过程中的坐标，然后根据移动过程中的坐标和检测数据来获取一系列障碍物相对于基础坐标的坐标，准确度高，采用TOF传感器作为检测传感器，成本较低；获取的点云数据可以根据实际情况，用于机器人的建图、定位及避障，实用性高。

于本发明的一个或多个方案中，步骤S1中：移动机器人以开始工作时的中心位置为基础坐标。移动机器人在开始工作时设置基础坐标，提高机器人获取的数据的准确度。

于本发明的一个或多个方案中，步骤S2中：所述机器人坐标为移动机器人中心位置的坐标，移动机器人以基础坐标为原点建立世界坐标系，根据移动过程中获取的IMU数据来算出当前的机器人坐标。

于本发明的一个或多个方案中，步骤S3中：所述TOF坐标为TOF模块的坐标，移动机器人预先获取TOF模块相对于机器人中心的位置信息，然后移动机器人以机器人坐标为原点，正前方为x轴，建立坐标系，根据机器人坐标和位置信息来获取TOF坐标。

于本发明的一个或多个方案中，步骤S4中：所述TOF数据为TOF模块与障碍物之间的测量距离，移动机器人采用计算公式根据机器人坐标、TOF坐标和TOF数据来获取障碍物的坐标，所述障碍物的坐标作为移动机器人获取的点云数据。通过预先设置TOF模块在机器人上的位置信息和移动过程中获取的数据来确定TOF模块的坐标，准确度高，实用性强。

于本发明的一个或多个方案中，所述计算公式为：ox=cos（rθ）* tx-sin(rθ)* ty+rx+d*cos(rθ+ tθ)；oy=sin（rθ）* tx+cos(rθ)* ty+ ry+d*sin(rθ+ tθ)；其中，机器人坐标为（rx，ry，rθ），TOF坐标为（tx，ty，tθ），TOF数据为d，障碍物的坐标为（ox，oy）。

一种移动机器人，所述移动机器人执行上述的基于单点TOF的点云数据获取方法，包括主体，所述主体上设有TOF模块和IMU模块，所述TOF模块用于检测TOF模块与障碍物之间的距离，所述IMU模块用于获取IMU数据。机器人通过TOF模块和IMU模块来获取数据，结构简单，生产成本低。

于本发明的一个或多个方案中，所述IMU模块包括六轴陀螺仪和码盘。

一种芯片，内置控制程序，其特征在于，所述控制程序用于控制机器人执行上述的基于单点TOF的点云数据获取方法。机器人通过装载该芯片就可以使用该方法，实用性高。

一种移动机器人，装配有主控芯片，其特征在于，所述主控芯片是上述的芯片。机器人通过该方法来进行点云数据获取，降低机器人的生产成本。

附图说明

图1为本发明的基于单点TOF的点云数据获取方法的流程示意图；

图2为本发明的移动机器人的坐标的结构示意图；

图3为本发明的移动机器人的结构示意图。

具体实施方式

下面详细描述本发明的实施例，所述的实施例示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。

在本发明的描述中，需要说明的是，对于方位词，如有术语“中心”，“横向”、“纵向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”、“顺时针”、“逆时针”等指示方位和位置关系为基于附图所示的方位或位置关系，仅是为了便于叙述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定方位构造和操作，不能理解为限制本发明的具体保护范围。

此外，如有术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或隐含指明技术特征的数量。由此，限定有“第一”、“第二”特征可以明示或者隐含包括一个或者多个该特征，在本发明描述中，“至少”的含义是一个或一个以上，除非另有明确具体的限定。

在本发明中，除另有明确规定和限定，如有术语“组装”、“相连”、“连接”术语应作广义去理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；也可以是机械连接；可以是直接相连，也可以是通过中间媒介相连，可以是两个元件内部相连通。对于本领域普通技术人员而言，可以根据具体情况理解上述的术语在本发明中的具体含义。

在发明中，除非另有规定和限定，第一特征在第二特征之“上”或之“下”可以包括第一和第二特征直接接触，也可以包括第一特征和第二特征不是直接接触而是通过它们之间的另外特征接触。而且，第一特征在第二特征“之上”、“之下”和“上面”包括第一特征在第二特征正上方和斜上方，或仅仅是表示第一特征水平高度高于第二特征的高度。第一特征在第二特征 “之上”、“之下”和“下面”包括第一特征在第二特征正下方或斜下方，或仅仅表示第一特征水平高度低于第二特征。

下面结合说明书的附图，通过对本发明的具体实施方式作进一步的描述，使本发明的技术方案及其有益效果更加清楚、明确。下面通过参考附图描述实施例是示例性的，旨在解释本发明，而不能理解为对本发明的限制。

参考图1可知，一种基于单点TOF的点云数据获取方法，该方法包括以下步骤：S1：移动机器人设置基础坐标，获取IMU数据和TOF数据；S2：移动机器人基于基础坐标和IMU数据确定当前的机器人坐标；S3：移动机器人基于当前的机器人坐标来获取TOF坐标；S4：移动机器人基于当前的机器人坐标、TOF坐标和TOF数据确定点云数据。移动机器人通过设置基础坐标来获取移动过程中的坐标，然后根据移动过程中的坐标和检测数据来获取一系列障碍物相对于基础坐标的坐标，准确度高，采用TOF传感器作为检测传感器，成本较低；获取的点云数据可以根据实际情况，用于机器人的建图、定位及避障，实用性高。

作为其中一种实施例，移动机器人以开始工作时的中心位置为基础坐标。移动机器人在开始工作时设置基础坐标，提高机器人获取的数据的准确度。

作为其中一种实施例，所述机器人坐标为移动机器人中心位置的坐标，移动机器人以基础坐标为原点建立世界坐标系，根据移动过程中获取的IMU数据来算出当前的机器人坐标。

作为其中一种实施例，所述TOF坐标为TOF模块的坐标，移动机器人预先获取TOF模块相对于机器人中心的位置信息，然后移动机器人以机器人坐标为原点，正前方为x轴，建立坐标系，根据机器人坐标和位置信息来获取TOF坐标。

作为其中一种实施例，所述TOF数据为TOF模块与障碍物之间的测量距离，移动机器人采用计算公式根据机器人坐标、TOF坐标和TOF数据来获取障碍物的坐标，所述障碍物的坐标作为移动机器人获取的点云数据。通过预先设置TOF模块在机器人上的位置信息和移动过程中获取的数据来确定TOF模块的坐标，准确度高，实用性强。所述计算公式为：ox=cos（rθ）* tx-sin(rθ)* ty+ rx+d*cos(rθ+ tθ)；oy=sin（rθ）* tx+cos(rθ)* ty+ ry+d*sin(rθ+ tθ)；其中，机器人坐标为（rx，ry，rθ），TOF坐标为（tx，ty，tθ），TOF数据为d，障碍物的坐标为（ox，oy）。

一种移动机器人，所述移动机器人执行上述的基于单点TOF的点云数据获取方法，包括主体，所述主体上设有TOF模块和IMU模块，所述TOF模块用于检测TOF模块与障碍物之间的距离，所述IMU模块用于获取IMU数据。机器人通过TOF模块和IMU模块来获取数据，结构简单，生产成本低。所述IMU模块包括六轴陀螺仪和码盘。

由参照图2可知，移动机器人在工作时，以自身的中心位置为基础坐标，在以基础坐标为原点建立世界坐标系，移动机器人然后开始移动，并在移动过程中通过IMU模块获取IMU数据，通过采集t1时刻到t2时刻之间的IMU数据，通过IMU数据就可以估算出机器人在t1时刻到t2时刻的相对运动姿态。从而可以根据t1时刻的机器人坐标，计算出t2时刻的机器人坐标。对于平面移动的机器人来说，IMU数据仅包括角速度方向垂直于地面的角速度大小，及两轮的编码器计数即可估算机器人的姿态。（此为机器人公开技术，常用于惯性导航机器人）。移动机器人在知道当前的机器人坐标后，以当前的机器人坐标为原点建立机器人坐标系，机器人的正前方为x轴，y轴可以根据实际情况设置，图中y轴为移动机器人的左侧方向，在根据设置TOF模块时的位置参数，获取TOF模块相对于机器人坐标系的TOF坐标，比如图中的机器人坐标为（1.0,1.0,1.5707），则TOF坐标为（0.035，-0.165，-1.5707），然后根据TOF模块获取到的TOF模块与障碍物之间的距离、机器人坐标和TOF坐标，通过公式ox=cos（rθ）* tx-sin(rθ)* ty+ rx+d*cos(rθ+ tθ)；oy=sin（rθ）* tx+cos(rθ)* ty+ ry+d*sin(rθ+ tθ)；其中，机器人坐标为（rx，ry，rθ），TOF坐标为（tx，ty，tθ），TOF数据为d，得到障碍物的坐标为（ox，oy）。点云数据(point cloud data)是指扫描资料以点的形式记录，本申请中，采用的是单点的TOF模块，获取到的是障碍物上一个点的坐标，该坐标就是点云数据。移动机器人在移动过程中就可以获取一系列的点云数据。

一种芯片，内置控制程序，其特征在于，所述控制程序用于控制机器人执行上述的基于单点TOF的点云数据获取方法。机器人通过装载该芯片就可以使用该方法，实用性高。

一种移动机器人，装配有主控芯片，其特征在于，所述主控芯片是上述的芯片。机器人通过该方法来进行点云数据获取，降低机器人的生产成本。

参照图3可知，一种机器人的点云数据获取结构，包括主体1和控制器，所述主体的左前侧或右前侧上设有单点的TOF模块2，所述TOF模块2与所述控制器电连接，所述TOF模块2检测方向与机器人的轮轴线平行。TOF模块2的探测方向与墙面垂直设置，便于机器人获取机器人与墙面之间的距离信息，并且机器人可以在沿边的过程中将获取的数据直接用于修改机器人的位姿，不需要经过复杂的计算。

作为其中一种实施例，所述TOF模块2包括TOF传感器，所述TOF传感器的型号为VL6180。成本较低，实用性高。所述TOF传感器包括发射器和接收器，所述发射器和接收器水平排列设置。所述TOF模块2的中线与主体1的中线之间的间隔为30mm到40mm，所述主体1的中线与机器人的轮轴线平行，该设置间隔可以使机器更好的沿边绕柱和绕墙角，获取的数据更加准确。

作为其中一种实施例，所述主体1的前端设有碰撞条3，所述碰撞条3上设有圆孔4，所述TOF模块2设置在圆孔4的一侧，并通过该圆孔4检测障碍物。所述主体1包括IMU模块，所述IMU模块包括六轴陀螺仪和码盘，所述六轴陀螺仪和所述码盘分别与控制器电连接。

在说明书的描述中，参考术语“合一个实施例”、“优选地”、“示例”、“具体示例”或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点，包含于本发明的至少一个实施例或示例中，在本说明书中对于上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或者示例中以合适方式结合。说明书的描述中连接的所述连接方式具有明显的效果和实用效力。

通过上述的结构和原理的描述，所属技术领域的技术人员应当理解，本发明不局限于上述的具体实施方式，在本发明基础上采用本领域公知技术的改进和替代均落在本发明的保护范围，应由各权利要求限定之。