一种基于视频的机器人导航方法及系统技术方案

本发明专利技术涉及导航领域，尤其涉及一种基于视频的机器人导航方法及系统。本发明专利技术通过建立视频图像像素点位置与地面位置的对应关系；获取视频图像像素点；根据所述像素点的位置获取地面位置。实现通过在机器人上安装摄像头，实时获取机器人能检测到的实际场景，得到视频图像，在视频图像中选取一像素点，并驱动机器人至所述像素点所表示的地面位置，从而实现可针对机器人周围的实际场景导航机器人。

【技术实现步骤摘要】

本专利技术涉及导航领域，尤其涉及一种基于视频的机器人导航方法及系统。
技术介绍
目前业界的机器人导航，基本上是在一幅导航地图中，点击地图上的某个像素点或选择某个位置，再通过所选位置相对于整个地图的长宽比例来计算转化为现实场景中的目标位置，然后控制机器人再移动到那个位置。使用地图导航控制机器人移动的缺点在于地图是一张静态图片，事先在地图上按比例画好路线、障碍等标志物，无法实时反映实际场景中的变化。
技术实现思路
本专利技术所要解决的技术问题是：提供一种基于视频的机器人导航方法及系统，实现可针对机器人周围的实际场景导航机器人。为了解决上述技术问题，本专利技术采用的技术方案为：本专利技术提供一种基于视频的机器人导航方法，包括：建立视频图像像素点位置与地面位置的对应关系；获取视频图像像素点；根据所述像素点的位置获取地面位置。上述基于视频的机器人导航方法，其有益效果在于：区别于现有技术使用地图导航控制机器人移动，无法根据实际场景中的变化进行导航。本专利技术通过在机器人上安装摄像头，实时获取机器人能检测到的实际场景，得到视频图像，再建立视频图像中像素点位置与地面位置的对应关系，可在视频图像中选取一像素点，并驱动机器人至所述像素点所表示的地面位置，从而实现可针对机器人周围的实际场景导航机器人。本专利技术还提供一种基于视频的机器人导航系统，包括：建立模块，用于建立视频图像像素点位置与地面位置的对应关系；第一获取模块，用于获取视频图像像素点；第二获取模块，用于根据所述像素点的位置获取地面位置。上述基于视频的机器人导航系统，其有益效果在于：通过建立模块建立视频图像中像素点位置与地面位置的对应关系，通过第一获取模块在视频图像中选取一像素点，再通过第二获取模块获取选取的像素点所对应的地面位置，从而可驱动机器人至所述像素点所表示的地面位置，实现可针对机器人周围的实际场景导航机器人。附图说明图1为本专利技术一种基于视频的机器人导航方法的流程框图；图2为本专利技术一种基于视频的机器人导航系统的结构框图；标号说明：1、建立模块；2、第一获取模块；3、第二获取模块；31、第一计算单元；32、第二计算单元；4、第三获取模块；5、计算模块；6、第四获取模块；7、驱动模块。具体实施方式为详细说明本专利技术的
技术实现思路
、所实现目的及效果，以下结合实施方式并配合附图予以说明。本专利技术最关键的构思在于：通过实时获取机器人周围的场景视频图像，在场景视频图像中选择像素点，并将所述像素点在视频图像中的位置转换为地面位置，驱动机器人至所述地面位置，实现可针对机器人周围的实际场景导航机器人。如图1所示，本专利技术提供一种基于视频的机器人导航方法，包括：建立视频图像像素点位置与地面位置的对应关系；获取视频图像像素点；根据所述像素点的位置获取地面位置。进一步地，根据所述像素点的位置获取地面位置，具体为：根据所述像素点的位置，计算得到机器人的摄像头相对于所述地面位置的垂直方向偏角和水平方向偏角；根据所述垂直方向偏角和所述水平方向偏角，计算得到所述地面位置相对于机器人的摄像头的垂直距离和水平距离。由上述描述可知，可根据像素点的位置计算出该像素点所对应的地面位置距离机器人的摄像头的偏移量。优选地，计算机器人的摄像头相对于所述地面位置的垂直方向偏角和水平方向偏角的方法步骤具体为：以监控端的视频图像的左上角为原点，右方为X轴正半轴，下方为Y轴正半轴建立直角坐标系，得到第一坐标系。在监控端的视频图像中选取一像素点作为目标像素点，该像素点在第一坐标系中的坐标为(x1，y1)，监控端的分辨率为width1*height1。计算所述像素点在监控端的视频图像中的垂直比例和水平比例，rateX1＝x1/width1，rateY1＝y1/height1；以监控端的视频图像的左上角为原点，右方为X轴正半轴，下方为Y轴正半轴建立直角坐标系，得到第二坐标系。获取机器人端视频图像的分辨率width2*height2；计算所述目标像素点在机器人端视频图像中的坐标(x2，y2)，x2＝width2*rateX1，y2＝height2*rateY1；获取摄像头的水平视角angW和垂直视角angH；计算得到所述目标像素点对应的地面位置与摄像头之间的水平偏角angX和垂直偏角angY，angX＝(x2/width2-0.5)*angW，angY＝(Y2/height2-0.5)*angH；获取摄像头距地面的垂直高度z；计算所述目标像素点对应的地面位置相对于摄像头对应的地面位置的水平偏移量x3和垂直偏移量y3，y3＝z/tan(angY)；x3＝y3*tan(angX)。进一步地，还包括：获取机器人的摄像头相对于机器人正前方的角度；根据所述地面位置相对于机器人的摄像头的垂直距离和水平距离和所述角度，计算得到所述地面位置相对于机器人的垂直距离和水平距离。由上述描述可知，可根据地面位置相对于机器人的摄像头的偏移量计算出该地面位置相对于机器人的偏移量。机器人的摄像头可以安装在任意方位，当机器人的摄像头不是安装在机器人的正前方时，需要将地面位置相对于机器人摄像头的偏移量转换为相对于机器人正前方的偏移量，才能正确地根据偏移量驱动机器人至所述地面位置。优选地，计算所述地面位置相对于机器人的垂直距离和水平距离具体为：以机器人为原点，正前方为Y轴正半轴，右方为X轴正半轴，上方为Z轴正半轴建立坐标系，得到第三坐标系。获取机器人的摄像头在第三坐标系中的坐标(x4，y4，z4)，摄像头相对于机器人正前方的角度angC，所述目标像素点对应的地面位置相对于摄像头对应的地面位置的水平偏移量x3和垂直偏移量y3，计算得到所述目标像素点对应的地面位置相对于机器人的水平偏移量x5和垂直偏移量y5，x5＝x3*cos(-angC)–y3*sin(-angC)+x4；y5＝x3*sin(-angC)+y3*cos(-angC)+y4。进一步地，还包括：实时获取机器人的摄像头拍摄的画面，得到所述视频图像。由上述描述可知，实现实时获取机器人周围的实际场景。进一步地，还包括：驱动机器人至所述地面位置。由上述描述可知，实现驱动机器人至在视频图像中选取的像素点对应于实际场景中的地面位置。如图2所示，本专利技术还提供一种基于视频的机器人导航系统，包括：建立模块1，用于建立视频图像像素点位置与地面位置的对应关系；第一获取模块2，用于获取视频图像像素点；第二获取模块3，用于根据所述像素点的位置获取地面位置。进一步地，所述第二获取模块3包括：第一计算单元31，用于根据所述像素点的位置，计算得到机器人的摄像头相对于所述地面位置的垂直方向偏角和水平方向偏角；第二计算单元32，用于根据所述垂直方向偏角和所述水平方向偏角，计算得到所述地面位置相对于机器人的摄像头的垂直距离和水平距离。进一步地，还包括：第三获取模块4，用于获取机器人的摄像头相对于机器人正前方的角度；计算模块5，用于根据所述地面位置相对于机器人的摄像头的垂直距离和水平距离和所述角度，计算得到所述地面位置相对于机器人的垂直距离和水平距离。进一步地，还包括：第四获取模块6，用于实时获取机器人的摄像头拍摄的画面，得到所述视频图像。进一步地，还包括：驱动模块7，用于驱动机器人至所述地面位置。本专利技术的实施例一为：实时获取机器人的摄像头拍摄本文档来自技高网...

【技术保护点】
一种基于视频的机器人导航方法，其特征在于，包括：建立视频图像像素点位置与地面位置的对应关系；获取视频图像像素点；根据所述像素点的位置获取地面位置。

【技术特征摘要】
1.一种基于视频的机器人导航方法，其特征在于，包括：建立视频图像像素点位置与地面位置的对应关系；获取视频图像像素点；根据所述像素点的位置获取地面位置。2.根据权利要求1所述的一种基于视频的机器人导航方法，其特征在于，根据所述像素点的位置获取地面位置，具体为：根据所述像素点的位置，计算得到机器人的摄像头相对于所述地面位置的垂直方向偏角和水平方向偏角；根据所述垂直方向偏角和所述水平方向偏角，计算得到所述地面位置相对于机器人的摄像头的垂直距离和水平距离。3.根据权利要求2所述的一种基于视频的机器人导航方法，其特征在于，还包括：获取机器人的摄像头相对于机器人正前方的角度；根据所述地面位置相对于机器人的摄像头的垂直距离和水平距离和所述角度，计算得到所述地面位置相对于机器人的垂直距离和水平距离。4.根据权利要求1所述的一种基于视频的机器人导航方法，其特征在于，还包括：实时获取机器人的摄像头拍摄的画面，得到所述视频图像。5.根据权利要求1所述的一种基于视频的机器人导航方法，其特征在于，还包括：驱动机器人至所述地面位置。6.一种基于视频的机器人导航系统，其特征在于，包括：建立模块，用于...

【专利技术属性】
技术研发人员：刘德建，念小义，何学城，陈宏展，
申请(专利权)人：福建网龙计算机网络信息技术有限公司，
类型：发明
国别省市：福建;35