CN107765683A - 移动式机器人的即时导航方法 - Google Patents
移动式机器人的即时导航方法 Download PDFInfo
- Publication number
- CN107765683A CN107765683A CN201610741473.6A CN201610741473A CN107765683A CN 107765683 A CN107765683 A CN 107765683A CN 201610741473 A CN201610741473 A CN 201610741473A CN 107765683 A CN107765683 A CN 107765683A
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- barrier
- moving direction
- navigation aid
- air navigation
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title abstract description 9
- 230000004888 barrier function Effects 0.000 claims abstract description 87
- 238000004891 communication Methods 0.000 claims abstract description 10
- 238000001514 detection method Methods 0.000 claims abstract description 7
- 230000003321 amplification Effects 0.000 claims description 9
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 9
- FGUUSXIOTUKUDN-IBGZPJMESA-N C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 Chemical compound C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 FGUUSXIOTUKUDN-IBGZPJMESA-N 0.000 claims description 6
- 230000005059 dormancy Effects 0.000 claims description 6
- GNFTZDOKVXKIBK-UHFFFAOYSA-N 3-(2-methoxyethoxy)benzohydrazide Chemical compound COCCOC1=CC=CC(C(=O)NN)=C1 GNFTZDOKVXKIBK-UHFFFAOYSA-N 0.000 claims description 4
- 238000010408 sweeping Methods 0.000 claims 1
- 238000005516 engineering process Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- YBJHBAHKTGYVGT-ZKWXMUAHSA-N (+)-Biotin Chemical compound N1C(=O)N[C@@H]2[C@H](CCCCC(=O)O)SC[C@@H]21 YBJHBAHKTGYVGT-ZKWXMUAHSA-N 0.000 description 4
- 238000004590 computer program Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000005070 sampling Methods 0.000 description 4
- FEPMHVLSLDOMQC-UHFFFAOYSA-N virginiamycin-S1 Natural products CC1OC(=O)C(C=2C=CC=CC=2)NC(=O)C2CC(=O)CCN2C(=O)C(CC=2C=CC=CC=2)N(C)C(=O)C2CCCN2C(=O)C(CC)NC(=O)C1NC(=O)C1=NC=CC=C1O FEPMHVLSLDOMQC-UHFFFAOYSA-N 0.000 description 4
- 238000000465 moulding Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000008520 organization Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000007717 exclusion Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000000873 masking effect Effects 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Optics & Photonics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种移动式机器人的即时导航方法,包括:移动式机器人取得目标位置;经由超宽频通讯模块自外部信标装置接收定位信号并计算当前位置;依据目标位置及当前位置计算移动方向;于经由移动式机器人的激光感测模块检测到障碍物时,校正移动方向,并依据校正后的移动方向移动以避开障碍物;及,重复执行上述检测、校正及移动,直到抵达目标位置。本发明经由主动检测障碍物,可有效避免移动式机器人误入无定位信号区域,而导航失败。
Description
技术领域
本发明是与移动式机器人有关,特别有关于移动式机器人的即时导航方法。
背景技术
不同于采用全球定位系统(Global Positioning System,GPS)的户外定位技术,由于在室内空间(如建筑物内)中无法准确接收GPS信号,因此无法采用相同的技术于室内进行定位。
为解决上述问题,目前已有一种室内定位技术被提出。前述室内定位技术是使用多个定位信标(beacon)来发射不同的定位信号。具体而言,多个定位信标是超宽频(Ultra-Wideband,UWB)信号发射器,分别被安装于建筑物的不同位置,并分别被设定为发出对应所安装位置的超宽频定位信号。藉此,使用者可使用室内导航装置来自多个定位信标取得定位信号,以进行室内定位。
另,目前已有一种可自动进行室内导航的移动式机器人被提出。所述移动式机器人于收到目标位置后,可依据上述定位信号规划导航路线,并依据所规划的导航路线自动移动至目标位置。
虽上述移动式机器人可自动移动至目标位置,然而,由于超宽频通讯的限制,前述定位信号与实际位置间可能存在误差。上述存在误差的定位信号将导致移动式机器人规划出错误的导航路线,而无法精准地移动至目标位置,或误入禁止区域(如管制区域或无定位信号区域)。
图1为现有的移动式机器人的自动导航示意图,用以示例性说明前段所述状况。如图1所示,目标位置10的座标为(Xt,Yt),移动式机器人12位于多个货架140-148间的主要走道,且其实际座标为(X1,Y1)。因此,若移动式机器人12朝移动方向V1移动时,可顺利抵达目标位置(Xt,Yt)。
由于定位信号存在误差,移动式机器人12可能误认其所在座标为(X2,Y2),并规划出错误的移动方向V2。当朝错误的移动方向V2移动后,移动式机器人12将从实际座标(X1,Y1)移动至错误位置(座标为(X3,Y3))。
当移动式机器人12处于错误位置时,由于定位信号被货架146、148遮蔽,移动式机器人12将因无法收到定位信号而无法再次规划导航路线,这使得移动式机器人12无法自货架146、148间脱困而导致导航失败。
发明内容
本发明提供一种移动式机器人的即时导航方法,可主动检测障碍物位置并即时修正移动方向。
为了实现上述目的,本发明提供了一种移动式机器人的即时导航方法,其特征在于,包括步骤:
a)于一移动式机器人取得一目标位置;
b)依据经由一超宽频通讯模块接收的一定位信号决定该移动式机器人的一当前位置;
c)依据该目标位置及该当前位置计算一移动方向;
d)于经由一激光感测模块检测到一障碍物时校正该移动方向,并控制该移动式机器人朝校正后的该移动方向移动;及
e)重复执行该步骤b至该步骤d直到该移动式机器人抵达该目标位置。
优选地,该步骤d包括一步骤d1:于检测该障碍物的数量小于一障碍阀值时,依据该障碍物于该激光感测模块的一扫描范围中所占比例校正该移动方向。
优选地,该步骤d1是于检测该障碍物位于该扫描范围的边缘且该障碍物的数量小于2时,依据该障碍物于该扫描范围中所占比例校正该移动方向。
优选地,该步骤d1是依据该障碍物于该扫描范围中的一角度比例及一放大因子校正该移动方向,该放大因子是对应该移动式机器人所在的一走道宽度。
优选地,该步骤d包括一步骤d2:于检测到该障碍物的数量不小于一障碍阀值时,识别前方不存在该障碍物的一无障碍方向,并以该无障碍方向作为新的该移动方向。
优选地,该步骤d还包括一步骤d3:于该激光感测模块的一扫描范围中无法识别该无障碍方向时,控制该移动式机器人停止移动。
优选地,还包括一步骤f:于经由一近距离感测模块检测到该障碍物时,控制该移动式机器人停止移动。
优选地,于该步骤f后包括一步骤g:于该移动式机器人停止移动时,发出一警示讯息。
优选地,于该步骤g后包括一步骤h:于发出该警示讯息达一警示时间且仍然经由该近距离感测器检测到该障碍物时,控制该移动式机器人倒退。
优选地,于该步骤f后包括下列步骤:
i)于停止移动达一停止时间且经由该近距离感测器检测到该障碍物时,控制该移动式机器人进入一休眠模式;及
j)于进入该休眠模式达一休眠时间时,重新于该扫描范围中识别该无障碍方向。
本发明经由主动检测障碍物,可有效避免移动式机器人误入无定位信号区域,而无法自动导航至目标位置。
附图说明
图1为现有的移动式机器人的自动导航示意图。
图2为本发明第一实施例的移动式机器人的架构图。
图3为本发明第一实施例的移动式机器人的即时导航方法的流程图。
图4为本发明第二实施例的移动式机器人的即时导航方法的流程图。
图5为本发明的校正模式示意图。
图6为本发明的避障模式示意图。
图7为本发明第三实施例的移动式机器人的即时导航方法的部分流程图。
图8为本发明的移动式机器人的即时导航示意图。
图9为本发明第四实施例的移动式机器人的即时导航方法的部分流程图。
其中,附图标记:
10…目标位置 12、2…移动式机器人
200…超宽频通讯模块 202…激光感测模块
204…人机界面 206…驱动模块
208…近距离感测模块
210…记忆模块
2100…电脑程序
212…控制模块
214…电池模块
3…外部信标装置
4…目标位置
140-148、50-60…货架
62-70…人员
V1、V2…移动方向
δ、δ1、δ2、δ3、δ4、δ5…移动方向
α、α1…角度
S10-S22…第一即时导航步骤
S30-S48…第二即时导航步骤
S10-S22…第一即时导航步骤
S50-S58…近距离障碍物回避步骤
S70-S76…等待障碍物排除步骤
具体实施方式
兹就本发明的一较佳实施例,配合附图,详细说明如后。
请参阅图2,为本发明第一实施例的移动式机器人的架构图。本发明公开了一种移动式机器人的即时导航方法(下称即时导航方法),应用于如图2所示的移动式机器人2。本发明中,移动式机器人2包括超宽频通讯模块200、激光感测模块202、人机界面204、驱动模块206、近距离感测模块208、记忆模块210及电性连接上述元件的控制模块212。
超宽频(Ultra-Wideband,UWB)通讯模块200用以收发超宽频信号(如6.5GHz射频信号)。较佳地,超宽频通讯模块200是超音波收发器,并可自多个外部信标装置3接收以超音波传输的定位信号。
具体而言,多个外部信标装置3是分别被安装于特定区域(如建筑物内)的不同位置,并分别被设定为发出不同的定位信号。较佳地,使用者可预先将上述特定区域座标化,以将各外部信标装置3所在位置对应至一组虚拟的座标。接着,使用者可对多个外部信标装置3分别进行设定,以使各外部信标装置3所发送的定位信号包括其所对应的座标。
激光感测模块202用以检测障碍物。具体而言,激光感测模块202可依据是否收到反射光来判断扫描范围内是否有障碍物。更进一步地,激光感测模块202还可依据发射的激光与反射光的时间差来计算障碍物的距离。
较佳地,激光感测模块202包括用以发射激光的激光模块及稜镜模块(图未标示),使用者可经由控制稜镜模块的多个稜镜旋转方式来调整激光感测模块202的扫描维度。
举例来说,当激光感测模块202控制所有稜镜皆水平旋转或垂直旋转时,可转换点光源的激光为二维激光,并对外部环境进行平面扫描;当激光感测模块202控制部分稜镜水平旋转且部分稜镜垂直旋转时,可转换点光源的激光为三维激光,并对外部环境进行立体扫描。
较佳地,使用者可经由调整移动式机器人2的壳体(图未标示)的覆盖范围(即不透光范围),来调整激光感测模块202的扫描范围。
举例来说,若激光感测模块202的扫描范围为360度,当壳体的覆盖范围为240度(即仅有120度可透光)时,可调整激光感测模块202的扫描范围为120度。
较佳地,使用者可经由调整激光感测模块202的取样角度,来调整激光感测模块202的扫描精确度。具体而言,激光感测模块202包括角度编码器(图未标示)。使用者可经由角度编码器设定取样角度(如每5度取样或每10度取样),来调整扫描精确度。
人机界面204(如键盘、触控荧幕、显示器、扬声器或上述装置的任意组合)用以接受输入或输出信息。驱动模块206用以控制移动式机器人2移动。
近距离感测模块208(如距离感测器(proximity sensor)或光感测器)用以检测近距离(如1公尺内)的障碍物。记忆模块210用以储存资料。
值得一提的是,激光感测模块202的扫描范围是明显小于超宽频通讯模块200的传输范围,并明显大于近距离感测模块208的感测范围。
控制模块212用以控制移动式机器人2。较佳地,控制模块212可控制移动式机器人2自动导航至目标位置(容后详述)。
较佳地,控制模块212还可经由人机界面204(以触控面板为例)与使用者互动,以提供服务或信息。
以提供商品的陈列位置导引服务为例,当使用者经由人机界面204选择特定商品后,控制模块212可自动取得特定商品的陈列位置,并做为目标位置。接着,控制模块212控制移动式机器人2自动导航至目标位置。并且,于导航过程中,控制模块212可经由人机界面204播放相关介绍信息(如卖场信息或特定商品信息)。藉此,移动式机器人2可取代服务人员引导使用者至特定商品的陈列位置。
以线上客服为例,使用者可经由操作移动式机器人2的人机界面204来与远端的客服人员取得联系,以获得所需信息。
较佳地,移动式机器人2还包括电池模块214。电池模块214电性连接控制模块212,用以提供移动式机器人2运作所需电力。记忆模块210可进一步储存一组充电位置(如充电座的座标)。控制模块212于检测电池模块214剩余电力过低时,可由记忆模块210取得充电位置并作为目标位置,并控制移动式机器人2自动导航至目标位置,以自动进行充电。并且,于充电期间,移动式机器人2仍可持续提供部分服务(如商品查询或线上客服)。藉此,本发明可有效避免移动式机器人2因电力不足而停止提供服务。
本发明各实施例的即时导航方法可采用硬体方式(如使用半导体技术、电子电路技术或数字电路技术)、软件方式(如使用固件或应用程序的方式)或软硬件混合方式来加以实现。
较佳地,记忆模块210可进一步储存电脑程序2100。电脑程序2100包括电脑可执行的程序码。当控制模块212执行电脑程序2100后,可控制移动式机器人2来执行本发明各实施例的即时导航方法的各步骤。
续请参阅图3,为本发明第一实施例的移动式机器人的即时导航方法的流程图。本实施例的即时导航方法包括以下步骤。
步骤S10:控制模块212取得目标位置。较佳地,控制模块212可经由人机界面204接受使用者操作,以设定目标位置,或经由网络(如Wi-Fi网络或蓝牙网络)自外部的使用者电子装置接收目标位置。
步骤S12:控制模块212经由超宽频通讯模块200接收定位信号,并依据所接收的定位信号决定当前位置。较佳地,控制模块212是分别自三个以上外部信标装置3接收三个以上定位信号,并依据三个以上定位信号使用三点定位方式来决定当前位置(如计算当前位置的座标)。
步骤S14:控制模块212判断是否抵达目标位置。较佳地,控制模块212是于当前位置与目标位置相符时,判断抵达目标位置。
若控制模块212判断未抵达目标位置,则执行步骤S16。否则,结束即时导航方法。
步骤S16:控制模块212依据当前位置及目标位置决定移动方向。较佳地,控制模块212计算当前位置及目标位置间的方位角,并作为移动方向。
步骤S18:控制模块212判断是否经由激光感测模块202检测到至少一障碍物。若检测到障碍物,则控制模块212执行步骤S20。否则,执行步骤S22。
步骤S20:控制模块212校正移动方向。较佳地,控制模块212可依据障碍物的数量、大小或位置来校正移动方向(如增加、减少或重新决定方位角),以使校正后的移动方向可避开障碍物。
步骤S22:控制模块212依据(校正后或未校正的)移动方向经由驱动模块206控制移动式机器人2朝移动方向移动。接着,控制模块212再次执行步骤S12以再次进行导航。
本发明经由主动检测障碍物,可有效避免移动式机器人误入无定位信号区域,而无法自动导航至目标位置。
续请参阅图4,为本发明第二实施例的移动式机器人的即时导航方法的流程图。本实施例的即时导航方法包括以下步骤。
步骤S30:控制模块212取得目标位置。
步骤S32:控制模块212自外部接收定位信号,并决定当前位置。
步骤S34:控制模块212判断是否抵达目标位置。
若控制模块212判断未抵达目标位置,则执行步骤S36。否则,结束即时导航方法。
步骤S36:控制模块212决定移动方向。
步骤S38:控制模块212经由激光感测模块202检测障碍物的数量,并判断障碍物的数量是否小于预设的障碍阀值(如2)。
若控制模块212判断障碍物的数量小于预设的障碍阀值,则执行步骤S40并进入校正模式。否则,执行步骤S44并进入避障模式。
较佳地,控制模块212还可进一步检测障碍物是否位于激光感测模块202的扫描范围的边缘,并于检测障碍物位于扫描范围的边缘且障碍物的数量小于障碍阀值时才执行步骤S40。否则,执行步骤S44。
步骤S40:控制模块212进入校正模式,并依据该障碍物于激光感测模块202的扫描范围中所占比例校正移动方向。
较佳地,于校正模式下,控制模块212可依据障碍物于激光感测模块的扫描范围中的角度比例及放大因子S校正移动方向,其中放大因子S是对应移动式机器人2所在的走道宽度。
具体而言,控制模块212是使用下述式1来校正移动方向。
其中,δ’为校正后的移动方向;δ为校正前的移动方向;S为放大因子;α为扫描范围(即最大有效扫描角度);α1为障碍物于扫描范围中所占角度。
值得一提的是,虽于本实施例中是依据放大因子S来计算校正后的移动方向δ’,但不应以此为限。于本发明的另一实施例中,亦可不依据放大因子S来计算校正后的移动方向δ’,而仅依据扫描范围中的角度比例进行校正。
步骤S42:控制模块212依据移动方向控制移动式机器人2移动。
若于步骤S38中,控制模块212判断障碍物的数量不小于障碍阀值,则执行步骤S44:控制模块212于避障模式下经由激光感测模块202判断是否可识别前方不存在障碍物的无障碍方向。
具体而言,控制模块212可经由激光感测模块202取得各障碍物的所在角度,并判断各障碍物间的间隙是否够大,而可允许移动式机器人2通过(如间隙大于10度)。若判断任一间隙可允许移动式机器人2通过,则将上述间隙所对应方向设定为无障碍方向。
若控制模块212可识别任一无障碍方向,则执行步骤S46。否则,执行步骤S48。
步骤S46:控制模块212将所识别的无障碍方向作为新的移动方向。接着,控制模块212执行步骤S42,以控制移动式机器人2朝新的移动方向前进。
若于步骤S44中,控制模块21无法识别任一无障碍方向,则执行步骤S48:控制模块21控制移动式机器人2停止移动。
较佳地,控制模块21可于移动式机器人2停止移动后,进一步经由人机界面204发出警示讯息,以通知使用者。
较佳地,控制模块21可于移动式机器人2停止移动后,进一步控制移动式机器人2倒退,以藉由远离障碍物来增加成功识别无障碍方向的机率。
较佳地,控制模块21可于移动式机器人2停止移动后,进入休眠模式一段时间,以等待障碍物被排除。
本发明经由选择性切换校正模式及避障模式,可有效于障碍物的数量较少时校正移动方向,来避免因定位信号的误差而导航失败,并可有效于障碍物的数量较多时积极地回避障碍物,来避免碰撞障碍物。
续请参阅图5,为本发明的校正模式示意图,用以示例性说明本发明的校正模式。如图所示,目标位置4的座标为(Xt,Yt),移动式机器人2位于多个货架50-58间的主要走道,且实际座标为(X1,Y1)。并且,当定位信号存在误差时,移动式机器人2误定位所在座标为(X2,Y2),并规划出错误的移动方向δ1。
于依据错误的移动方向进行导航的过程中,若移动式机器人2经由激光感测模块202主动检测到障碍物(即货架58),且判断障碍物位于扫描范围的边缘时,会自动进入校正模式。于校正模式下,移动式机器人2可计算障碍物(于扫描范围中占角度α1)于扫描范围(最大扫描角度为角度α)中所占比例来校正移动方向,而校正错误的移动方向δ1为正确的移动方向δ2,而可顺利导航至目标位置(Xt,Yt)并避免碰撞障碍物。
续请参阅图6,为本发明的避障模式示意图,用以示例性说明本发明的避障模式。若移动式机器人2经由激光感测模块202主动检测到多个障碍物(如固定的货架54、56及活动的货架60)且多个障碍物的数量不小于障碍阀值时,会自动进入避障模式。于避障模式下,移动式机器人2可于货架56、60的间隙中识别出无障碍方向δ,并作为新的移动方向。藉此,移动式机器人2可自座标(X1,Y1)沿所识别的无障碍方向δ移动至座标(X2,Y2),而可同时闪避多个障碍物。
续请参阅图7,为本发明第三实施例的移动式机器人的即时导航方法的部分流程图。相较于图3所示的第一实施例,本实施例的即时导航方法更包括用以执行近距离障碍物回避功能的以下步骤。并且,于导航过程中,控制模块212是持续且重复执行近距离障碍物回避功能。
步骤S50:控制模块212经由近距离感测模块208判断是否检测到障碍物。若控制模块212判断检测到障碍物,则执行步骤S52。否则,结束本次检测。
步骤S52:控制模块212控制移动式机器人2停止移动。更进一步地,控制模块212还可经由人机界面204发出警示讯息(如发出“请借过”的语音讯息),以使障碍物(如人员)主动回避。
步骤S54:控制模块212判断是否已发出警示讯息达预设的警示时间(如5秒)。若控制模块212判断已发出警示讯息达预设的警示时间,则执行步骤S56。否则,再次执行步骤S54。
步骤S56:控制模块212再次经由近距离感测模块208判断是否检测到障碍物。若控制模块212判断障碍物仍存在,则执行步骤S58。否则,结束本次检测。
步骤S58:控制模块212控制移动式机器人2倒退预设距离,以远离障碍物。于远离障碍物后,移动式机器人2可经由执行图3或图4所示的即时导航方法来主动闪避障碍物。
本发明可即时检测近距离的障碍物,并避免碰撞障碍物。并且,本发明经由倒退来远离障碍物,可增加识别无障碍方向的机率,而可有效提升闪避障碍物的机率。
续请参阅图8,为本发明的移动式机器人的即时导航示意图,用以说明运用本发明的移动式机器人如何连续地经由避障模式及校正模式来闪避障碍物并完成导航。如图所示,目标位置4的座标为(Xt,Yt),移动式机器人2位于多个货架50-60间的主要走道,且起始座标为(X1,Y1)。
当移动式机器人2位于座标(X1,Y1)时,可经由激光感测模块202检测到多个障碍物(即货架54及人员62、64),并进入避障模式。于避障模式下,移动式机器人2判断无法识别无障碍方向,并朝移动方向δ1倒退至座标(X2,Y2)以远离障碍物。于远离障碍物后,移动式机器人2离开避障模式。
接着,移动式机器人2于座标(X2,Y2)经由激光感测模块202检测到正前方有多个障碍物(即货架54及人员62、64),并再次进入避障模式。于避障模式下,移动式机器人2识别扫描范围右侧存在无障碍方向,将无障碍方向作为移动方向δ2,并朝移动方向δ2移动至座标(X3,Y3)以闪避障碍物并朝目标位置4接近。于本次移动后,移动式机器人2离开避障模式。
接着,移动式机器人2于座标(X3,Y3)经由激光感测模块202检测到正前方仅有一组障碍物(即相近的货架58及人员66),且障碍物位于扫描范围边缘,而进入校正模式。于校正模式下,移动式机器人2将依据存在误差的定位信号所计算的移动方向δ3校正为移动方向δ4,并朝移动方向δ4移动至座标(X4,Y4),以补偿定位信号的误差并朝目标位置4接近。于本次移动后,移动式机器人2离开校正模式。
最后,移动式机器人2于座标(X4,Y4)经由激光感测模块202检测到正前方有多个障碍物(即人员68、70),并再次进入避障模式。于避障模式下,移动式机器人2识别扫描范围多个障碍物中间存在无障碍方向,将无障碍方向作为移动方向δ5,并朝移动方向δ5移动至目标位置4所在的座标(Xt,Yt)以完成本次导航。
续请参阅图9,为本发明第四实施例的移动式机器人的即时导航方法的部分流程图。相较于图3所示的第一实施例,本实施例的即时导航方法更包括用以执行等待障碍物排除功能的以下步骤。并且,于导航过程中,控制模块212是持续且重复执行等待障碍物排除功能。
步骤S70:控制模块212经由近距离感测模块208判断是否检测到障碍物。
若控制模块212判断检测到障碍物,则执行步骤S72。否则,判断结束本次检测。并且,于结束检测后,移动式机器人2可经由执行图3或图4所示的即时导航方法来继续朝目标位置接近。
步骤S72:控制模块212控制移动式机器人2停止移动。
步骤S74:控制模块212控制移动式机器人2进入休眠模式。具体而言,于休眠模式下,移动式机器人2可节省电力消耗。较佳地,控制模块212是于移动式机器人2停止移动达预定的休眠启动时间(如30秒)才进入休眠模式。
步骤S76:控制模块212判断是否已进入休眠模式达预设的休眠时间(如30秒)。若控制模块212判断已进入休眠模式达预设的休眠时间,则再次执行步骤S70,以检测障碍物是否排除。否则,再次执行步骤S76。
本发明可即时检测近距离的障碍物,并避免碰撞障碍物。并且,本发明经由休眠模式,可有效降低等待障碍物排除时的耗电量,进而有效提升续航力。
以上所述仅为本发明的较佳具体实例,非因此即局限本发明的权利要求范围,故举凡运用本发明内容所为的等效变化,均同理皆包含于本发明的范围内,合予陈明。
Claims (10)
1.一种移动式机器人的即时导航方法,其特征在于,包括步骤:
a)于一移动式机器人取得一目标位置;
b)依据经由一超宽频通讯模块接收的一定位信号决定该移动式机器人的一当前位置;
c)依据该目标位置及该当前位置计算一移动方向;
d)于经由一激光感测模块检测到一障碍物时校正该移动方向,并控制该移动式机器人朝校正后的该移动方向移动;及
e)重复执行该步骤b至该步骤d直到该移动式机器人抵达该目标位置。
2.如权利要求1所述的移动式机器人的即时导航方法,其特征在于,该步骤d包括一步骤d1:于检测该障碍物的数量小于一障碍阀值时,依据该障碍物于该激光感测模块的一扫描范围中所占比例校正该移动方向。
3.如权利要求2所述的移动式机器人的即时导航方法,其特征在于,该步骤d1是于检测该障碍物位于该扫描范围的边缘且该障碍物的数量小于2时,依据该障碍物于该扫描范围中所占比例校正该移动方向。
4.如权利要求2所述的移动式机器人的即时导航方法,其特征在于,该步骤d1是依据该障碍物于该扫描范围中的一角度比例及一放大因子校正该移动方向,该放大因子是对应该移动式机器人所在的一走道宽度。
5.如权利要求1所述的移动式机器人的即时导航方法,其特征在于,该步骤d包括一步骤d2:于检测到该障碍物的数量不小于一障碍阀值时,识别前方不存在该障碍物的一无障碍方向,并以该无障碍方向作为新的该移动方向。
6.如权利要求5所述的移动式机器人的即时导航方法,其特征在于,该步骤d还包括一步骤d3:于该激光感测模块的一扫描范围中无法识别该无障碍方向时,控制该移动式机器人停止移动。
7.权利要求1所述的移动式机器人的即时导航方法,其特征在于,还包括一步骤f:于经由一近距离感测模块检测到该障碍物时,控制该移动式机器人停止移动。
8.如权利要求7所述的移动式机器人的即时导航方法,其特征在于,于该步骤f后包括一步骤g:于该移动式机器人停止移动时,发出一警示讯息。
9.如权利要求8所述的移动式机器人的即时导航方法,其特征在于,于该步骤g后包括一步骤h:于发出该警示讯息达一警示时间且仍然经由该近距离感测器检测到该障碍物时,控制该移动式机器人倒退。
10.如权利要求7所述的移动式机器人的即时导航方法,其特征在于,于该步骤f后包括下列步骤:
i)于停止移动达一停止时间且经由该近距离感测器检测到该障碍物时,控制该移动式机器人进入一休眠模式;及
j)于进入该休眠模式达一休眠时间时,重新于该扫描范围中识别该无障碍方向。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW105126812 | 2016-08-22 | ||
TW105126812A TW201807523A (zh) | 2016-08-22 | 2016-08-22 | 移動式機器人的即時導航方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107765683A true CN107765683A (zh) | 2018-03-06 |
Family
ID=61191586
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610741473.6A Pending CN107765683A (zh) | 2016-08-22 | 2016-08-26 | 移动式机器人的即时导航方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US9971350B2 (zh) |
CN (1) | CN107765683A (zh) |
TW (1) | TW201807523A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108957466A (zh) * | 2018-04-18 | 2018-12-07 | 广东宝乐机器人股份有限公司 | 移动机器人的雷达数据补偿方法、装置、设备和存储介质 |
CN113323068A (zh) * | 2021-04-29 | 2021-08-31 | 中联重科土方机械有限公司 | 用于工程机械的控制方法、处理器及工程机械 |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
AU2012202213B2 (en) * | 2011-04-14 | 2014-11-27 | Joy Global Surface Mining Inc | Swing automation for rope shovel |
JP6818708B2 (ja) * | 2018-02-28 | 2021-01-20 | 株式会社東芝 | マニピュレータシステム、制御装置、制御方法、およびプログラム |
CN108549088B (zh) * | 2018-04-27 | 2020-10-02 | 科沃斯商用机器人有限公司 | 基于机器人的定位方法、设备、系统及存储介质 |
EP3569366B1 (en) * | 2018-05-17 | 2023-06-28 | Siemens Aktiengesellschaft | Robot control method and apparatus |
CN109276190A (zh) * | 2018-10-23 | 2019-01-29 | 中国人民解放军陆军工程大学 | 基于uwb的扫地机器人监控方法及其设备 |
CN109798894B (zh) * | 2018-12-28 | 2021-12-10 | 广东嘉腾机器人自动化有限公司 | 一种多区域跨楼层的agv定位方法、存储装置及agv定位系统 |
US11958192B2 (en) * | 2019-05-31 | 2024-04-16 | Amir Khajepour | Method and system for mobile reconfigurable robot for a large workspace |
KR102384525B1 (ko) | 2020-07-09 | 2022-04-08 | 엘지전자 주식회사 | 이동로봇의 제어방법 |
CN112130559A (zh) * | 2020-08-21 | 2020-12-25 | 同济大学 | 一种基于uwb与激光雷达的室内行人跟随与避障方法 |
CN112631290A (zh) * | 2020-12-14 | 2021-04-09 | 云南昆船智能装备有限公司 | 自动标定和设置导航标记物的移动机器人及方法 |
CN112731270A (zh) * | 2021-01-12 | 2021-04-30 | 蔚来汽车科技(安徽)有限公司 | 自动标定装置、设备和服务器以及自动标定方法、存储介质 |
CN113681557A (zh) * | 2021-08-17 | 2021-11-23 | Oppo广东移动通信有限公司 | 机器人控制方法、机器人和可读存储介质 |
KR20230046080A (ko) * | 2021-09-29 | 2023-04-05 | 삼성전자주식회사 | 로봇 및 그 제어 방법 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20010037163A1 (en) * | 2000-05-01 | 2001-11-01 | Irobot Corporation | Method and system for remote control of mobile robot |
CN101025628A (zh) * | 2007-03-23 | 2007-08-29 | 北京大学 | 一种基于流场的智能机器人避障方法 |
CN103777200A (zh) * | 2013-12-16 | 2014-05-07 | 重庆大学 | 面向移动机器人的rfid定位节点布置方法及辅助定位导航方法 |
CN204009577U (zh) * | 2014-04-14 | 2014-12-10 | 南京师范大学 | 智能小车复合式避障系统 |
CN105629974A (zh) * | 2016-02-04 | 2016-06-01 | 重庆大学 | 一种基于改进型人工势场法的机器人路径规划方法及系统 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5279672A (en) * | 1992-06-29 | 1994-01-18 | Windsor Industries, Inc. | Automatic controlled cleaning machine |
CA2616613C (en) * | 2005-07-26 | 2013-10-22 | Timothy D. Barfoot | Guidance, navigation, and control system for a vehicle |
TWI372369B (en) | 2008-06-04 | 2012-09-11 | Univ Nat Chiao Tung | Intruder detection system and method |
JP5094658B2 (ja) * | 2008-09-19 | 2012-12-12 | 日立オートモティブシステムズ株式会社 | 走行環境認識装置 |
CN102445694A (zh) | 2011-09-20 | 2012-05-09 | 中南大学 | 导航机器人障碍探测方法及系统 |
CN102914967B (zh) | 2012-09-21 | 2015-01-28 | 浙江工业大学 | 采摘机器人的自主导航和人机协同采摘作业系统 |
JP5880498B2 (ja) | 2013-08-09 | 2016-03-09 | トヨタ自動車株式会社 | 自律移動体、障害物判別方法及び障害物回避方法 |
TWM508319U (zh) | 2015-02-17 | 2015-09-11 | Tbi Motion Technology Co Ltd | 復健機器之導航輔助裝置 |
CN104967672A (zh) | 2015-06-01 | 2015-10-07 | 南京邮电大学 | 一种能优选信道和缓存数据的健康数据传输系统和方法 |
CN105607635B (zh) | 2016-01-05 | 2018-12-14 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制系统及全向自动导引车 |
-
2016
- 2016-08-22 TW TW105126812A patent/TW201807523A/zh unknown
- 2016-08-26 CN CN201610741473.6A patent/CN107765683A/zh active Pending
- 2016-11-01 US US15/340,897 patent/US9971350B2/en not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20010037163A1 (en) * | 2000-05-01 | 2001-11-01 | Irobot Corporation | Method and system for remote control of mobile robot |
CN101025628A (zh) * | 2007-03-23 | 2007-08-29 | 北京大学 | 一种基于流场的智能机器人避障方法 |
CN103777200A (zh) * | 2013-12-16 | 2014-05-07 | 重庆大学 | 面向移动机器人的rfid定位节点布置方法及辅助定位导航方法 |
CN204009577U (zh) * | 2014-04-14 | 2014-12-10 | 南京师范大学 | 智能小车复合式避障系统 |
CN105629974A (zh) * | 2016-02-04 | 2016-06-01 | 重庆大学 | 一种基于改进型人工势场法的机器人路径规划方法及系统 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108957466A (zh) * | 2018-04-18 | 2018-12-07 | 广东宝乐机器人股份有限公司 | 移动机器人的雷达数据补偿方法、装置、设备和存储介质 |
CN113323068A (zh) * | 2021-04-29 | 2021-08-31 | 中联重科土方机械有限公司 | 用于工程机械的控制方法、处理器及工程机械 |
Also Published As
Publication number | Publication date |
---|---|
US9971350B2 (en) | 2018-05-15 |
US20180052466A1 (en) | 2018-02-22 |
TW201807523A (zh) | 2018-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107765683A (zh) | 移动式机器人的即时导航方法 | |
AU2019208265B2 (en) | Moving robot, method for controlling the same, and terminal | |
CN203882195U (zh) | 基于多传感器融合的服务机器人及其充电座 | |
CA2539903C (en) | Method and system for determining the spatial position of a hand-held measuring appliance | |
CN102906594B (zh) | 用于使用手势来控制激光跟踪器的方法和设备 | |
EP3627269A1 (en) | Target tracking method and apparatus, mobile device and storage medium | |
US8027515B2 (en) | System and method for real-time calculating location | |
AU2023254997A1 (en) | Recharging Control Method of Desktop Robot | |
US20230099779A1 (en) | Metrology system | |
CN101451836B (zh) | 测量系统 | |
CN105094125A (zh) | 室内机器人及其定位方法 | |
CN105700522B (zh) | 一种机器人充电方法及其充电系统 | |
CN101470204A (zh) | 测量系统 | |
CN106291535A (zh) | 一种障碍物检测装置、机器人及避障系统 | |
JP2012137909A (ja) | 移動体遠隔操縦システムおよびそのための制御プログラム | |
CN103389486A (zh) | 控制方法和电子设备 | |
US20210039265A1 (en) | Autonomous working system, method and computer readable recording medium | |
CN111090284B (zh) | 自行走设备返回基站的方法及自行走设备 | |
KR100948947B1 (ko) | 이동체의 위치 추정 장치 및 그 방법 | |
CN103472434B (zh) | 一种机器人声音定位方法 | |
CN109991983B (zh) | 机器人导航方法、装置、系统、电子设备及存储介质 | |
US20130162971A1 (en) | Optical system | |
KR20160056559A (ko) | 포인터를 이용한 로봇의 주행 시스템 및 방법 | |
JP2012173051A (ja) | 電波計測システム | |
KR101080366B1 (ko) | 초음파센서를 이용한 로봇의 위치 인식 방법 및 그 장치 |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20180306 |
|
WD01 | Invention patent application deemed withdrawn after publication |