CN101089556B - 移动设备和用于补偿该移动设备的位置的方法 - Google Patents
移动设备和用于补偿该移动设备的位置的方法 Download PDFInfo
- Publication number
- CN101089556B CN101089556B CN2007100904932A CN200710090493A CN101089556B CN 101089556 B CN101089556 B CN 101089556B CN 2007100904932 A CN2007100904932 A CN 2007100904932A CN 200710090493 A CN200710090493 A CN 200710090493A CN 101089556 B CN101089556 B CN 101089556B
- Authority
- CN
- China
- Prior art keywords
- information
- mobile device
- state
- acceleration
- angle
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 230000033001 locomotion Effects 0.000 claims abstract description 106
- 230000001133 acceleration Effects 0.000 claims description 59
- 230000002159 abnormal effect Effects 0.000 claims description 50
- 230000004888 barrier function Effects 0.000 claims description 36
- 230000008859 change Effects 0.000 claims description 32
- 238000012937 correction Methods 0.000 claims description 22
- 230000009471 action Effects 0.000 claims description 15
- 230000005484 gravity Effects 0.000 claims description 11
- 230000037147 athletic performance Effects 0.000 claims description 6
- 230000001915 proofreading effect Effects 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 abstract description 4
- 208000012661 Dyskinesia Diseases 0.000 abstract 3
- 230000006870 function Effects 0.000 description 10
- 230000005540 biological transmission Effects 0.000 description 9
- 230000008569 process Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000005856 abnormality Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000004140 cleaning Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 239000012141 concentrate Substances 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Images
Classifications
-
- 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
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
提供一种移动设备以及基于位置识别技术来补偿位置的设备、方法和介质。提供校正位置的功能的移动设备包括:感测单元,获得通过移动设备的运动而产生的反映一个或多个异常运动状态的多种状态信息;状态确定单元,通过参照获得的多种状态信息来确定是否通过独立导航而产生异常运动状态;位置信息计算单元,当发生异常运动状态时,通过校正所述多种状态信息来计算移动设备的最终位置信息。
Description
本申请要求于2006年6月16日提交到韩国知识产权局的第10-2006-0054571号韩国专利申请的权益,该申请公开于此以资参考。
技术领域
本发明涉及一种移动设备的位置识别技术,更具体地讲,涉及一种提供位置校正功能的移动设备以及校正位置的方法和介质,通过该位置校正功能,即使在移动设备处于异常运动状态(如在诸如清洁机器人的移动设备移动时可能发生的与障碍物的碰撞、打滑、经过障碍物和绑架)时,也可执行精确地位置识别。
背景技术
通常,为了工业目的开发机器人,并且机器人用于工厂自动化或用于代替人劳动力在不宜于人类的极端环境下执行工作。随着近来在尖端空间开发产业中的应用,机器人工程领域不断发展,并且最近,连对人友好的家庭机器人也已开发。此外,代替医疗器械,可将机器人***人体内,以治疗不能通过传统医疗器械进行治疗的人体的小器官。这种快速发展使机器人工程领域成为继互联网所引导的信息革命和当前流行的生物工程领域之后涌现出的高科技领域。
关于机器人工程,在集中于重工业领域并且限于工业机器人的传统机器人工程领域向面向轻工业的机器人工程的扩展中,家庭机器人扮演着重要角色。一个主要的例子就是清洁机器人。清洁机器人通常包括用于运动的驱动单元、用于清洁的清洁单元和用于在所有方向感测障碍物的监控单元。
这里,移动清洁机器人使用监控单元以这样的方式在有限的区域中行进:如果出现障碍物,则移动机器人改变其运动方向,或者移动机器人使用预定的单元计算其位置,并识别将被清洁的目标区域,然后沿着最佳路径移动,以便能够减少清洁时间和能量消耗。
因此,在于预定的区域中行进的移动设备(包括近来的移动机器人)中,非常需要一种识别设备的位置,即精确地识别设备的位置的技术。
然而,在识别机器人的位置的传统技术中使用的编码器的情况下,随着行进时间增加,位置误差可能通过例如打滑现象而积累。具体地讲,通过与障碍物的碰撞,或者由于为了避免障碍物而作的运动,或者当机器人经过低的障碍物(如门槛)时,位置误差可能加重。作为识别机器人的位置的传统技术的另一例子,可使用陀螺仪。然而,当陀螺仪在机器人经过低的障碍物的情况下转动时,陀螺仪的使用也伴随着位置误差的积累。此外,在人为改变移动机器人的位置的所谓“绑架”的情况下,机器人可能不能够识别其位置。
发明内容
本发明的另外的方面和/或优点将在下面的描述中被部分地阐述,部分地根据描述它们将变得明显,或者可通过实施本发明而被了解。
本发明提供一种提供校正位置的功能的移动设备以及校正位置的方法,其中,通过使用加速度计以及编码器和陀螺仪,确定移动机器人的异常状态(如移动机器人的打滑、与障碍物的碰撞、经过障碍物和绑架),可使误差最小,并可校正误差。
通过阅读下面的描述、附图和权利要求,对于本领域技术人员而言,本发明的上述目的以及其他目的、特点和优点将变得清楚。
根据本发明的一方面,提供一种提供校正位置的功能的移动设备,该移动设备包括:感测单元,获得通过移动设备的运动而产生的反映一个或多个异常运动状态的多种状态信息;状态确定单元,通过参照获得的多种状态信息来确定是否通过独立导航而产生异常运动状态;位置信息计算单元,如果发生异常运动状态,则通过校正所述多种状态信息来计算移动设备的最终位置信息。
根据本发明的另一方面,提供一种校正位置的方法,该方法包括:获得通过移动设备的运动而产生的反映一个或多个异常运动状态的多种状态信息;通过参照获得的多种状态信息来确定是否通过独立导航而产生异常运动状态;当发生异常运动状态时,校正所述多种状态信息,从而计算移动设备的最终位置信息;通过参照计算的最终位置信息产生动作控制信号;通过参照产生的动作控制信号执行移动设备的运动动作。
根据本发明的另一方面,提供一种移动设备,包括:感测单元,获得通过移动设备的运动而产生的多种状态信息;状态确定器,基于所述多种状态信息确定是否产生异常运动状态;位置信息计算器,当发生异常运动状态时,校正所述多种状态信息,并计算移动设备的最终位置信息。
根据本发明的另一方面,提供一种校正移动设备的位置的方法,该方法包括:获得通过移动设备的运动而产生的多种状态信息;基于获得的多种状态信息确定是否产生异常运动状态;当发生异常运动状态时,校正所述多种状态信息,并计算移动设备的最终位置信息;通过参照计算的最终位置信息产生动作控制信号;通过参照产生的动作控制信号执行移动设备的运动动作。
根据本发明的另一方面,提供一种校正移动设备的位置的方法,该方法包括:获得通过移动设备的运动而产生的多种状态信息;基于获得的多种状态信息确定是否产生异常运动状态;当发生异常运动状态时,校正所述多种状态信息,并计算移动设备的最终位置信息。
根据本发明的另一方面,提供至少一种存储用于实现本发明的方法的计算机可读指令的计算机可读介质。
附图说明
通过下面结合附图对示例性实施例的描述,本发明的上述和/或其他方面、特点和优点将变得清楚并更容易理解,其中:
图1示出根据本发明示例性实施例的基于移动设备的运动方向的3维(3D)空间坐标***;
图2是示出根据本发明示例性实施例的提供位置校正功能的移动设备的结构的框图;
图3是示出图2中所示的移动设备的感测单元的结构的示图;
图4是根据本发明示例性实施例的校正位置的方法的流程图。
具体实施方式
现在,将详细描述本发明的示例性实施例,其例子示于附图中,在附图中,相同的标号始终表示相同的部件。下面,将参照附图描述示例性实施例以解释本发明。
将参照被认为是移动设备的一个主要例子的清洁机器人来描述本发明的示例性实施例。然而,示例性实施例可应用于任何移动设备(例如,移动机器人或移动式机器人)。
移动机器人对其自己的位置的识别可通过编码器和陀螺仪来实现,所述编码器感测移动机器人的位置改变或速度改变,所述陀螺仪通过识别移动机器人的惯性质量的运动来感测移动机器人的转动角的改变。
通常当用于移动移动机器人的位置或者改变移动机器人的方向的命令被给出并且移动机器人根据该命令移动时,编码器用于控制该移动机器人的运动。当使用编码器时,可通过以预定的时间间隔测量移动机器人的轮子的转动量并对测量的量进行积分来识别移动机器人的位置。然而,编码器有这样的缺点:每当执行积分运算时,误差就可能积累。具体地讲,当在移动机器人经过障碍物时发生驱动轮的打滑或者驱动轮的垂直方向的改变时,产生相对过多的误差。因此,在本发明的示例性实施例中,另外使用了感测三(3)个轴的加速度分量和重力加速度的加速度计,以便能够减小误差。
为了解释移动机器人的用于减小这种误差的位置校正功能,将介绍3维(3D)空间坐标***。图1示出根据本发明示例性实施例的基于移动设备的运动方向的3维(3D)空间坐标***。
如图1中所示,假设移动设备100(例如,移动机器人)沿x方向行进,y方向垂直于x方向并且平行于地面,z方向垂直于地面。当移动设备100经过障碍物或斜面时,移动设备100的主体可能倾斜并转动。在这种情况下,假设关于x轴的转动方向是横滚(roll)方向,关于y轴的转动方向是俯仰(pitch)方向,关于z轴的转动方向是偏航(yaw)方向。此外,假设当产生异常状态(异常运动状态),例如移动设备100经过障碍物时的状态时,移动设备100以z轴作为转动轴与x轴的角度为θ,移动设备100以y轴作为转动轴与z轴的角度为,移动设备100以x轴作为转动轴与y轴的角度为ψ。
图2是示出根据本发明示例性实施例的提供位置校正功能的移动设备100的结构的框图。参照图2,提供位置校正功能的移动设备100包括:感测单元110、状态确定单元(状态确定器)120、位置信息计算单元(位置信息计算器)130、动作控制单元(动作控制器)140和驱动单元(驱动器)150。
感测单元110获得多种状态信息,所述状态信息反映(指示)当移动设备100行进以清洁或建立地图时产生的一个或多个异常运动状态。在感测单元110中可使用多种传感器,现在,将参照图3解释感测单元110的结构。图3的感测单元110包括位置感测单元(位置传感器)111、速度感测单元(速度传感器)112、转动角感测单元(转动角传感器)113、加速度感测单元(加速度传感器)114和接触感测单元(接触传感器)115。
位置感测单元111感测并获得反映(指示)移动设备100行进的距离的运动位置信息。运动位置信息的取得可由上述编码器来执行。通过使用编码器,可获得移动设备100在x轴方向上的位置改变(ΔXe)和转动角(Δθe)。为了获得这些值,首先,应该使用移动设备100的右驱动轮的运动距离(UR)和左驱动轮的运动距离(UL)的平均值来获得移动设备100在预定时间内在每一方向上移动的运动距离(ΔU)。然后,假设两个轮之间的距离为D,则可使用等式Δθe=(UR-UL)/D获得移动设备100的转动角(Δθe),并且位置改变ΔXe等于ΔU。
因此,在该方法中,可获得包括移动设备100在x轴上的位置改变(ΔXe)以及x轴与移动设备100的运动方向之间的角度改变(Δθe)的运动位置信息。这里,下标e指示编码器。
速度感测单元112通过参照获得的运动位置信息(ΔXe,Δθe)来获得反映(指示)移动设备100的运动速度的速度信息。该速度信息可表示为ΔVXe,速度信息的取得也可由编码器来实现。这里,下标e也指示编码器。
转动角感测单元113获得转动角信息,该转动角信息反映(指示)关于图1中所示的3D坐标空间的坐标轴的转动角的大小。转动角信息可指示关于图1中所示的3D空间中的一个轴的转动角的改变,或指示关于该3D空间中的所有轴的转动角的改变。关于所有轴的转动角的改变包括关于x轴的转动角(横滚方向)的改变(Δψg)、关于y轴的转动角(俯仰方向)的改变(Δ g)和关于z轴的转动角(偏航方向)的改变(Δθg)。这样的使用角速度的转动角信息的取得可由上述陀螺仪来执行。在本发明示例性实施例中,可测量关于三个轴的转动角的所有改变,或者可仅测量关于z轴的转动角的改变(Δθg)。然而,在绑架的情况下,需要测量关于三个轴的转动角的所有改变。这里,下标g指示陀螺仪。
加速度感测单元114获得反映(指示)3个轴的加速度分量和重力加速度的加速度信息。加速度信息包括x轴方向上的加速度分量(ax)、y轴方向上的加速度分量(ay)、z轴方向上的加速度分量(az)和重力加速度(g)。加速度信息的取得可由上述陀螺仪来执行。
接触感测单元115获得反映(指示)移动机器人100是否与地面接触的接触信息。术语地面指的是陆地、地板、人行道或者移动设备在其上移动的任何类似表面。
所述多种状态信息可包括运动位置信息、速度信息、转动角信息、加速度信息和接触信息的全部。
再参照图2,状态确定单元120通过参照获得的多种状态信息来确定是否由于独立导航(self-contained navigation)而发生异常运动状态。当发生异常运动状态时,位置信息计算单元130校正所述多种状态信息,从而计算移动设备100的最终位置信息。
现在,将更详细地解释当异常运动状态发生时,移动设备100确定并校正该状态的过程。
在本发明的当前示例性实施例中,在移动设备100行进时发生的异常运动状态可大致分为4种。这种分类方法仅是为了方便解释本示例性实施例,本发明不限于此。这4种状态是:第一种,发生打滑或碰撞并且发生偏航方向上的转动的状态;第二种,移动设备100的所有驱动轮都经过障碍物并且发生俯仰方向上的转动的状态;第三种,仅一个驱动轮经过障碍物并且发生横滚方向上的转动的状态;第四种,移动设备100自身被人强制拾起和移动的绑架状态。
首先,现在将解释发生打滑或碰撞并且发生偏航方向上的转动的状态。
如果基于运动位置信息计算的转动角改变(Δθe)和基于转动角信息计算的转动角改变(Δθg)之间的差值等于或大于预定的第一阈值,即|Δθe-Δθg|≥Th1,则状态确定单元120确定发生异常运动状态。
此外,如果基于速度信息计算的速度改变(ΔVxe)和基于加速度信息计算的平行于运动方向的加速度分量(ax)之间的差值等于或大于预定的第二阈值,即|ΔVxe-ax|≥Th2,则状态确定单元120确定发生异常运动状态。
此外,如果基于加速度信息计算的平行于地面并垂直于运动方向的加速度分量(ay)的大小等于或大于预定的第三阈值,即|ay|≥Th3,则状态确定单元120确定发生异常运动状态。
当上述三个条件有选择地满足时,位置信息计算单元130相对于移动设备100前进的方向校正运动位置信息,从而计算最终位置信息。这可表示为下面的等式1:
Δθ=Δθg
Δx=∫∫axdtdt或0
Δy=∫∫aydtdt或0......(1)
即,为了补偿打滑或碰撞,可通过将加速度分量对时间执行两次积分运算来计算在短时间内移动的实际驱动距离。然而,由于用目前低廉的加速度计获得的精度可能不够,所以打滑时的运动距离可被设为0,以便能够使误差最小。
其次,现在将解释移动设备100的所有驱动轮都经过障碍物并且发生俯仰方向上的转动的状态。在这种情况下,如果基于加速度信息计算的垂直于地面的加速度分量(az)的大小不同于基于加速度信息计算的重力加速度(g)的大小,并且关于y轴的转动角(俯仰方向)的改变(Δ g)等于或大于预定的第四阈值,则状态确定单元120确定发生异常运动状态。即,当|az|≠|g|时,应该满足条件
位置信息计算单元130相对于俯仰角来校正运动位置信息,从而计算最终位置信息。这可表示为下面的等式2:
这里,ΔXe是由速度感测单元112的编码器获得的x轴方向上的运动位置信息,可使用3个轴的角速度信息来获得俯仰角
第三,现在将解释仅一个驱动轮经过障碍物并且发生横滚方向上的转动的状态。
在这种情况下,如果基于加速度信息计算的垂直于地面的加速度分量(az)的大小不同于基于加速度信息计算的重力加速度(g)的大小,并且关于x轴的转动角(横滚方向)的改变(Δψg)等于或大于预定的第五阈值,则状态确定单元120确定发生异常运动状态。即,当|az|≠|g|时,应该满足条件Δψg≥Th5。
此时,位置信息计算单元130相对于横滚角来校正运动位置信息,从而计算最终位置信息。这可表示为下面的等式3:
Δθ=Δθg/cosψg......(3)
这里,Δθg是由转动角感测单元113获得的偏航方向上的改变(Δθg),因此,如果用所述改变(Δθg)除以横滚角(ψg)的余弦值,则可获得校正的转动角Δθ。
同时,移动设备100在倾斜的平面上转动的情况应该区分于上述第三种情况。为了区分这些情况,当移动设备100转动时,如果z轴方向上的加速度分量az改变,则其对应于第三种情况;如果加速度分量az没有改变而为恒定,则确定其是移动设备100在倾斜的表面上转动的情况,并且不应该执行校正。
第四,现在将解释移动设备100自身被人或机器强制拾起和移动的所谓绑架状态。在这种情况下,如果基于接触信息计算的接触状态指示没有接触,并且基于加速度信息计算的垂直于地面的加速度分量(az)和重力加速度之差等于或大于预定的第六阈值,即|az-g|≥Th6,则状态确定单元120确定发生异常状态。位置信息计算单元130相对于基于加速度信息计算的运动距离和基于转动角信息计算的转动角的改变来校正运动位置信息,从而计算最终的位置信息。
如上所述,在当前示例性实施例中引入了预定的阈值Th1至Th6,以便于状态确定单元120可确定是否发生移动设备100的异常运动状态。然而,不需要将预定的值设置为所述阈值,能够作为确定是否发生异常运动状态的标准的值可被用作阈值Th1至Th6之一。
同时,再参照图2,动作控制单元140通过参照根据上述4种情况中的任何一种情况计算的最终位置信息来产生移动设备100的动作控制信号。驱动单元150通过参照产生的动作控制信号来使移动设备100的运动动作能够被执行。
图4是根据本发明的示例性实施例的校正位置的方法的流程图。
首先,在操作S102,感测单元110获得多种状态信息,所述状态信息反映(指示)在移动设备100行进时发生的一个或多个异常运动状态。然后,在操作S104,状态确定单元120通过参照获得的多种状态信息确定是否通过独立导航而发生异常运动状态。接下来,当发生异常运动状态时,在操作S106,位置信息计算单元校正所述多种状态信息,并计算移动设备100的最终位置信息。然后,在操作S108,动作控制单元140通过参照计算的最终位置信息来产生动作控制信号。最后,在操作S110,驱动单元150通过参照产生的动作控制信号来执行移动设备100的运动动作。
根据如上所述的本发明,通过使用加速度计以及传统技术中使用的编码器和陀螺仪,可确定移动机器人的异常运动状态,如打滑、与障碍物碰撞、经过障碍物和绑架,从而可使误差最小。结果,可通过本发明的设备和方法增强诸如清洁机器人的移动设备中所使用的定位***的性能。
除了上述示例性实施例之外,本发明的示例性实施例还可通过执行介质(例如,计算机可读介质)上的计算机可读代码/指令来实现。所述介质可对应于允许存储和/或传输计算机可读代码/指令的任何介质。所述介质还可包括(单独或与计算机可读代码/指令组合)数据文件、数据结构等。代码/指令的例子包括如通过编译器产生的机器代码以及包含可由计算装置等使用解释器执行的高级代码的文件。
计算机可读代码/指令可以以各种方式记录/传送到介质上,所述介质的例子包括磁存储介质(例如,软盘、硬盘、磁带等)、光学介质(例如,CD-ROM、DVD等)、磁光介质(例如,光磁软盘)、硬件存储装置(例如,只读存储介质、随机存取存储介质、闪存等)以及传输可包括计算机可读代码/指令、数据文件、数据结构等信号的诸如载波的存储/传输介质。存储/传输介质的例子可包括有线和/或无线传输介质。例如,存储/传输介质可包括无线传输介质,该无线传输介质包括传输指定指令、数据结构、数据文件等的与连接到计算装置或网络的接入点通信的信号的载波。所述介质还可以是分布式网络,从而计算机可读代码/指令可以以分布式方式被存储/传送和执行。所述介质还可以是互联网。计算机可读代码/指令可由一个或多个处理器执行。计算机可读代码/指令还可在专用集成电路(ASIC)或现场可编程门阵列(FPGA)中的至少一个中执行或嵌入其中。
此外,可配置一个或多个软件模块或者一个或多个硬件模块,以便执行上述示例性实施例的操作。
这里使用的术语“模块”或部件指的是(但不限于)执行特定任务的软件组件、硬件组件或软件组件和硬件组件的组合。模块可以被有利地配置在可寻址存储介质中,并被配置为在一个或多个处理器上运行。因此,作为示例,所述模块或部件可包括:诸如软件组件、专用软件组件、面向对象的软件组件、类组件和任务组件的组件、进程、函数、执行线程、属性、程序、子程序、程序代码段、驱动程序、固件、微码、电路、数据、数据库、数据结构、表、数组和变量。组件或模块中提供的功能可被组合为更少的组件或模块,或者可被进一步分为另外的组件或模块。此外,组件和模块可在装置中提供的至少一个处理器(例如,中央处理单元(CPU))上运行。此外,硬件组件的例子包括ASIC(专用集成电路)和FPGA(现场可编程门阵列)。如上所述,模块还可表示软件组件和硬件组件的组合。
计算机可读代码/指令和计算机可读介质可以是为了本发明的目的而专门设计和构造的代码/指令和介质,或者可以是计算机硬件和/或计算机软件领域的技术人员可用的公知类型。
尽管已显示和描述了本发明的几个示例性实施例,但是本领域技术人员应该理解,在不脱离由权利要求限定其范围的本发明的原理和精神的情况下,可对这些示例性实施例进行改变。
Claims (18)
1.一种移动设备,包括:
感测单元,获得通过移动设备的运动而产生的多种状态信息;
状态确定器,基于所述多种状态信息确定是否产生异常运动状态;
位置信息计算器,当发生异常运动状态时,校正所述多种状态信息,并计算移动设备的最终位置信息,
其中,所述异常运动状态包括移动设备与障碍物之间发生碰撞并且发生偏航方向上转动的状态、在移动设备经过障碍物时移动设备在俯仰方向上相对于运动方向倾斜的状态以及在移动设备经过障碍物时移动设备在横滚方向上相对于运动方向倾斜的状态中的任何一种。
2.如权利要求1所述的设备,还包括:
动作控制器,基于计算的最终位置信息产生动作控制信号;
驱动器,基于产生的动作控制信号执行移动设备的运动动作。
3.如权利要求1所述的设备,其中,感测单元包括:
位置传感器,获得指示移动设备的运动距离的运动位置信息;
速度传感器,基于运动位置信息获得指示移动速度的速度信息;
转动角传感器,感测指示移动设备的转动角的方向和大小的转动角信息;
加速度传感器,获得指示3个轴的加速度分量和重力加速度的加速度信息;
接触传感器,获得指示移动设备是否与地面接触的接触信息,
其中,所述多种状态信息包括运动位置信息、速度信息、转动角信息、加速度信息和接触信息。
4.如权利要求3所述的设备,其中,如果基于运动位置信息计算的转动角的改变与基于转动角信息计算的转动角的改变之间的差值等于或大于预定的第一阈值,则状态确定器确定发生移动设备与障碍物之间发生碰撞并且发生偏航方向上转动的异常运动状态。
5.如权利要求3所述的设备,其中,如果基于速度信息计算的速度的改变与基于加速度信息计算的平行于运动方向的加速度分量之间的差值等于或大于预定的第二阈值,则状态确定器确定发生移动设备与障碍物之间发生碰撞并且发生偏航方向上转动的异常运动状态。
6.如权利要求3所述的设备,其中,如果基于加速度信息计算的平行于地面且垂直于运动方向的加速度分量的大小等于或大于预定的第三阈值,则状态确定器确定发生移动设备与障碍物之间发生碰撞并且发生偏航方向上转动的异常运动状态。
7.如权利要求3所述的设备,其中,如果基于加速度信息计算的垂直于地面的加速度分量的大小不同于重力加速度的大小,并且基于转动角信息计算的俯仰方向上的角度的改变等于或大于预定的第四阈值,则状态确定器确定发生移动设备经过障碍物时移动设备在俯仰方向上相对于运动方向倾斜的异常运动状态。
8.如权利要求3所述的设备,其中,如果基于加速度信息计算的垂直于地面的加速度分量的大小不同于重力加速度的大小,并且基于转动角信息计算的横滚方向上的转动角的改变等于或大于预定的第五阈值,则状态确定器确定发生移动设备经过障碍物时移动设备在横滚方向上相对于运动方向倾斜的异常运动状态。
9.如权利要求3所述的设备,其中,所述异常运动状态还包括移动设备处于被绑架状态的状态。
10.如权利要求9所述的设备,其中,如果基于接触信息计算的接触状态指示没有接触,并且基于加速度信息计算的垂直于地面的加速度分量与重力加速度之差等于或大于预定的第六阈值,则状态确定器确定发生移动设备处于被绑架状态的异常运动状态。
11.如权利要求3所述的设备,其中,如果状态确定器确定发生移动设备与障碍物之间发生碰撞并且发生偏航方向上转动的异常运动状态,则位置信息计算器相对于移动设备前进的方向来校正运动位置信息,并计算最终位置信息。
12.如权利要求3所述的设备,其中,如果状态确定器确定发生移动设备经过障碍物时移动设备在俯仰方向上相对于运动方向倾斜的异常运动状态,则位置信息计算器相对于基于加速度信息计算的俯仰角来校正运动位置信息,从而计算最终位置信息。
13.如权利要求3所述的设备,其中,如果状态确定器确定发生移动设备经过障碍物时移动设备在横滚方向上相对于运动方向倾斜的异常运动状态,则位置信息计算器相对于基于加速度信息计算的横滚角来校正运动位置信息,从而计算最终位置信息。
14.如权利要求9所述的设备,其中,如果状态确定器确定发生移动设备处于被绑架状态的异常运动状态,则位置信息计算器相对于基于加速度信息计算的运动距离以及基于转动角信息计算的转动角的改变来校正运动位置信息,从而计算最终位置信息。
15.一种校正移动设备的位置的方法,该方法包括:
获得通过移动设备的运动而产生的多种状态信息;
基于获得的多种状态信息确定是否产生异常运动状态;
当发生异常运动状态时,校正所述多种状态信息,并计算移动设备的最终位置信息;
通过参照计算的最终位置信息产生动作控制信号;
通过参照产生的动作控制信号执行移动设备的运动动作,
其中,所述异常运动状态包括移动设备与障碍物之间发生碰撞并且发生偏航方向上转动的状态、在移动设备经过障碍物时移动设备在俯仰方向上相对于运动方向倾斜的状态以及在移动设备经过障碍物时移动设备在横滚方向上相对于运动方向倾斜的状态中的任何一种。
16.如权利要求15所述的方法,其中,获得多种状态信息的步骤包括:
获得指示移动设备的运动距离的运动位置信息;
通过参照运动位置信息获得指示移动速度的速度信息;
获得指示移动设备的转动角的方向和大小的转动角信息;
获得指示3个轴的加速度分量和重力加速度的加速度信息;
获得指示移动设备是否与地面接触的接触信息,
其中,所述多种状态信息包括运动位置信息、速度信息、转动角信息、加速度信息和接触信息。
17.一种校正移动设备的位置的方法,该方法包括:
获得通过移动设备的运动而产生的多种状态信息;
基于获得的多种状态信息确定是否产生异常运动状态;
当发生异常运动状态时,校正所述多种状态信息,并计算移动设备的最终位置信息,
其中,所述异常运动状态包括移动设备与障碍物之间发生碰撞并且发生偏航方向上转动的状态、在移动设备经过障碍物时移动设备在俯仰方向上相对于运动方向倾斜的状态以及在移动设备经过障碍物时移动设备在横滚方向上相对于运动方向倾斜的状态中的任何一种。
18.如权利要求17所述的方法,其中,所述多种状态信息包括运动位置信息、速度信息、转动角信息、加速度信息和接触信息。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR10-2006-0054571 | 2006-06-16 | ||
KR1020060054571A KR101297388B1 (ko) | 2006-06-16 | 2006-06-16 | 위치 보정 기능을 제공하는 이동 장치 및 위치 보정 방법 |
KR1020060054571 | 2006-06-16 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101089556A CN101089556A (zh) | 2007-12-19 |
CN101089556B true CN101089556B (zh) | 2010-11-03 |
Family
ID=38566024
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2007100904932A Active CN101089556B (zh) | 2006-06-16 | 2007-04-12 | 移动设备和用于补偿该移动设备的位置的方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US7768417B2 (zh) |
EP (1) | EP1868056B1 (zh) |
JP (1) | JP4718518B2 (zh) |
KR (1) | KR101297388B1 (zh) |
CN (1) | CN101089556B (zh) |
Families Citing this family (40)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008520394A (ja) | 2004-11-23 | 2008-06-19 | エス.シー. ジョンソン アンド サン、インコーポレイテッド | 表面床クリーニングと組み合わせた空気の浄化を提供する装置および方法 |
US7389166B2 (en) * | 2005-06-28 | 2008-06-17 | S.C. Johnson & Son, Inc. | Methods to prevent wheel slip in an autonomous floor cleaner |
KR20090069595A (ko) * | 2007-12-26 | 2009-07-01 | 삼성전자주식회사 | 이동 로봇의 이동 오류 검출 장치 및 방법 |
US8681093B2 (en) * | 2008-02-11 | 2014-03-25 | Apple Inc. | Motion compensation for screens |
KR101553653B1 (ko) * | 2009-01-07 | 2015-09-16 | 삼성전자 주식회사 | 로봇의 슬립 감지 장치 및 방법 |
US8774970B2 (en) | 2009-06-11 | 2014-07-08 | S.C. Johnson & Son, Inc. | Trainable multi-mode floor cleaning device |
EP2495079B1 (en) * | 2009-10-30 | 2018-09-05 | Yujin Robot Co., Ltd. | Slip detection apparatus and method for a mobile robot |
CN101741983B (zh) * | 2009-12-10 | 2013-08-07 | 中兴通讯股份有限公司 | 一种实现临近感应的方法以及终端 |
US10977601B2 (en) | 2011-06-29 | 2021-04-13 | State Farm Mutual Automobile Insurance Company | Systems and methods for controlling the collection of vehicle use data using a mobile device |
US20130006674A1 (en) | 2011-06-29 | 2013-01-03 | State Farm Insurance | Systems and Methods Using a Mobile Device to Collect Data for Insurance Premiums |
CN102564416B (zh) * | 2011-12-30 | 2014-08-20 | 浙江国自机器人技术有限公司 | 一种镜面清洁机器人进行三维重构与定位的***及方法 |
DE102012201870A1 (de) * | 2012-02-08 | 2013-08-08 | RobArt GmbH | Verfahren zum automatischen Auslösen einer Selbstlokalisierung |
EP2820899A4 (en) * | 2012-02-29 | 2015-06-03 | Intel Corp | POSITION DISCREPANCY CORRECTIONS BASED ON COMMUNITY CORRECTIONS AND PITCH IDENTIFICATION |
CN103505140B (zh) * | 2012-06-28 | 2016-12-21 | 科沃斯机器人股份有限公司 | 擦玻璃装置 |
CN103744425B (zh) * | 2012-08-23 | 2017-10-03 | 苏州宝时得电动工具有限公司 | 自动工作设备及其控制方法 |
CN103622643A (zh) * | 2012-08-29 | 2014-03-12 | 科沃斯机器人科技(苏州)有限公司 | 自移动清洁装置 |
CN102991489B (zh) * | 2012-11-21 | 2015-12-09 | 上海富欣智能交通控制有限公司 | 对空转和打滑进行检测和补偿的安全列车测速测距***及方法 |
PL401996A1 (pl) * | 2012-12-11 | 2014-06-23 | Robotics Inventions Spółka Z Ograniczoną Odpowiedzialnością | Układ kontroli kolizji robota z przeszkodą, robot wyposażony w taki układ oraz sposób kontroli kolizji robota z przeszkodą |
CN104414573B (zh) * | 2013-08-23 | 2017-12-22 | 科沃斯机器人股份有限公司 | 擦窗装置 |
CN103713637A (zh) * | 2013-12-09 | 2014-04-09 | 广西科技大学 | 一种基于单片机的智能小车重力倾斜角度控制方法 |
CN103713635A (zh) * | 2013-12-09 | 2014-04-09 | 广西科技大学 | 一种基于单片机智能小车控制*** |
CN105242675A (zh) * | 2014-06-17 | 2016-01-13 | 苏州宝时得电动工具有限公司 | 自动行走设备 |
CN104516352B (zh) * | 2015-01-25 | 2016-05-18 | 哈尔滨工大服务机器人有限公司 | 用于矩形目标检测的机器人*** |
CN104679001A (zh) * | 2015-01-25 | 2015-06-03 | 无锡桑尼安科技有限公司 | 一种用于矩形目标检测方法 |
KR101697857B1 (ko) * | 2015-04-08 | 2017-01-18 | 엘지전자 주식회사 | 이동 로봇 및 그의 위치인식방법 |
CN105752195B (zh) * | 2016-03-31 | 2018-09-21 | 重庆交通大学 | 桥梁检测用机器人 |
CN106444859B (zh) * | 2016-11-10 | 2019-07-26 | 广州市景沃电子有限公司 | 一种横滚角运动隔离的单轴稳定云台及控制方法 |
CN107422737A (zh) * | 2017-08-08 | 2017-12-01 | 珠海市微半导体有限公司 | 机器人是否碰到障碍物的检测方法和***及芯片 |
CN107289929A (zh) * | 2017-08-08 | 2017-10-24 | 珠海市微半导体有限公司 | 一种机器人碰到障碍物的检测方法和***及芯片 |
JP7180612B2 (ja) * | 2017-12-05 | 2022-11-30 | ソニーグループ株式会社 | 制御装置、および制御方法、プログラム、並びに移動体 |
CN108508886B (zh) * | 2018-02-11 | 2020-10-27 | 浙江科聪智能科技有限公司 | 用于防爆巡检机器人的一体化控制器及其控制*** |
CN108762266B (zh) * | 2018-05-28 | 2021-07-02 | 深圳市卓兴半导体科技有限公司 | 电动滑板车控制方法、装置、存储介质及电动滑板车 |
CN108634886B (zh) * | 2018-05-29 | 2020-08-28 | 珠海市一微半导体有限公司 | 机器人清扫中断后的控制方法及芯片 |
CN110733033B (zh) * | 2018-07-19 | 2023-03-24 | 科沃斯机器人股份有限公司 | 机器人控制方法、机器人及存储介质 |
CN110968099B (zh) * | 2019-12-17 | 2024-05-07 | 小狗电器互联网科技(北京)股份有限公司 | 一种机器人被困检测方法以及机器人 |
CN111002346B (zh) * | 2019-12-17 | 2021-05-14 | 小狗电器互联网科技(北京)股份有限公司 | 一种机器人被困检测方法以及机器人 |
CN111565364B (zh) * | 2020-04-03 | 2021-02-09 | 拉扎斯网络科技(上海)有限公司 | 定位信息的获取方法及装置、存储介质、终端 |
CN112603202B (zh) * | 2020-12-07 | 2022-01-11 | 深圳市银星智能科技股份有限公司 | 离地检测方法、装置、移动机器人及存储介质 |
CN112558616B (zh) * | 2020-12-28 | 2023-11-21 | 南京苏美达智能技术有限公司 | 一种智能自行走设备及控制方法 |
CN114325744B (zh) * | 2021-12-29 | 2022-08-19 | 广东工业大学 | 一种无人车打滑检测方法、***、设备及介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5446356A (en) * | 1993-09-09 | 1995-08-29 | Samsung Electronics Co., Ltd. | Mobile robot |
CN1274310A (zh) * | 1998-06-09 | 2000-11-22 | 索尼公司 | 机器人装置及其姿态控制方法 |
CN1309597A (zh) * | 1998-11-30 | 2001-08-22 | 索尼公司 | 机器人装置及其控制方法 |
CN1381340A (zh) * | 2001-04-18 | 2002-11-27 | 三星光州电子株式会社 | 机器人清洁机,机器人清洁***以及控制它们的方法 |
CN1514322A (zh) * | 2002-12-31 | 2004-07-21 | Lg������ʽ���� | 补偿机器人清洁器的旋转位置误差的方法 |
CN1636685A (zh) * | 2003-12-22 | 2005-07-13 | Lg电子株式会社 | 用于校正移动式机器人位置的装置和方法 |
CN1759798A (zh) * | 2004-10-12 | 2006-04-19 | 三星光州电子株式会社 | 用于机器人清洁器的陀螺传感器的补偿方法 |
Family Cites Families (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2517240B2 (ja) | 1986-08-15 | 1996-07-24 | 三洋電機株式会社 | 無人走行車輌 |
JP3231377B2 (ja) | 1992-01-29 | 2001-11-19 | 株式会社日立製作所 | 列車姿勢制御装置 |
JPH06284518A (ja) | 1993-03-26 | 1994-10-07 | Railway Technical Res Inst | 移動体加速度検出装置及び移動***置検出装置 |
JPH09329438A (ja) | 1996-06-07 | 1997-12-22 | Tokyu Constr Co Ltd | 地質不連続面の測定方法及び測定装置 |
JP3555003B2 (ja) * | 1997-08-29 | 2004-08-18 | 株式会社日立製作所 | 移動機の位置計測装置 |
JPH11102220A (ja) | 1997-09-26 | 1999-04-13 | Minolta Co Ltd | 移動体の制御装置 |
JP3941252B2 (ja) * | 1998-08-07 | 2007-07-04 | マツダ株式会社 | 車両の位置検出装置 |
JP2000330639A (ja) | 1999-05-25 | 2000-11-30 | Osaka Gas Co Ltd | 走行制御方法及び走行体 |
JP3537705B2 (ja) | 1999-05-31 | 2004-06-14 | 本田技研工業株式会社 | 自動追従走行システム |
JP3555107B2 (ja) * | 1999-11-24 | 2004-08-18 | ソニー株式会社 | 脚式移動ロボット及び脚式移動ロボットの動作制御方法 |
JP4229358B2 (ja) * | 2001-01-22 | 2009-02-25 | 株式会社小松製作所 | 無人車両の走行制御装置 |
KR100483548B1 (ko) * | 2002-07-26 | 2005-04-15 | 삼성광주전자 주식회사 | 로봇 청소기와 그 시스템 및 제어 방법 |
US6999851B2 (en) * | 2002-08-30 | 2006-02-14 | Sony Corporation | Robot apparatus and motion controlling method therefor |
US7145478B2 (en) * | 2002-12-17 | 2006-12-05 | Evolution Robotics, Inc. | Systems and methods for controlling a density of visual landmarks in a visual simultaneous localization and mapping system |
JP2004306251A (ja) | 2003-03-23 | 2004-11-04 | Sony Corp | ロボット装置及びその制御方法 |
JP2004299013A (ja) * | 2003-03-31 | 2004-10-28 | Fanuc Ltd | 誤差修正フィードバック機能を有するロボットオフラインプログラミング装置 |
JP2005215742A (ja) | 2004-01-27 | 2005-08-11 | Yanmar Co Ltd | 農業用作業車 |
JP2005216021A (ja) * | 2004-01-30 | 2005-08-11 | Funai Electric Co Ltd | 自律走行ロボットクリーナー |
JP4531520B2 (ja) | 2004-10-15 | 2010-08-25 | 本田技研工業株式会社 | 脚式移動ロボットの制御装置 |
JP4204538B2 (ja) * | 2004-11-29 | 2009-01-07 | 株式会社東芝 | 移動制御装置および移動制御方法 |
-
2006
- 2006-06-16 KR KR1020060054571A patent/KR101297388B1/ko active IP Right Grant
-
2007
- 2007-02-20 US US11/707,992 patent/US7768417B2/en active Active
- 2007-04-12 CN CN2007100904932A patent/CN101089556B/zh active Active
- 2007-05-22 EP EP07108623.5A patent/EP1868056B1/en active Active
- 2007-06-13 JP JP2007156469A patent/JP4718518B2/ja active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5446356A (en) * | 1993-09-09 | 1995-08-29 | Samsung Electronics Co., Ltd. | Mobile robot |
CN1274310A (zh) * | 1998-06-09 | 2000-11-22 | 索尼公司 | 机器人装置及其姿态控制方法 |
CN1309597A (zh) * | 1998-11-30 | 2001-08-22 | 索尼公司 | 机器人装置及其控制方法 |
CN1381340A (zh) * | 2001-04-18 | 2002-11-27 | 三星光州电子株式会社 | 机器人清洁机,机器人清洁***以及控制它们的方法 |
CN1514322A (zh) * | 2002-12-31 | 2004-07-21 | Lg������ʽ���� | 补偿机器人清洁器的旋转位置误差的方法 |
CN1636685A (zh) * | 2003-12-22 | 2005-07-13 | Lg电子株式会社 | 用于校正移动式机器人位置的装置和方法 |
CN1759798A (zh) * | 2004-10-12 | 2006-04-19 | 三星光州电子株式会社 | 用于机器人清洁器的陀螺传感器的补偿方法 |
Non-Patent Citations (1)
Title |
---|
JP特开2006-155146A 2006.06.15 |
Also Published As
Publication number | Publication date |
---|---|
JP2007334896A (ja) | 2007-12-27 |
US7768417B2 (en) | 2010-08-03 |
US20070290828A1 (en) | 2007-12-20 |
EP1868056B1 (en) | 2018-02-28 |
EP1868056A2 (en) | 2007-12-19 |
EP1868056A3 (en) | 2013-11-20 |
CN101089556A (zh) | 2007-12-19 |
KR20070119964A (ko) | 2007-12-21 |
KR101297388B1 (ko) | 2013-08-19 |
JP4718518B2 (ja) | 2011-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101089556B (zh) | 移动设备和用于补偿该移动设备的位置的方法 | |
CN109579847B (zh) | 同步定位与地图构建中关键帧提取方法、装置和智能设备 | |
US10275649B2 (en) | Apparatus of recognizing position of mobile robot using direct tracking and method thereof | |
US11287819B2 (en) | Systems and methods for ground plane estimation | |
EP2715286B1 (en) | Deep lane navigation system for automatic guided vehicles | |
JP7487388B2 (ja) | 測定装置、測定方法、及び、プログラム | |
US20220128998A1 (en) | Navigation method, moving carrier and navigation system | |
US20130141336A1 (en) | System and method for linear and angular measurements of a moving object | |
CN107228663A (zh) | 一种自动导引运输车的定位***和方法 | |
CN110864692A (zh) | 掘进机的位姿确定方法 | |
US20220044418A1 (en) | Optical sensor for odometry tracking to determine trajectory of a wheel | |
CN110942474A (zh) | 机器人目标跟踪方法、设备及存储介质 | |
CN111089595B (zh) | 一种机器人的检测数据融合方法和主控芯片及机器人 | |
Csaba et al. | Differences between Kinect and structured lighting sensor in robot navigation | |
Rövid | Machine vision-based measurement system for vehicle body inspection | |
hyeuk Lee et al. | Elbow detection for localization of a mobile robot inside pipeline using laser pointers | |
Liu et al. | Stereo-image matching using a speeded up robust feature algorithm in an integrated vision navigation system | |
Grandjean et al. | Perception control for obstacle detection by a cross-country rover | |
CN206959855U (zh) | 一种自动导引运输车的定位*** | |
KR20220038737A (ko) | 광 마우스 센서 기술을 기반으로 하는 광류 주행 거리 측정기 | |
Aqel et al. | Estimation of image scale variations in monocular visual odometry systems | |
Fazekas et al. | Vision-based motion estimation for vehicles on test track via cone markers | |
TWI844240B (zh) | 自主移動裝置 | |
Van Crombrugge et al. | Fast Ground Detection for Range Cameras on Road Surfaces Using a Three-Step Segmentation | |
CN116698021A (zh) | 一种机器人定位方法、电子设备以及计算机存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |