CN106292697A - 一种移动设备的室内路径规划与导航方法 - Google Patents

一种移动设备的室内路径规划与导航方法 Download PDF

Info

Publication number
CN106292697A
CN106292697A CN201610597435.8A CN201610597435A CN106292697A CN 106292697 A CN106292697 A CN 106292697A CN 201610597435 A CN201610597435 A CN 201610597435A CN 106292697 A CN106292697 A CN 106292697A
Authority
CN
China
Prior art keywords
path
app
information
coordinate
map
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.)
Granted
Application number
CN201610597435.8A
Other languages
English (en)
Other versions
CN106292697B (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.)
Beijing University of Technology
Original Assignee
Beijing University of Technology
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 Beijing University of Technology filed Critical Beijing University of Technology
Priority to CN201610597435.8A priority Critical patent/CN106292697B/zh
Publication of CN106292697A publication Critical patent/CN106292697A/zh
Application granted granted Critical
Publication of CN106292697B publication Critical patent/CN106292697B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft

Abstract

一种移动智能设备的室内路径规划与导航方法,该方法属于无线控制机器人导航的技术领域。该室内路径规划与导航方法包括以下步骤:步骤1,首先安装在手持可通信智能设备的室内路径规划与导航应用程序自动获取室内路径规划与导航地图。然后用户在APP的室内路径规划与导航地图上绘画路径,APP进行用户绘画路径信息的采集。步骤2,APP将绘画路径信息进行路径坐标信息转化。步骤3,绘画路径与实际地理信息坐标的转化。步骤4,APP对绘画的路径的进行实际情况合理性的评估步骤。5,APP传输合理路径数据给移动智能设备。本方法可以解决自主路径规划和自主导航的相对有更好的时效性,更具简洁性,并且具有可自定制性。

Description

一种移动设备的室内路径规划与导航方法
技术领域
本发明涉及一种移动智能设备的室内路径规划与导航方法,该方法属于无线控制机器人导航的技术领域。
背景技术
目前移动智能设备的比较成熟的导航技术主要是运用GPS定位系统的帮助来实现导航的,特别是在户外的导航,GPS应用十分广泛。然而在室内,由于技术限制,GPS的准确地定位受诸多因素影响,所以室内的导航大多不采用GPS定位的方式来实现导航。目前相对应用广泛的室内导航方式主要有:电磁导航、视觉导航(镜头采取图像的方法等)。电磁导航相对成本高,且不容易执行;相对而言,视觉导航更容易实现,但是其不够精确,导致实际的导航效果亦存在诸多问题。
相比室外导航,室内导航最大的困难点就在于没有准确地导航定位辅助系统,GPS等卫星定位系统并不能深入室内,所以只能通过激光测距、无线局域网路的等方法来进行定位工作,这些方法均有些局限性,不能带来准确地导航。
现有的一些公开的论文或者专利主要存在以下几个方面的问题。专利名称:一种微型无人机室内自主导航方法(专利号:CN201410466305.1)。
该专利公开了一种微型无人机室内自主导航方法,其特征在于,该方法包括以下步骤:S1:基于RGB-D相机和MEMS惯性传感器的微型无人机运动状态估计:利用RGB-D相机获取环境的二维彩色图像和三维深度数据,通过特征点检测、特征点匹配、运动状态估计获得微型无人机的姿态和位置参数估计值,利用MEMS传感器获取惯性测量值,将所述姿态和位置参数估计值与惯性测量值通过滤波方法进行信息融合,用以抑制惯性测量值误差积累,得到更为精确的无人机包括位置、速度、姿态在内的运动状态估计值;S2:基于RGB-D相机和MEMS惯性传感器融合的三维环境实时建模:利用步骤S1中RGB-D相机获取的三维深度数据,以及融合后的运动状态估计值进行三维点云的精确配准与融合,构建三维环境模型,并触发式地对该模型进行全局优化,用以提高模型精度;S3:实时可信路径规划与路径跟踪控制:设定规划周期,在每个规划周期中,以步骤S2得到的三维环境模型为基础,同时建立RGB-D相机的测量误差模型和定位可信度的评价函数,从而生成无人机从当前点到目标点的路径,在每个规划周期结束后,选择当前最优路径执行;根据所述当前最优路径,与步骤S1得到运动状态估计值进行比较,得到当前的位置偏差,从而根据当前位置偏差生成无人机的位置控制指令,根据位置控制指令解算为无人机的姿态控制指令,实施位置控制和姿态控制,引导无人机跟踪预定路径飞行。
该专利运用的是视觉导航方法,该导航方法利用相机和惯性传感器进行路径的计算预估,以期实现路径规划;这种路径规划因为是通过实时规划与之前预设的进行对比择优进而选取路径执行,因此目的性不够明确,路径的简洁性和相对时间浪费存在很大问题,但是该方法的优点是路径规划可以根据周围情况及时调整,保证了安全性。
《室内环境下的机器人路径规划》作者:刘蕾
该论本文首先对静态已知环境下的路径规划方法进行讨论,分别采用可视图法和随机路图法实现静态已知环境下的全局路径规划。通过仿真和实验结果系统地分析了二者的特点,并在此基础上重新界定了两类方法各自的适用范围。同时将准随机采样策略应用于随机路图采样点生成过程,使得采样点分布均匀性显著增强,偏差度量降低,从而提高了路径搜索的成功率。未知环境下的路径规划重点在于如何实时获取环境信息并有效利用。
本文在对传统势场法进行分析的基础上,提出一种基于激光测距仪数据信息的改进方向权值法,方法中的安全策略更适用于实际的应用环境。仿真和实验结果证明,该方法考虑不同的障碍物情况并充分利用环境信息,能够有效完成未知环境下的局部路径规划。针对动态时变环境路径规划这一更具实际意义和挑战性的问题,本文该论文提出一种新的概率方向权值法,依据障碍物的运动特性建立障碍物运动模型,并应用卡尔曼滤波对运动障碍物信息进行有效预估。同时基于周期规划将障碍物预估信息、实际信息与目标信息有效结合,实现了动态时变环境下存在运动障碍物和动态目标的实时路径规划。在此基础上,提出一种基于优先级的冲突消解策略,实现了动态环境下多机器人路径规划。该策略简单易行,保证了多机器人路径规划中的安全性。本文进行了一系列软件仿真和基于SmanROB2机器人平台的实验,通过对实验结果和数据的分析讨论,表明了所提方法的有效性和实用性。
本论文基于随机路图法和可视图法基础上提出一种新的概率方向权值法,该方法基本可以解决实际动态未知环境下的路径规划,但是该方法实现的路径规划相对复杂,其主要目的是保证路径规划中的安全性,没有解决路径的简洁时效性。
《室内移动机器人路径规划与定位技术研究》作者:宋婷
论文分析了已有路径规划技术的方法,重点研究了基于栅格地图的路径规划算法:区域覆盖路径规划算法和点到点路径规划算法。针对室内环境特点提出了环境地图的建模,具体算法设计以及基本的行进方式,用VS.NET软件开发平台,对两种路径规划算法进行了软件仿真。还研究了室内定位系统的相关技术以及常用的室内定位方法的基础上,分析了多种室内定位算法的应用特点和测距方法,重点研究了基于ZigBee无线网络的室内定位技术。
该论文主要研究栅格地图的路径规划算法,和无线网络室内定位技术,来实现路径规划导航,该论文主要是对这两方法的研究,但是没有实际实施的效果,而且这种路径规划不具备择优性,仅仅是针对路径算法的研究。
本发明方法为一种具有简洁性的路径规划方法,且目的性较强。同时本方法还包括按照路径规划的指向性导航方法。用本方法可以让自主路径规划和自主导航相对有更好的时效性,更具简洁性,并且具有可自定制性。
发明内容
针对控制移动智能设备,包括机器人、智能车、无人机等,解决了远程自由控制智能设备地理位置的问题,发明一种移动设备的室内路径规划与导航方法。先通过软件构造局部地图数据获取的方法进行对设备周边的地理信息进行确定,再运用安装在手持可通信智能设备(手机、平板电脑等)的室内路径规划与导航应用程序(以下简称APP)对用户绘画的路径的录入进行识别,结合APP自动获取室内路径规划与导航地图的地理信息和绘画路径,规定方向换算距离,根据绘画路径制定出路径规划,传输给移动智能设备。
上述室内路径规划与导航方法为一种绘画路径规划与实际路径转换实现方法,实现本方法的手持可通信智能设备具有显示屏和触摸控制功能。
上述室内路径规划与导航方法包括以下步骤:
步骤1,APP自动获取室内路径规划与导航地图并采集用户的绘画路径信息。
运用软件构造局部地图数据的方法得到智能移动设备活动范围的地理信息,即电子地图文件并存储在手持可通信智能设备当中。上述电子地图文件能够在手持可通信智能设备内置的APP上读取或修改,内置的APP为智能移动设备的地理信息显示、操作处理端。运用上述电子地图文件并通过无线局域网定位技术能够定位出智能移动设备在当前区域内的具体位置坐标,如果智能移动设备能够接收到卫星信号并进行地理信息捕捉,那么借助卫星信号获取当前的地理信息坐标数据,亦或者地磁定位技术定位等方法。用户开启手持可通信智能设备的APP,在手持可通信智能设备的触摸屏上根据APP在屏幕上显示的室内路径规划与导航地图,以移动智能设备所在的原点为起点,用手指或触屏专用工具在触摸屏上进行本路径的绘画,APP读取用户的绘画路径并进行存储录入。APP录入相同起点的多组路径并进行存储,方便用户快速调用。
步骤2,APP将绘画路径信息进行路径坐标信息转化。
APP将录入绘画信息进行简化处理,利用输入的相邻地点坐标进行直线连接,对相邻坐标点存在的弯曲线进行精简处理,使得路径呈现为折线。设定绘画路径起点方向为正方向,并确定室内路径规划与导航地图的零点,将精简后的路径转换成数据坐标信息,并进行存储。
步骤3,绘画路径与实际地理信息坐标的转化。
把精简后的绘画路径折线按照APP中放大地图比例和室内路径规划与导航地图与实际的比例尺换算成实际线路的路径的长度大小,设从中获取路径的每端折线交叉点为关键点,记录这些关键点坐标并进行实际数据信息转化。最后APP将实际路径长度与关键点实际坐标结合,得到实际的准确路径信息并存储在APP当中。
步骤4,APP对绘画的路径的进行实际情况合理性的评估。
APP在存储的室内路径规划与导航地图中识别图中存在的障碍物并进行记录,通过实际准确路径信息在实际地理信息相比较的方法里判定上述路径规划的合理性,当规划路径的中途有障碍物遮挡,有部分路径不能通过,或者会影响被智能移动设备正常行驶(会和旁边障碍物发生剐蹭等)的情况,则上述的绘画的路径对应方案不可行,APP会提示用户路径规划无效。若没有以上影响,则可行,APP会提示路径规划成功。如果在一个没有障碍物的局部区域中实现的话,APP自动省去此步骤。
步骤5,APP传输合理路径数据给移动智能设备。
通过局域网的技术,手持可通信智能设备和移动智能设备在相同的局域网内进行互联,即通过APP端能够与移动智能设备进行数据的传输交互,APP将实际的准确路径信息转化成移动智能设备能够识别的命令并传输给它,使得移动智能设备按照命令进行移动,便实现室内路径规划与导航。
所述局域网的技术为WiFi或蓝牙或移动网络技术。
附图说明
图1实施方式一流程图
图2空旷区域场景图。
图3绘画路径示例图。
图4取绘画路径关键点。
图5实施方式二流程图
图6复杂场景示例图。
图7复杂场景俯视平面图。
图8绘画路径示例。
图9取绘画路径路径关键点。
图10根据关键点获得的规划路径。
图11根据实际情况制定的可行路径方案。
具体实施方式
实施方式一(空旷无障碍区域场景)。
实施方式一的流程(如图1)包括以下步骤:
步骤S10,首先,运用软件构造局部地图的方法得到智能移动设备所需要移动区域的范围的所有地理信息,通过无线局域网定位技术或者卫星定位、地磁定位等技术得到移动智能设备在所需要移动区域的范围的地理位置信息,将这些地理信息和移动的智能设备的位置信息都上传到智能移动设备(智能手机、平板电脑等)的对应APP当中,接下来在已经得到的区域地图上,进行以移动智能设备的位置为起点进行移动路径的绘画,然后APP会对如下步骤进行绘画路径信息的采集。
S101,地图获取,利用简单测量和照片的形式运用软件进行立体或平面建模得到部分区域的地图信息,将实际场景和地图地理数据信息进行保存。如图2所示。
S102,由上一步得到的所有地图数据信息将其全部存储到手持可通信智能设备方便进行程序调用,将所有数据存入APP对应的智能移动设备数据库当中。并通过无线局域网定位技术或者卫星定位、地磁定位等技术得到移动智能设备在所需要移动区域的范围的实时地理位置信息。
S103,在APP的用户界面当中呈现由S101所获得的地图信息,呈现在屏幕上的即上述区域的室内路径规划与导航地图,用户可以在屏幕上所显示地图进行路径的绘画,APP将会进行路径规划的录入。如果再一次录入绘画路径与从上一次录入的起点相同,APP则会自动推荐上一次使用过的路径,方便用户调用。亦可不使用推荐路径,调用历史存储路径。
步骤S20,根据用户在APP当中所绘画路径进行对移动智能设备坐标的正方向进行方向确定,设定所画路径第一步所指引的方向为正方向,将所有所画路径进行方向和距离的确定,得到准确的路径数据信息;
S201,由S10所获得的绘画路径来确定坐标,如图3所示,定路径起点的方向为正方向,通过旋转将室内路径规划与导航地图的方向与正方向相同,并规定左下角的顶点为原点(0.0)。
S202,规定了正方向和原点坐标后即可对绘画路径进行数据化,从起点到终点进行绘画路径与坐标的数据内的转化:
S2021,在APP中进行室内路径规划与导航地图的缩放,方便用户进行精准的绘画,同时也有效的绕过障碍。
S2022,根据所画的路径进行坐标点的关键点获取,如图4所示,得到关键点进行连线即可得到路径,这样解决可以较少数据的存储,加快处理的速度。
S2023,当遇到弧线路径的时候,为了增加精确度,增加关键点的取样,实现弧线的坐标路径。
S203,由上一步所获得的所有点进行存储,点连成线即可成为路径。
步骤S30,根据上一步所得到的路径数据信息进行实际路径数据信息的转化,设定几个不同的转化比例尺,根据对APP上呈现的区域地理信息的缩放程度选择不同的比例尺进行实际的数据信息转化,得到实际的路径数据信息;
S301,将所得的坐标点位数据根据APP端所呈现的地图图片大小进行和实际场景的比例转化,即坐标点的位置转化。设定比例尺1:100,毫米为单位,在APP上路径所分离出的关键点为(1,1),在转化后的坐标即为(100,100),即以米为单位的坐标(1,1)。
S302,将所有关键点坐标转化后,点连成线,即得到实际路线的路径信息。运用距离公式:式中,(X1,Y1)、(X2,Y2)分别为相邻两点的关键点坐标,便可运算出两点间距离。
步骤S40,根据上一步得到的实际路径信息和移动智能设备的行动参数进行结合(行动参数为转弯半径、设备尺寸等),再和车身传感器结合判断周围情况得到一个完整的实施方案;
步骤S50,APP将会把整体方案的指令信息发送给移动智能设备,移动智能设备会根据自身的传感器来判断周围的情况来执行方案。
实施方式二(实际复杂综合情景)。
实施方式二的流程(如图5)包括以下步骤:
步骤S10,首先,运用软件构造局部地图的方法得到智能移动设备所需要移动区域的范围的所有地理信息,通过无线局域网定位技术或者卫星定位、地磁定位等技术得到移动智能设备在所需要移动区域的范围的地理位置信息,将这些地理信息和被移动的智能设备的位置信息都上传到手持可通信智能设备(智能手机、平板电脑等)的对应APP当中,接下来在已经得到的区域地图上,进行以被移动的智能设备的位置为起点进行移动路径的绘画,然后APP会对如下步骤进行绘画信息的采集。
S101,地图获取,利用简单测量和照片的形式运用软件进行立体或者平面建模得到部分区域的地图信息,将实际场景和地图地理数据信息进行保存。如图6所示。
S102,由上一步得到的所有地图数据信息将其全部存储到手持可通信智能设备方便进行程序调用,将所有数据存入APP的数据库当中。包括区域的俯视图像,和通过无线局域网定位技术或者卫星定位、地磁定位等技术得到的所有物体的坐标数据。设定地图的左下角为地图的零点。如图6所示,这是一个10M*10M的教室局部区域图像,若以cm为单位,则上述区域的俯视图为的坐标大小为1000*1000,精度比较适中。
S103,在APP的用户界面当中呈现由S101所获得的地图信息,呈现在屏幕上的即上述区域的室内路径规划与导航地图,使用者可以在屏幕上所显示地图进行路径的绘画,APP将会进行绘画路径的录入。如图7所示。
由图7所示,在俯视角度的地图中,可以在触摸屏上进行绘画,由S102已经订好的坐标精度,就可以知道绘画路径的坐标信息。如果再一次录入绘画路径与从上一次录入的起点相同,APP则会自动推荐上一次使用过的路径,方便使用者调用。亦可不使用推荐路径,调用历史存储路径。
步骤S20,根据用户在APP当中所绘画路径进行对被移动智能设备坐标的正方向进行方向确定,设定所画路径第一步所指引的方向为正方向,将所有所画路径进行方向和距离的确定,得到准确的路径数据信息;
S201,由S10所获得的绘画路径来确定坐标,定绘画路径起点的方向为正方向。通过旋转将室内路径规划与导航地图的方向与正方向相同,如图8所示。
S202,规定了正方向和原点坐标后即可对所画的路径进行数据化,从起点到终点进行绘画路径与坐标的数据内的转化:
S2021,在APP中进行室内路径规划与导航地图的缩放,方便用户进行精准的绘画,同时也能够有效的绕过障碍。
S2022,根据所画的路径进行坐标点的关键点获取,如图9所示,得到关键点进行连线即可得到路径,这样解决较少数据的存储,加快处理的速度。假设APP上图像呈1:1比例缩放,即APP上俯视图分析率也是1000*1000,则:点1坐标(220,40),点2坐标(240,480),点3坐标(570,500),点4坐标(575,750),点5坐标(750,750),点6坐标(770,970)。
S2023,当遇到弧线路径的时候,为了增加精确度,增加关键点的取样,实现弧线的坐标路径。
S203,由上一步所获得的所有点进行存储,点连成线即可成为路径。
步骤S30,根据上一步所得到的路径数据信息进行实际路径数据信息的转化,设定几个不同的转化比例尺,根据对APP上呈现的区域地理信息的缩放程度选择不同的比例尺进行实际的数据信息转化,得到实际的路径数据信息;如图10所示。
S301,将所得的坐标点位数据根据APP端所呈现的地图图片大小进行和实际场景的比例转化,即坐标点的位置转化。设定比例尺1:100,毫米为单位,在APP上路径所分离出的关键点为(1,1),在转化后的坐标即为(100,100),即以米为单位的坐标(1,1)
S302,将所有关键点坐标转化后,点连成线,计算点与点之间的距离即可。1点(X1,Y1)到2点(X2,Y2),运用距离公式:便可运算出两点间距离,将路径细化,其实就是若干个两点间的直线运动。
步骤S40,根据上一步得到的实际路径信息和所被移动的智能设备的行动参数进行结合(如转弯半径、设备尺寸等),再和车身传感器结合判断周围情况得到以下完整的实施方案;
S401,根据已经掌握的被移动智能设备的物理信息(尺寸、拐弯半径等等),进行路径的调整改动。设备宽度不能满足局部路径下进行移动,则需要将不能满足移动的那段路径进行平移一定距离保证设备的移动。当所画路径穿越物体事物时,这种情况是不可行的,如图11。比如图11中的A桌子,由S10得到的A桌在上述图像中的具体位置坐标,可以对所画路径进行平移,将路径平移到保证安全移动的坐标上。即将ab线段进行远离桌子方向的平移,得到新的a’b’线段,已知坐标a(82,30)b(82,55),而桌子的左边缘在X=80的直线上,所以ab线段至少要向左平移2个单位以上才可保证不与桌子发生碰撞。
S402,为了防止设备在移动过程中由移动障碍物遮挡前进的路线,设定当设备的传感器感应到周围有障碍物的时候,设备停止移动,并反馈给APP,等到障碍物没有之后再移动。亦或者通过智能设备自身添加传感器进行避障移动,避开障碍后再回到原路径。
步骤S50,APP根据上一步得到路径实施方案进行可行性的评估,在控制端结合实际地理信息进行模拟,判断中途是否有不可行的地方,如果存在这样的问题,控制端将会报警反馈给用户,告知用户上述方案不可执行,需要重新绘画,反之,则告知用户上述方案可行;
S501,根据上一步的评估,需要对路径进行模拟,这一步在APP上实现,主要是针对用户所画路径可能有些不能实现,局部所画路径是穿过障碍物,实际它并不能进行穿越,所以遇到这种情况APP会向用户反馈此段路径不合法。
S502,针对这种情况,用平移路径的方法进行回避障碍,或者重新进行路径规划,遇到这种情况时,APP会提示用户进行选择重新绘画或者自动优化功能。
步骤S60,如若通过上一步的评估,APP将会把整体方案的指令信息发送给移动智能设备,移动智能设备会根据自身的传感器来判断周围的情况来执行方案。

Claims (4)

1.一种移动设备的室内路径规划与导航方法,其特征在于:该室内路径规划与导航方法为一种绘画路径规划与实际路径转换实现方法,实现本方法手持可通信智能设备具有显示屏和触摸控制功能;
上述室内路径规划与导航方法包括以下步骤:
步骤1,APP自动获取室内路径规划与导航地图并采集用户的绘画路径信息;
运用软件构造局部地图数据的方法得到智能移动设备活动范围的地理信息,即电子地图文件并存储在手持可通信智能设备当中;上述电子地图文件能够在手持可通信智能设备内置的APP上读取或修改,内置的APP为智能移动设备的地理信息显示、操作处理端;运用上述电子地图文件通过无线局域网定位技术能够定位出智能移动设备在当前区域内的具体位置坐标,如果智能移动设备能够接收到卫星信号并进行地理信息捕捉,那么借助卫星信号获取当前的地理信息坐标数据,亦或者地磁定位技术定位方法;开启手持可通信智能设备的APP,用户在手持可通信智能设备的触摸屏上根据APP在屏幕上显示的室内路径规划与导航地图,以移动智能设备所在的原点为起点,用手指或触屏专用工具在触摸屏上进行本路径的绘画,APP读取绘画路径并进行存储录入;APP录入相同起点的多组路径并进行存储,方便使用者快速调用;
步骤2,APP将绘画路径信息进行路径坐标信息转化;
APP将录入绘画信息进行简化处理,利用输入的相邻地点坐标进行直线连接,对相邻坐标点存在的弯曲线进行精简处理,使得路径呈现为折线;设定绘画路径起点方向为正方向,并确定室内路径规划与导航地图的零点,将精简后的路径转换成数据坐标信息,并进行存储;
步骤3,绘画路径与实际地理信息坐标的转化;
把精简后的绘画路径折线按照APP中放大地图比例和室内路径规划与导航地图与实际的比例尺换算成实际线路的路径的长度大小,设从中获取路径的每端折线交叉点为关键点,记录这些关键点坐标并进行实际数据信息转化;最后APP将实际路径长度与关键点实际坐标结合,得到实际的准确路径信息并存储在APP当中;
步骤4,APP对绘画的路径的进行实际情况合理性的评估;
APP在存储的室内路径规划与导航地图中识别图中存在的障碍物并进行记录,通过实际准确路径信息在实际地理信息相比较的方法里判定上述路径规划的合理性,当规划路径的中途有障碍物遮挡,有部分路径不能通过,或者会影响被智能移动设备正常行驶的情况,则上述的绘画的路径对应方案不可行,APP会提示路径规划无效;若没有以上影响,则可行,APP会提示路径规划成功;如果在一个没有障碍物的局部区域中实现的话,APP自动省去此步骤;
步骤5,APP传输合理路径数据给移动智能设备;
通过局域网的技术,手持可通信智能设备和移动智能设备在相同的局域网内进行互联,即通过APP端能够与移动智能设备进行数据的传输交互,APP将实际的准确路径信息转化成移动智能设备能够识别的命令并传输给它,使得移动智能设备按照命令进行移动,便实现室内路径规划与导航。
2.根据权利要求1所述的一种移动设备的室内路径规划与导航方法,其特征在于:所述局域网的技术为WiFi或蓝牙或移动网络技术。
3.根据权利要求1所述的一种移动设备的室内路径规划与导航方法,其特征在于:步骤S10,首先,运用软件构造局部地图的方法得到智能移动设备所需要移动区域的范围的所有地理信息,通过无线局域网定位技术或者卫星定位、地磁定位技术得到移动智能设备在所需要移动区域的范围的地理位置信息,将这些地理信息和移动的智能设备的位置信息都上传到智能移动设备的对应APP当中,接下来在已经得到的区域地图上,进行以移动智能设备的位置为起点进行移动路径的绘画,然后APP会对如下步骤进行绘画路径信息的采集;
S101,地图获取,利用简单测量和照片的形式运用软件进行立体或平面建模得到部分区域的地图信息,将实际场景和地图地理数据信息进行保存;
S102,由上一步得到的所有地图数据信息将其全部存储到手持可通信智能设备方便进行程序调用,将所有数据存入APP对应的智能移动设备数据库当中;并通过无线局域网定位技术或者卫星定位、地磁定位技术得到移动智能设备在所需要移动区域的范围的实时地理位置信息;
S103,在APP的用户界面当中呈现由S101所获得的地图信息,呈现在屏幕上的即上述区域的室内路径规划与导航地图,使用者在屏幕上所显示地图进行路径的绘画,APP将会进行路径规划的录入;如果再一次录入绘画路径与从上一次录入的起点相同,APP则会自动推荐上一次使用过的路径,方便使用者调用;亦可不使用推荐路径,调用历史存储路径;
步骤S20,根据用户在APP当中所绘画路径进行对移动智能设备坐标的正方向进行方向确定,设定所画路径第一步所指引的方向为正方向,将所有所画路径进行方向和距离的确定,得到准确的路径数据信息;
S201,由S10所获得的绘画路径来确定坐标,定路径起点的方向为正方向,通过旋转将室内路径规划与导航地图的方向与正方向相同,并规定左下角的顶点为原点(0.0);
S202,规定了正方向和原点坐标后即可对所画的路径进行数据化,从起点到终点进行绘画路径与坐标的数据内的转化:
S2021,在APP中进行室内路径规划与导航地图的缩放,方便用户进行精准的绘画,同时也有效的绕过障碍;
S2022,根据所画的路径进行坐标点的关键点获取,得到关键点进行连线即可得到路径,这样解决较少数据的存储,加快处理的速度;
S2023,当遇到弧线路径的时候,为了增加精确度,增加关键点的取样,实现弧线的坐标路径;
S203,由上一步所获得的所有点进行存储,点连成线即可成为路径;
步骤S30,根据上一步所得到的路径数据信息进行实际路径数据信息的转化,设定几个不同的转化比例尺,根据对APP上呈现的区域地理信息的缩放程度选择不同的比例尺进行实际的数据信息转化,得到实际的路径数据信息;
S301,将所得的坐标点位数据根据APP端所呈现的地图图片大小进行和实际场景的比例转化,即坐标点的位置转化;设定比例尺1:100,毫米为单位,在APP上路径所分离出的关键点为(1,1),在转化后的坐标即为(100,100),即以米为单位的坐标(1,1);
S302,将所有关键点坐标转化后,点连成线,即得到实际路线的路径信息;运用距离公式:式中,(X1,Y1)、(X2,Y2)分别为相邻两点的关键点坐标,便可运算出两点间距离;
步骤S40,根据上一步得到的实际路径信息和移动智能设备的行动参数进行结合,再和车身传感器结合判断周围情况得到一个完整的实施方案;
步骤S50,APP将会把整体方案的指令信息发送给移动智能设备,移动智能设备会根据自身的传感器来判断周围的情况来执行方案。
4.根据权利要求1所述的一种移动设备的室内路径规划与导航方法,其特征在于:步骤S10,首先,运用软件构造局部地图的方法得到智能移动设备所需要移动区域的范围的所有地理信息,通过无线局域网定位技术或者卫星定位、地磁定位等技术得到移动智能设备在所需要移动区域的范围的地理位置信息,将这些地理信息和被移动的智能设备的位置信息都上传到手持可通信智能设备的对应APP当中,接下来在已经得到的区域地图上,进行以被移动的智能设备的位置为起点进行移动路径的绘画,然后APP会对如下步骤进行绘画信息的采集;
S101,地图获取,利用简单测量和照片的形式运用软件进行立体或者平面建模得到部分区域的地图信息,将实际场景和地图地理数据信息进行保存;
S102,由上一步得到的所有地图数据信息将其全部存储到手持可通信智能设备方便进行程序调用,将所有数据存入APP的数据库当中;包括区域的俯视图像,和通过无线局域网定位技术或者卫星定位、地磁定位技术得到的所有物体的坐标数据;设定地图的左下角为地图的零点;如图所示,这是一个10M*10M的教室局部区域图像,若以cm为单位,则上述区域的俯视图为的坐标大小为1000*1000,精度比较适中;
S103,在APP的用户界面当中呈现由S101所获得的地图信息,呈现在屏幕上的即上述区域的室内路径规划与导航地图,使用者可以在屏幕上所显示地图进行路径的绘画,APP将会进行绘画路径的录入;
在俯视角度的地图中,在触摸屏上进行绘画,由S102已经订好的坐标精度,就知道绘画路径的坐标信息;如果再一次录入绘画路径与从上一次录入的起点相同,APP则会自动推荐上一次使用过的路径,方便使用者调用;亦可不使用推荐路径,调用历史存储路径;
步骤S20,根据用户在APP当中所绘画路径进行对被移动智能设备坐标的正方向进行方向确定,设定所画路径第一步所指引的方向为正方向,将所有所画路径进行方向和距离的确定,得到准确的路径数据信息;
S201,由S10所获得的绘画路径来确定坐标,定绘画路径起点的方向为正方向;通过旋转将室内路径规划与导航地图的方向与正方向相同;
S202,规定了正方向和原点坐标后即可对所画的路径进行数据化,从起点到终点进行绘画路径与坐标的数据内的转化:
S2021,在APP中进行室内路径规划与导航地图的缩放,方便用户进行精准的绘画,同时也能够有效的绕过障碍;
S2022,根据所画的路径进行坐标点的关键点获取,得到关键点进行连线即可得到路径,这样解决较少数据的存储,加快处理的速度;假设APP上图像呈1:1比例缩放,即APP上俯视图分析率也是1000*1000,则:点1坐标(220,40),点2坐标(240,480),点3坐标(570,500),点4坐标(575,750),点5坐标(750,750),点6坐标(770,970);
S2023,当遇到弧线路径的时候,为了增加精确度,增加关键点的取样,实现弧线的坐标路径;
S203,由上一步所获得的所有点进行存储,点连成线即可成为路径;
步骤S30,根据上一步所得到的路径数据信息进行实际路径数据信息的转化,设定几个不同的转化比例尺,根据对APP上呈现的区域地理信息的缩放程度选择不同的比例尺进行实际的数据信息转化,得到实际的路径数据信息;
S301,将所得的坐标点位数据根据APP端所呈现的地图图片大小进行和实际场景的比例转化,即坐标点的位置转化;设定比例尺1:100,毫米为单位,在APP上路径所分离出的关键点为(1,1),在转化后的坐标即为(100,100),即以米为单位的坐标(1,1);
S302,将所有关键点坐标转化后,点连成线,计算点与点之间的距离即可;1点(X1,Y1)到2点(X2,Y2),运用距离公式:便可运算出两点间距离,将路径细化,其实就是若干个两点间的直线运动;
步骤S40,根据上一步得到的实际路径信息和所被移动的智能设备的行动参数进行结合,再和车身传感器结合判断周围情况得到以下完整的实施方案;
S401,根据已经掌握的被移动智能设备的物理信息,进行路径的调整改动;设备宽度不能满足局部路径下进行移动,则需要将不能满足移动的那段路径进行平移一定距离保证设备的移动;当所画路径穿越物体事物时,这种情况是不可行的;由S10得到的A桌在上述图像中的具体位置坐标,可以对所画路径进行平移,将路径平移到保证安全移动的坐标上;即将ab线段进行远离桌子方向的平移,得到新的a’b’线段,已知坐标a(82,30)b(82,55),而桌子的左边缘在X=80的直线上,所以ab线段至少要向左平移2个单位以上才可保证不与桌子发生碰撞;
S402,为了防止设备在移动过程中由移动障碍物遮挡前进的路线,设定当设备的传感器感应到周围有障碍物的时候,设备停止移动,并反馈给APP,等到障碍物没有之后再移动;亦或者通过智能设备自身添加传感器进行避障移动,避开障碍后再回到原路径;
步骤S50,APP根据上一步得到路径实施方案进行可行性的评估,在控制端结合实际地理信息进行模拟,判断中途是否有不可行的地方,如果存在这样的问题,控制端将会报警反馈给用户,告知用户上述方案不可执行,需要重新绘画,反之,则告知用户上述方案可行;
S501,根据上一步的评估,需要对路径进行模拟,这一步在APP上实现,主要是针对用户所画路径可能有些不能实现,局部所画路径是穿过障碍物,实际它并不能进行穿越,所以遇到这种情况APP会向用户反馈此段路径不合法;
S502,针对这种情况,用平移路径的方法进行回避障碍,或者重新进行绘画路径,遇到这种情况时,APP会提示用户进行选择重新绘画或者自动优化功能;
步骤S60,如若通过上一步的评估,APP将会把整体方案的指令信息发送给移动智能设备,移动智能设备会根据自身的传感器来判断周围的情况来执行方案。
CN201610597435.8A 2016-07-26 2016-07-26 一种移动设备的室内路径规划与导航方法 Active CN106292697B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610597435.8A CN106292697B (zh) 2016-07-26 2016-07-26 一种移动设备的室内路径规划与导航方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610597435.8A CN106292697B (zh) 2016-07-26 2016-07-26 一种移动设备的室内路径规划与导航方法

Publications (2)

Publication Number Publication Date
CN106292697A true CN106292697A (zh) 2017-01-04
CN106292697B CN106292697B (zh) 2019-06-14

Family

ID=57652569

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610597435.8A Active CN106292697B (zh) 2016-07-26 2016-07-26 一种移动设备的室内路径规划与导航方法

Country Status (1)

Country Link
CN (1) CN106292697B (zh)

Cited By (27)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106774338A (zh) * 2017-01-11 2017-05-31 深圳市鑫益嘉科技股份有限公司 一种机器人控制方法及装置
CN106843228A (zh) * 2017-03-23 2017-06-13 汕头大学 基于移动终端划线设定智能小车行走路径的方法及系统
CN106873597A (zh) * 2017-03-24 2017-06-20 上海思岚科技有限公司 通过电脑客户端对移动机器人设置虚拟轨道的实现方法
CN106970637A (zh) * 2017-05-23 2017-07-21 厦门南羽科技有限公司 航线规划方法及装置
CN107063284A (zh) * 2017-04-24 2017-08-18 北京视据科技有限公司 一种基于电子地图的导航路径长度的测量方法及装置
CN107238387A (zh) * 2017-05-03 2017-10-10 广东精讯科技股份有限公司 利用智能手机规划机器人行走路线的方法
CN107329474A (zh) * 2017-07-26 2017-11-07 五邑大学 智能小车控制方法
CN108007470A (zh) * 2017-11-30 2018-05-08 深圳市隐湖科技有限公司 一种移动机器人地图文件格式和路径规划系统及其方法
CN108052102A (zh) * 2017-12-08 2018-05-18 北京奇虎科技有限公司 机器人行进路线的确定方法、装置及机器人
CN108324442A (zh) * 2018-02-07 2018-07-27 成都中友启明科技有限公司 一种轨道路径上的装置的定位系统及定位方法
CN108459598A (zh) * 2017-08-24 2018-08-28 炬大科技有限公司 一种用于处理任务区域的任务的移动电子设备以及方法
CN108459597A (zh) * 2017-07-26 2018-08-28 炬大科技有限公司 一种用于处理任务区域的任务的移动电子设备以及方法
CN108801275A (zh) * 2018-06-11 2018-11-13 杭州晶智能科技有限公司 基于无线网络和地磁信号的室内移动机器人指纹地图建立方法
CN109031372A (zh) * 2018-06-07 2018-12-18 卡斯柯信号有限公司 一种从卫星定位数据中自动提取行驶线路关键点的方法
CN109472995A (zh) * 2017-09-07 2019-03-15 广州极飞科技有限公司 无人飞行器的航区规划方法、装置和遥控器
CN109934908A (zh) * 2019-02-28 2019-06-25 东华大学 一种基于无人机的实际场景建模方法
CN110083152A (zh) * 2019-04-08 2019-08-02 浙江亚特电器有限公司 用于智能割草机的多草坪工作方法
WO2019174053A1 (zh) * 2018-03-16 2019-09-19 深圳市大疆创新科技有限公司 可移动平台及其控制方法
WO2019201188A1 (zh) * 2018-04-15 2019-10-24 张舒怡 机器人的路径规划
CN110506284A (zh) * 2017-03-30 2019-11-26 克朗设备公司 仓库绘制工具
CN111930113A (zh) * 2020-06-30 2020-11-13 创新工场(北京)企业管理股份有限公司 一种为自主导航机器人设置行驶路径的方法与装置
CN112113565A (zh) * 2020-09-22 2020-12-22 温州科技职业学院 一种农业温室环境的机器人定位系统
US11067992B2 (en) 2019-05-24 2021-07-20 Hefei University Of Technology Path planning method and system for self-driving of autonomous system
CN113280835A (zh) * 2021-05-20 2021-08-20 北京智慧图科技有限责任公司 一种基于路径规划的室内定位校正方法
CN113741472A (zh) * 2021-09-10 2021-12-03 上海伯镭智能科技有限公司 一种基于多图像采集的障碍回避方法及装置
CN115167477A (zh) * 2022-08-23 2022-10-11 广东爱吉尔机器人科技有限公司 资源受限的中央集中式动态路径规划方法及电子设备
WO2022267283A1 (zh) * 2021-06-25 2022-12-29 深圳市优必选科技股份有限公司 机器人及其导航方法、装置和计算机可读存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100299013A1 (en) * 2009-05-22 2010-11-25 Toyota Motor Engin. & Manufact. Using topological structure for path planning in semi-structured environments
CN102914316A (zh) * 2012-10-11 2013-02-06 广东欧珀移动通信有限公司 一种移动终端规划路径的方法及系统
CN103791912A (zh) * 2012-10-30 2014-05-14 大陆汽车投资(上海)有限公司 支持手绘路径的导航路径规划装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100299013A1 (en) * 2009-05-22 2010-11-25 Toyota Motor Engin. & Manufact. Using topological structure for path planning in semi-structured environments
CN102914316A (zh) * 2012-10-11 2013-02-06 广东欧珀移动通信有限公司 一种移动终端规划路径的方法及系统
CN103791912A (zh) * 2012-10-30 2014-05-14 大陆汽车投资(上海)有限公司 支持手绘路径的导航路径规划装置

Cited By (37)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106774338A (zh) * 2017-01-11 2017-05-31 深圳市鑫益嘉科技股份有限公司 一种机器人控制方法及装置
CN106843228A (zh) * 2017-03-23 2017-06-13 汕头大学 基于移动终端划线设定智能小车行走路径的方法及系统
CN106843228B (zh) * 2017-03-23 2020-01-03 汕头大学 基于移动终端划线设定智能小车行走路径的方法及系统
CN106873597A (zh) * 2017-03-24 2017-06-20 上海思岚科技有限公司 通过电脑客户端对移动机器人设置虚拟轨道的实现方法
CN110506284B (zh) * 2017-03-30 2023-05-23 克朗设备公司 仓库绘制工具
CN110506284A (zh) * 2017-03-30 2019-11-26 克朗设备公司 仓库绘制工具
CN107063284A (zh) * 2017-04-24 2017-08-18 北京视据科技有限公司 一种基于电子地图的导航路径长度的测量方法及装置
CN107238387A (zh) * 2017-05-03 2017-10-10 广东精讯科技股份有限公司 利用智能手机规划机器人行走路线的方法
CN106970637A (zh) * 2017-05-23 2017-07-21 厦门南羽科技有限公司 航线规划方法及装置
CN107329474A (zh) * 2017-07-26 2017-11-07 五邑大学 智能小车控制方法
CN108459597A (zh) * 2017-07-26 2018-08-28 炬大科技有限公司 一种用于处理任务区域的任务的移动电子设备以及方法
CN108459597B (zh) * 2017-07-26 2024-02-23 炬大科技有限公司 一种用于处理任务区域的任务的移动电子设备以及方法
CN107329474B (zh) * 2017-07-26 2020-05-12 五邑大学 智能小车控制方法
CN108459598A (zh) * 2017-08-24 2018-08-28 炬大科技有限公司 一种用于处理任务区域的任务的移动电子设备以及方法
CN108459598B (zh) * 2017-08-24 2024-02-20 炬大科技有限公司 一种用于处理任务区域的任务的移动电子设备以及方法
CN109472995A (zh) * 2017-09-07 2019-03-15 广州极飞科技有限公司 无人飞行器的航区规划方法、装置和遥控器
CN108007470A (zh) * 2017-11-30 2018-05-08 深圳市隐湖科技有限公司 一种移动机器人地图文件格式和路径规划系统及其方法
CN108052102B (zh) * 2017-12-08 2021-09-28 成都全景智能科技有限公司 机器人行进路线的确定方法、装置及机器人
CN108052102A (zh) * 2017-12-08 2018-05-18 北京奇虎科技有限公司 机器人行进路线的确定方法、装置及机器人
CN108324442A (zh) * 2018-02-07 2018-07-27 成都中友启明科技有限公司 一种轨道路径上的装置的定位系统及定位方法
WO2019174053A1 (zh) * 2018-03-16 2019-09-19 深圳市大疆创新科技有限公司 可移动平台及其控制方法
WO2019201188A1 (zh) * 2018-04-15 2019-10-24 张舒怡 机器人的路径规划
CN109031372B (zh) * 2018-06-07 2021-09-28 卡斯柯信号有限公司 一种从卫星定位数据中自动提取行驶线路关键点的方法
CN109031372A (zh) * 2018-06-07 2018-12-18 卡斯柯信号有限公司 一种从卫星定位数据中自动提取行驶线路关键点的方法
CN108801275B (zh) * 2018-06-11 2021-11-16 西安天图测绘信息技术有限公司 基于无线网络和地磁信号的室内移动机器人指纹地图建立方法
CN108801275A (zh) * 2018-06-11 2018-11-13 杭州晶智能科技有限公司 基于无线网络和地磁信号的室内移动机器人指纹地图建立方法
CN109934908A (zh) * 2019-02-28 2019-06-25 东华大学 一种基于无人机的实际场景建模方法
CN109934908B (zh) * 2019-02-28 2023-06-27 东华大学 一种基于无人机的实际场景建模方法
CN110083152A (zh) * 2019-04-08 2019-08-02 浙江亚特电器有限公司 用于智能割草机的多草坪工作方法
US11067992B2 (en) 2019-05-24 2021-07-20 Hefei University Of Technology Path planning method and system for self-driving of autonomous system
CN111930113A (zh) * 2020-06-30 2020-11-13 创新工场(北京)企业管理股份有限公司 一种为自主导航机器人设置行驶路径的方法与装置
CN112113565A (zh) * 2020-09-22 2020-12-22 温州科技职业学院 一种农业温室环境的机器人定位系统
CN113280835A (zh) * 2021-05-20 2021-08-20 北京智慧图科技有限责任公司 一种基于路径规划的室内定位校正方法
WO2022267283A1 (zh) * 2021-06-25 2022-12-29 深圳市优必选科技股份有限公司 机器人及其导航方法、装置和计算机可读存储介质
CN113741472A (zh) * 2021-09-10 2021-12-03 上海伯镭智能科技有限公司 一种基于多图像采集的障碍回避方法及装置
CN113741472B (zh) * 2021-09-10 2024-03-08 上海伯镭智能科技有限公司 一种基于多图像采集的障碍回避方法及装置
CN115167477A (zh) * 2022-08-23 2022-10-11 广东爱吉尔机器人科技有限公司 资源受限的中央集中式动态路径规划方法及电子设备

Also Published As

Publication number Publication date
CN106292697B (zh) 2019-06-14

Similar Documents

Publication Publication Date Title
CN106292697A (zh) 一种移动设备的室内路径规划与导航方法
CN106774313B (zh) 一种基于多传感器的室外自动避障agv导航方法
US11561317B2 (en) Geographic map updating methods and systems
CN108983781A (zh) 一种无人车目标搜索系统中的环境探测方法
Schindler Vehicle self-localization with high-precision digital maps
JP5927735B2 (ja) 地図データ作成装置、自律移動システムおよび自律移動制御装置
EP3676561B1 (en) Systems and methods to apply markings
CN103984981B (zh) 基于高斯过程模型的建筑物环境传感器测点优化方法
CA3086261A1 (en) Vehicle tracking
WO2012086029A1 (ja) 自律移動システム
CN106931961A (zh) 一种自动导航方法及装置
CN109782756A (zh) 具有自主绕障行走功能的变电站巡检机器人
CN103926925A (zh) 一种基于改进的vfh算法的定位与避障方法及机器人
CN105547305A (zh) 一种基于无线定位和激光地图匹配的位姿解算方法
Colle et al. Mobile robot localization by multiangulation using set inversion
CN104703118A (zh) 一种室内机器人基于蓝牙技术定位移动终端的系统
CN104469677A (zh) 基于智能终端的移动轨迹记录系统及其方法
Zhao et al. Data-driven indoor positioning correction for infrastructure-enabled autonomous driving systems: A lifelong framework
CN103838240A (zh) 控制方法和电子设备
CN109917790A (zh) 一种自主导引车辆及其行驶控制方法和控制装置
CN109668568A (zh) 一种利用环视全景成像进行定位导航的方法
CN109425347A (zh) 一种半潜无人船的同时定位与地图构建方法
Li et al. Hybrid filtering framework based robust localization for industrial vehicles
Lin et al. Fast, robust and accurate posture detection algorithm based on Kalman filter and SSD for AGV
CN107567036A (zh) 基于机器人搜救环境无线自组织局域网的slam系统及方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant