CN106382944B - 一种移动机器人的路线规划方法 - Google Patents

一种移动机器人的路线规划方法 Download PDF

Info

Publication number
CN106382944B
CN106382944B CN201610878367.2A CN201610878367A CN106382944B CN 106382944 B CN106382944 B CN 106382944B CN 201610878367 A CN201610878367 A CN 201610878367A CN 106382944 B CN106382944 B CN 106382944B
Authority
CN
China
Prior art keywords
line segment
route
robot
node
feasible
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
CN201610878367.2A
Other languages
English (en)
Other versions
CN106382944A (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.)
Zhejiang Guozi Robot Technology Co Ltd
Original Assignee
Zhejiang Guozi Robot Technology 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 Zhejiang Guozi Robot Technology Co Ltd filed Critical Zhejiang Guozi Robot Technology Co Ltd
Priority to CN201610878367.2A priority Critical patent/CN106382944B/zh
Publication of CN106382944A publication Critical patent/CN106382944A/zh
Application granted granted Critical
Publication of CN106382944B publication Critical patent/CN106382944B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3407Route searching; Route guidance specially adapted for specific applications
    • G01C21/3415Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
    • 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/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface

Abstract

本发明提供一种移动机器人的路线规划方法,包括如下步骤:步骤一,根据机器人的移动目标和地图上的节点属性搜索可行路线;步骤二,根据所有可行路线中线段的权重值确定最优路线,线段为由多个控制点的贝塞尔曲线或者样条曲线构成的任意曲线;步骤三,驱动机器人沿着最优路线移动,并在停靠点停止。本发明的移动机器人的路线规划方法,通过增加节点的旋转属性,大幅增加节点之间的联通方式,避免了两个节点之间只有一种单一连接方式;通过增加线段的权重属性,可根据线段的长度快速确定最短路径,且可根据需要,只需调节线段权重值即可调整机器人的移动路径,操作简单;能够使机器人停靠在线段的任意位置,而无需增加节点从而影响地图路段配置。

Description

一种移动机器人的路线规划方法
技术领域
本发明涉及移动机器人领域,特别涉及一种移动机器人的路线规划方法。
背景技术
现在的移动机器人大都是基于现有的地图基础上进行路径规划,配置相应的路线,配合基于该地图的定位系统,使移动机器人可以沿着对应路线移动并最终停靠在指定路线上的目标点位置。
路线均是由节点和线组成,任意两个节点相连可以构成一条线,多条线相连便组成图,目前大多移动机器人均是在图中的一个点搜索出一条路径到达图中的另一个点。但是这种路线规划使得机器人的停靠点需要设置在节点处,不够灵活。
发明内容
为了解决上述问题,本发明提供一种移动机器人的路线规划方法,包括如下步骤:
步骤一,根据机器人的移动目标和地图上的节点属性搜索可行路线;
步骤二,根据所有可行路线中线段的权重值确定最优路线,线段为由多个控制点的贝塞尔曲线或者样条曲线构成的任意曲线;
步骤三,驱动机器人沿着最优路线移动,并在停靠点停止。
进一步地,在步骤一中,节点属性包括可旋转属性和不可旋转属性,机器人能够在可旋转属性的节点原地旋转,从而切换线段并搜索可行路线。
进一步地,在步骤二中,线段的权重值等于线段长度值,采用线段长度值最短的可行路径为最优路线。
进一步地,在步骤二中,线段的权重值可以通过人工输入来确定,采用线段的权重值最小的可行路线作为最优路线。
进一步地,在步骤三中,通过线段上的相对位置来确定停靠点,从而使机器人可以在线段的任意位置停靠。
本发明的有益效果如下:
1、本发明的移动机器人的路线规划配置的方法,通过增加节点的旋转属性,大幅增加节点之间的联通方式,避免了两个节点之间只有一种单一连接方式。
2、移动机器人的路线规划配置的方法,通过增加线段的权重属性,可根据线段的长度快速确定最短路径,且可根据需要,只需调节线段权重值即可调整机器人的移动路径,操作简单。
3、移动机器人的路线规划配置的方法,能够使机器人停靠在线段的任意位置,而无需增加节点从而影响地图路段配置。
附图说明
图1是本发明的一种搜索可行路线的贝塞尔曲线的矢量图;
图2是本发明的一种确定最优路线的贝塞尔曲线的矢量图;
图3是本发明的未配置停靠点的初始路线示意图;
图4是本发明的节点作为停靠点的路线示意图;
图5是本发明的停靠点设置在线段的任意位置示意图。
具体实施方式
下面结合附图和具体实施例对本发明做进一步详细说明。
如图1-5所示,本发明公开了一种移动机器人的路线规划方法,包括如下步骤:
步骤一,根据机器人的移动目标和地图上的节点属性搜索可行路线;
步骤二,根据所有可行路线中线段的权重值确定最优路线,线段为由多个控制点的贝塞尔曲线或者样条曲线构成的任意曲线;
步骤三,驱动机器人沿着最优路线移动,并在停靠点停止。
在步骤一中,节点属性包括可旋转属性和不可旋转属性,机器人能够在可旋转属性的节点原地旋转,从而切换线段并搜索可行路线。
在节点处相邻的线段如果夹角超过一定角度(可配置),如果该节点处没有配置允许旋转属性则认为此线段不相连,在路径搜索中不会连接此线段,反之,如果配置了允许旋转,则将此线段联通,在移动机器人运动到该节点处以原地旋转的形式切换线段。
如图1所示,在一个实施例中,当节点2没有配置允许原地旋转属性,由于线段(1,2)和线段(2,4)在节点2处有角度突变,在路径搜索时则认为线段(1,2)和线段(2,4)不连通,实际搜索出来的路线为(1,2)->(2,3)->(3,4)而不是最短的路径(1,2)->(2,4)。在一个实施例中,当节点2配置了允许原地旋转的属性,则搜索出来的路径则为最短的路径(1,2)->(2,4)。
在一个实施例中,线段带有配置权重的属性,在步骤二中,线段的权重值等于线段长度值,采用线段长度值最短的可行路径为最优路线。线段的权重值可以通过人工输入来确定,采用线段的权重值最小的可行路线作为最优路线。
权重值默认等于线段长度但修改权重不会影响线段长度,默认的路线搜索为最短路径搜索,但针对某些同时满足路径条件的路线,需要机器人走较长的那段路线,此时可以通过修改对应路线的权重达到目的。
在一个实施例中,各个线段的默认权重值为线段长度,如图2所示,当机器人需要的路线规划为(1,2)->(2,3)->(3,4)而不是最短的(1,2)->(2,4),则此时可以修改路线权重来达到目的。例如将线段(2,4)的权重改为10,或者将线段(2,3)和线段(3,4)的权重和改为小于7均可以是最终搜出的路线为(1,2)->(2,3)->(3,4)。
在步骤三中,通过线段上的相对位置来确定停靠点,从而使机器人可以在线段的任意位置停靠。
如图3-图4所示,目前大多数移动机器人的停靠目标点均是在路线的节点上,如果在某一段线路上需要很密集的设置很多个停靠目标点,此时需要设置很多个路线节点,另外,在已有路线上增加停靠点,则需要增加对应节点,这样就变更了整体的地图路线。
如图5所示,因此本发明的一个实施例中,将停靠点以在某线段上的相对位置(对应条线段上,距离线段起点距离占该线段总距离的百分比)来表示线段上的任意一个点,这样,停靠点的设置则无需变更原有地图路线,还可以方便的变更停靠点位置而不影响原有路线,同时,停靠点的增删改操作均不会影响其他停靠点的路径搜索(其他停靠点搜出的路径不变)。
以上所述,并不用以限制发明,凡是依据本发明的技术实质对以上实施例所作的任何细微修改、等同替换和改进,均应包含在本发明技术方案的保护范围之内。

Claims (3)

1.一种移动机器人的路线规划方法,其特征在于,包括如下步骤:
步骤一,根据机器人的移动目标和地图上的节点属性搜索可行路线,所述节点属性包括可旋转属性和不可旋转属性,并可在每个节点处设置临界角度,当相邻的线段夹角超过临界角度且此节点处设置为不可旋转属性,则机器人在路径搜索中不会连接此线段,当相邻的线段夹角超过临界角度且此节点处设置为可旋转属性,则将此线段联通,机器人运动到此节点处以原地旋转的形式切换线段并搜索可行路线;
步骤二,根据所有可行路线中线段的权重值确定最优路线,所述线段为由多个控制点的贝塞尔曲线或者样条曲线构成的任意曲线;
步骤三,驱动机器人沿着最优路线移动,并在停靠点停止;通过线段上的相对位置来确定所述停靠点,从而使机器人可以在线段的任意位置停靠。
2.如权利要求1所述的移动机器人的路线规划方法,其特征在于,在所述步骤二中,线段的权重值等于线段长度值,采用线段长度值最短的可行路径为最优路线。
3.如权利要求1所述的移动机器人的路线规划方法,其特征在于,在所述步骤二中,线段的权重值可以通过人工输入来确定,采用线段的权重值最小的可行路线作为最优路线。
CN201610878367.2A 2016-10-08 2016-10-08 一种移动机器人的路线规划方法 Active CN106382944B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610878367.2A CN106382944B (zh) 2016-10-08 2016-10-08 一种移动机器人的路线规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610878367.2A CN106382944B (zh) 2016-10-08 2016-10-08 一种移动机器人的路线规划方法

Publications (2)

Publication Number Publication Date
CN106382944A CN106382944A (zh) 2017-02-08
CN106382944B true CN106382944B (zh) 2019-11-01

Family

ID=57936191

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610878367.2A Active CN106382944B (zh) 2016-10-08 2016-10-08 一种移动机器人的路线规划方法

Country Status (1)

Country Link
CN (1) CN106382944B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10310512B2 (en) 2016-10-08 2019-06-04 Zhejiang Guozi Robot Technology Co., Ltd. Path planning method for mobile robots
CN107168305B (zh) * 2017-04-01 2020-03-17 西安交通大学 路口场景下基于Bezier和VFH的无人车轨迹规划方法
CN107677285B (zh) 2017-04-11 2019-05-28 平安科技(深圳)有限公司 机器人的路径规划系统及方法
CN108801287B (zh) * 2017-05-03 2021-08-13 腾讯科技(深圳)有限公司 一种导航地图中引导线的显示方法和移动终端
CN108000501B (zh) * 2017-11-22 2020-08-07 湖北工业大学 一种用于串联机器人的新型轨迹规划方法
CN108568817B (zh) * 2018-03-13 2021-05-11 同济大学 一种基于贝塞尔曲线的Delta机器人轨迹连接控制方法
CN110244711A (zh) * 2019-05-16 2019-09-17 芜湖智久机器人有限公司 机器人路径规划系统及方法、计算机可读存储介质、装置
CN112612273B (zh) * 2020-12-21 2021-08-24 南方电网电力科技股份有限公司 一种巡检机器人避障路径规划方法、系统、设备和介质
CN112817310A (zh) * 2020-12-30 2021-05-18 广东电网有限责任公司电力科学研究院 一种变电站巡检策略的制定方法及装置
CN113467498B (zh) * 2021-07-14 2022-07-01 西北工业大学 一种基于Bezier-凸优化的运载火箭上升段轨迹规划方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102207736A (zh) * 2010-03-31 2011-10-05 中国科学院自动化研究所 基于贝塞尔曲线的机器人路径规划方法及装置
CN102759362A (zh) * 2011-04-29 2012-10-31 昆达电脑科技(昆山)有限公司 导航系统及其路径规划方法
CN103268729A (zh) * 2013-05-22 2013-08-28 北京工业大学 基于混合特征的移动机器人级联式地图创建方法
CN103674015A (zh) * 2013-12-13 2014-03-26 国家电网公司 一种无轨化定位导航方法及装置
WO2015004855A1 (ja) * 2013-07-11 2015-01-15 ヤマハ発動機株式会社 ナビゲーション装置、シミュレーション装置、移動装置およびナビゲーション方法
CN105487535A (zh) * 2014-10-09 2016-04-13 东北大学 一种基于ros的移动机器人室内环境探索系统与控制方法
CN105698807A (zh) * 2016-02-01 2016-06-22 郑州金惠计算机系统工程有限公司 一种适用于变电站智能巡检机器人的激光导航系统
CN106094834A (zh) * 2016-07-19 2016-11-09 芜湖哈特机器人产业技术研究院有限公司 基于已知环境下的移动机器人路径规划方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5871486B2 (ja) * 2011-06-01 2016-03-01 株式会社ソニー・コンピュータエンタテインメント 最短経路探索プログラム、最短経路探索プログラムを記憶したコンピュータ読み取り可能な記録媒体、最短経路探索装置、最短経路探索方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102207736A (zh) * 2010-03-31 2011-10-05 中国科学院自动化研究所 基于贝塞尔曲线的机器人路径规划方法及装置
CN102759362A (zh) * 2011-04-29 2012-10-31 昆达电脑科技(昆山)有限公司 导航系统及其路径规划方法
CN103268729A (zh) * 2013-05-22 2013-08-28 北京工业大学 基于混合特征的移动机器人级联式地图创建方法
WO2015004855A1 (ja) * 2013-07-11 2015-01-15 ヤマハ発動機株式会社 ナビゲーション装置、シミュレーション装置、移動装置およびナビゲーション方法
CN103674015A (zh) * 2013-12-13 2014-03-26 国家电网公司 一种无轨化定位导航方法及装置
CN105487535A (zh) * 2014-10-09 2016-04-13 东北大学 一种基于ros的移动机器人室内环境探索系统与控制方法
CN105698807A (zh) * 2016-02-01 2016-06-22 郑州金惠计算机系统工程有限公司 一种适用于变电站智能巡检机器人的激光导航系统
CN106094834A (zh) * 2016-07-19 2016-11-09 芜湖哈特机器人产业技术研究院有限公司 基于已知环境下的移动机器人路径规划方法

Also Published As

Publication number Publication date
CN106382944A (zh) 2017-02-08

Similar Documents

Publication Publication Date Title
CN106382944B (zh) 一种移动机器人的路线规划方法
US10310512B2 (en) Path planning method for mobile robots
US10576984B2 (en) Second stop position for intersection turn
TWI687111B (zh) 用於無人機的wwan無線電鏈路品質導航
US9902317B1 (en) System and method for controlling mobile warning triangle
US8060295B2 (en) Automated separation manager
KR101196374B1 (ko) 이동 로봇의 경로 생성 시스템
CN103970143B (zh) 一种无人飞行器自主巡点飞行的智能优化方法
CN106716872B (zh) 飞行器及其控制方法、装置和电子设备
CN103743407A (zh) 一种导航方法及装置
CN104197947A (zh) 一种路线推荐方法及系统
WO2022000222A1 (zh) 信息处理方法、无人机、服务器及存储介质
Huskić et al. GeRoNa: generic robot navigation: a modular framework for robot navigation and control
CN106003027A (zh) 机械臂运动路径的设置方法和系统
CN107295595A (zh) 用于在停车场管理系统与机动车之间进行通信的方法和设备
JP2016057660A (ja) 移動体の経路計画方法と装置
CN113498498B (zh) 行动控制设备和行动控制方法、以及程序
Zhou et al. Enhanced ant colony optimization algorithm for global path planning of mobile robots
ES2646267T3 (es) Planificación de rutas
CN103837148A (zh) 一种导航地图的切换方法、装置及一种电子设备
KR20140089240A (ko) 군집지능로봇의 전파맵 기반 위치 제어 장치 및 방법
CN103572967A (zh) 一种臂架控制设备、系统、方法和工程机械
JP6399436B2 (ja) 移動体の経路計画方法と装置
CN105466442A (zh) 模糊起点预设路线导航方法
EP3172945A1 (en) Lighting control system for routing of messages between a number of lighting nodes forming a wireless multi-node network and method therefor

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