CN106325269A - 基于里程计和磁传感器的两轮平衡车路径校正装置及方法 - Google Patents
基于里程计和磁传感器的两轮平衡车路径校正装置及方法 Download PDFInfo
- Publication number
- CN106325269A CN106325269A CN201610635671.4A CN201610635671A CN106325269A CN 106325269 A CN106325269 A CN 106325269A CN 201610635671 A CN201610635671 A CN 201610635671A CN 106325269 A CN106325269 A CN 106325269A
- Authority
- CN
- China
- Prior art keywords
- balance car
- magnetic
- path
- wheel
- correction zone
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000012937 correction Methods 0.000 claims abstract description 111
- 230000007246 mechanism Effects 0.000 claims abstract description 4
- 241001269238 Data Species 0.000 claims description 10
- 230000006870 function Effects 0.000 claims description 6
- 230000006698 induction Effects 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 abstract description 2
- 230000008569 process Effects 0.000 description 5
- 238000005303 weighing Methods 0.000 description 4
- 230000007613 environmental effect Effects 0.000 description 3
- 238000005245 sintering Methods 0.000 description 3
- 238000009966 trimming Methods 0.000 description 3
- 230000033228 biological regulation Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 229910015335 Ni2In Inorganic materials 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000000205 computational method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
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
- 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/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0253—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于里程计和磁传感器的两轮平衡车路径校正装置及方法,包括相互连接的控制器和两轮平衡车驱动机构、两个里程计、两个磁传感器和多个校正区,两个里程计和两个磁传感器分别与控制器连接,两轮平衡车的左轮和右轮各安装一个里程计和一个磁传感器,每个校正区包括两个相互不平行也不相交的磁条,磁条固定在地面上,并与两轮平衡车的标准路径交叉。与现有技术相比,本发明利用磁传感器和里程计判断两轮平衡车位置和姿态,从而与标准数据进行比较得出偏差,进行路径校正,不需要在全路段铺设磁轨或磁条,实时性好、易于安装、成本低、不易受环境影响。
Description
技术领域
本发明涉及一种两轮平衡车的路径校正方法,尤其是涉及一种基于里程计和磁传感器的两轮平衡车路径校正装置及方法。
背景技术
近年来,两轮平衡车因其运动灵活、智能控制、操作简单、节省能源、绿色环保等特点在现代交通工具中应用越来越广泛,如用于日常代步工具、警务人员治安巡查、广告宣传、辅助拍摄等。然而,除了其载人功能外,两轮平衡车作为机器人家族中的一员,在其自动行走、姿态调节等基本功能的基础上搭载某些传感器后即可在很多场合下替代巡逻机器人完成很多任务,如电站巡检、小区安保、日常巡逻、环境监测、军事侦察等。
现阶段,里程计、陀螺仪、磁罗盘等传感器常用于室外环境下机器人定位,但因其存在明显缺陷,一般不单独使用,通常与其他传感器共同使用,进行信息融合。巡逻机器人通常采用搭载里程计、视觉传感器、超声波传感器、激光测距仪、磁导航传感器、GPS、红外线传感器等方式实现其路径规划、自主导航、定位、检测路线等功能。
当机器人在避障后或因其他原因偏移巡逻路径时,如不及时采取校正和调整措施,在行进过程中误差不断积累,不仅无法顺利完成巡逻任务,还会增大机器人走入死路或发生碰撞的危险程度。因此在机器人巡逻过程中对其实际运行路线与预定路径进行比较与评估后及时进行校正和调整是至关重要的。通常利用其上搭载的传感器进行位置信息采集,通过位置估算及障碍物位置或轨道位置信息进行路径的跟踪及调整。目前,大部分轮式巡逻机器人主要是基于视觉传感器、红外传感器或磁导航传感器设计开发的,基于视觉传感器的机器人识别精度高,但视觉定位算法复杂,实时性较差,且易受环境光线影响,运行不稳定;基于红外传感器价格较低、抗干扰能力强,识别速度快,但识别精度不高,通常需要在全路段布置连续的路面色带标志信息来引导机器人行进;磁导航传感器也需要在全路段铺设磁轨或磁条,而在很多实际应用场合下,要求在巡逻全路段铺设导轨、磁轨、色带轨等是不现实的。
现有技术中,针对移动机器人巡逻过程中的路径校正均采用立体视觉方式,成本较高、实时性差、且易受环境影响,也尚未有专门针对两轮平衡车巡逻时使用的路径校正方法供生产厂家使用。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种能在两轮平衡车避障或偏移路径后使其返回预定标准路线的基于里程计和磁传感器的两轮平衡车路径校正装置及方法。
本发明的目的可以通过以下技术方案来实现:
一种基于里程计和磁传感器的两轮平衡车路径校正装置,包括相互连接的控制器和两轮平衡车驱动机构,还包括两个里程计、两个磁传感器和多个校正区,所述的两个里程计和两个磁传感器分别与控制器连接,两轮平衡车的左轮和右轮各安装一个里程计和一个磁传感器,每个校正区包括两个相互不平行也不相交的磁条,所述的磁条位置固定,并与两轮平衡车的标准路径交叉,
两轮平衡车从起点开始按记忆路径行驶,记忆路径按照标准路径生成,当两轮平衡车行驶至校正区,磁传感器感应到车轮压过磁条时,控制器读取里程计的实时数据,根据实时数据与该校正区的标准数据计算当前的实际路径与标准路径之间的偏差,并根据偏差进行路径校正,使两轮平衡车回到标准路径,然后继续行驶至下一个校正区或结束行驶,其中,每个校正区内,有四个标准数据和四个实时数据,标准数据获取方法包括:两轮平衡车从起点严格沿标准路径行驶,经过校正区内磁条时,由控制器记录两个里程计的数据作为该校正区的标准数据。
所述的装置还包括设置在两轮平衡车路径上的充电桩,所述的充电桩作为两轮平衡车行驶的起点。
一种使用所述的基于里程计和磁传感器的两轮平衡车路径校正装置进行路径校正的方法,包括以下步骤:
S1,两轮平衡车从起点开始启动,按记忆路径行驶,两轮平衡车行驶的实际路径与标准路径之间存在偏差;
S2,车轮压过磁条时,该车轮上的磁传感器向控制器发送信号,控制器读取该车轮上里程计的实时数据,并返回步骤S2,直到控制器读取到四个实时数据,该校正区内的实时数据读取完毕;
S3,控制器根据四个实时数据,计算两轮平衡车当前的实际路径与标准路径之间的偏差,并判断是否进行路径校正,若是,则进入步骤S4,否则继续按记忆路径行驶并返回步骤S2,或者结束行驶;
S4,两轮平衡车暂停行驶,根据偏差计算校正参数并根据校正参数移动至标准路径,然后继续按记忆路径行驶并返回步骤S2。
所述的步骤S2中,当车轮经过磁条时,磁传感器检测到连续变化的磁感应强度,当磁感应强度最大时,磁传感器判断车轮压过磁条,并向控制器发送信号。控制器读取对应车轮上的里程计数据。
所述的步骤S3中,若偏差小于设定值,则不进行路径校正,两轮平衡车继续朝标准路径行驶并返回步骤S2,若当前校正区为最后一个校正区,则不进行路径校正,两轮平衡车结束行驶,否则进入步骤S4。
所述的步骤S4中,第i个校正区内,当前实际路径与标准路径之间的偏差包括角度偏差θi和方位向偏差Δdi,计算式分别为:
θi=βAi-αAi
其中,βAi为第i个校正区内车轮第一次压过的磁条与当前实际路径之间的夹角,αAi为第i个校正区内车轮第一次压过的磁条与标准路径之间的夹角,αBi为第i个校正区内车轮第二次压过的磁条与标准路径之间的夹角,ΔLi1为第i个校正区内标准路径与两个磁条交点之间的距离,ΔLi2为第i个校正区内实际路径与两个磁条交点之间的距离;
校正参数Δyi和的计算式分别为:
Δyi=ΔLmisinθi-Δdi
其中,ΔLmi为第i个校正区内,当前实际路径与车轮第二次压过的磁条之间交点到实际路径上的待校正点之间的距离,sgn(*)为符号函数;
两轮平衡车根据校正参数移动至标准路径的具体方法为:两轮平衡车方向逆时针旋转φi角度后,沿方位向所在直线向标准路径行进|Δyi|,再逆时针旋转角度,回到标准路径和正确姿态,所述的方位向与标准路径方向垂直。
所述的第i个校正区内标准路径与两个磁条交点之间的距离ΔLi1计算式为:
其中,LLi为平衡车左轮在经过两磁条之间这段时间内左轮里程计的里程记录值,LRi为平衡车右轮在经过两磁条之间这段时间内右轮里程计的里程记录值;
第i个校正区内实际路径与两个磁条交点之间的距离ΔLi2计算原理与ΔLi1相同。
与现有技术相比,本发明具有以下优点:
(1)采用在校正区内设置磁条的方式,利用磁传感器和里程计判断两轮平衡车位置和姿态,从而与标准数据进行比较得出偏差,进行路径校正,不需要在全路段铺设磁轨或磁条,实时性好、易于安装、成本低、不易受环境影响、不需要人机交互。
(2)磁传感器抗干扰能力强,不受外界环境光照、颜色等影响。
(3)以充电桩作为两轮平衡车行驶的起点,无需另设起点,节约成本,易于管理,且符合两轮平衡车充电需要。
(4)每个校正区内,由于两个磁条的特殊摆放方式,可保证里程计共读取四个实时数据,从而保证计算的可靠性。
(5)当磁感应强度最大时,磁传感器判断车轮压过磁条,此时读取里程计数据,计算误差小。
(6)路径校正时,只需经过两次旋转和一次位移,且角度和位移数值明确,可回到标准路径和正确姿态。
附图说明
图1为本实施例两轮平衡车标准路径生成及巡逻路径校正流程图;
图2为本实施例两轮平衡车的行驶路径及校正区位置示意图;
图3为本实施例中,两轮平衡车在经过校正区时计算行驶路径与磁条间夹角以及里程值的示意图;
图4为本实施例中,计算当前巡逻路径(路径2)与预定标准路径(路径1)的角度偏差和方位向偏差的几何示意图;
图5为本实施例中,预定标准路径(路径1)和当前巡逻路径(路径2)相对位置处于第二种情况下,计算路径2与路径1的角度偏差和方位向偏差的几何示意图;
图6(a)、图6(b)为本实施例中,预定标准路径(路径1)和当前巡逻路径(路径2)相对位置处于第三种情况下,计算路径2与路径1的角度偏差和方位向偏差的几何示意图;
图7(a)、图7(b)为本实施例中,预定标准路径(路径1)和当前巡逻路径(路径2)相对位置处于第四种情况下,计算路径2与路径1的角度偏差和方位向偏差的几何示意图;
图8为本实施例中,在待校正点换算出校正参数的几何示意图;
附图标记:101为充电桩;10为起始区;1为第一个校正区;2为第二个校正区;i为第i个校正区;K为第K个校正区。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。本实施例以本发明技术方案为前提进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
实施例
一种基于里程计和磁传感器的两轮平衡车路径校正装置,包括相互连接的控制器和两轮平衡车驱动机构,还包括两个里程计、两个磁传感器、充电桩和多个校正区,两个里程计和两个磁传感器分别与控制器连接,两轮平衡车的左轮和右轮各安装一个里程计和一个磁传感器,每个校正区包括两个相互不平行也不相交的磁条,磁条固定在地面上,并与两轮平衡车的标准路径交叉,充电桩设置在两轮平衡车路径上,作为两轮平衡车行驶的起点。
两轮平衡车从起点开始按记忆路径行驶,记忆路径按照标准路径生成,当两轮平衡车行驶至校正区,磁传感器感应到车轮压过磁条时,控制器读取里程计的实时数据,根据实时数据与该校正区的标准数据计算当前的实际路径与标准路径之间的偏差,并根据偏差进行路径校正,使两轮平衡车回到标准路径,然后继续行驶至下一个校正区或结束行驶,其中,每个校正区内,有四个标准数据和四个实时数据,标准数据获取方法包括:两轮平衡车从起点严格沿标准路径行驶,经过校正区内磁条时,由控制器记录两个里程计的数据作为该校正区的标准数据。
一种使用基于里程计和磁传感器的两轮平衡车路径校正装置进行路径校正的方法,包括以下步骤:
S1,两轮平衡车从起点开始启动,按记忆路径行驶,两轮平衡车行驶的实际路径与标准路径之间存在偏差;
S2,车轮压过磁条时,该车轮上的磁传感器向控制器发送信号,控制器读取该车轮上里程计的实时数据,并返回步骤S2,直到控制器读取到四个实时数据,该校正区内的实时数据读取完毕;
S3,控制器根据四个实时数据,计算两轮平衡车当前的实际路径与标准路径之间的偏差,并判断是否进行路径校正,若是,则进入步骤S4,否则继续按记忆路径行驶并返回步骤S2,或者结束行驶;
S4,两轮平衡车暂停行驶,根据偏差计算校正参数并根据校正参数移动至标准路径后,然后继续按记忆路径行驶并返回步骤S2。
如图1所示,在预定标准行进路段(图中由一圈条形框围成的虚线路径,带有箭头)设置一个起始区和K个校正区域,起始区内安装一个充电桩1,充电桩1位置作为平衡车预定标准路径和巡逻路径的起始点。每个校正区域内的地面上粘贴两条能被磁传感器所感应识别的直线磁条,分别记为Ai和Bi(i=1,2,…,K),如附图2所示,磁条Ai的起始点与终止点分别位于路基两侧,磁条Bi的起始点与终止点也分别位于路基两侧,两条磁条不平行也不相交,分别与两侧路基构成不同的任意夹角即可。平衡车的左右两轮分别搭载一部里程计和一部磁传感器,当车轮行进至某条磁条时,该轮上的磁传感器感应识别出磁条,并返回给平衡车一个信号,此时该轮上的里程计将记录下该时刻的里程数据。
第一步,开机后,两轮平衡车从起始点开始沿预定标准路径行进,经过每一个校正区时,记录下相关数据,并通过计算得到平衡车行进方向分别与该校正区内两条磁条间的夹角以及平衡车在通过两条磁条间行进的里程值,设置参数i=1。具体方法如下。
如附图3所示,假设平衡车左右两轮间距为DLR,平衡车行进方向始终垂直于两轮轮轴方向。当平衡车经过第i个校正区时,假设右轮先到达磁条Ai,即平衡车行进到位置xA1时,右轮上的磁传感器感应识别到磁条Ai,此时右轮上的里程计记录当前里程值为LRi1,当平衡车继续行进到左轮到达磁条Ai时,即平衡车行进到位置xA2时,左轮上的磁传感器感应识别到磁条Ai,此时左轮和右轮上的里程计分别记录当前里程值LLi1和LRi2,在此期间右轮行进里程为
LAi=LRi2-LRi1
根据图中几何关系,可以计算得到平衡车行进方向与磁条Ai之间的夹角αAi为
平衡车继续行进,同理,当右轮到达磁条Bi时,即平衡车行进到位置xB1时,右轮上的磁传感器感应识别到磁条Bi,右轮上的里程计记录当前里程值LRi3,当左轮到达磁条Bi时,即平衡车行进到位置xB2时,左轮上的磁传感器感应识别到磁条Bi,此时左轮和右轮上的里程计分别记录当前里程值LLi2和LRi4,在此期间右轮行进里程为
LBi=LRi4-LRi3
计算得到平衡车行进方向与磁条Bi之间的夹角αBi为
而平衡车在经过两磁条之间的行进距离为左右轮行进距离的平均值,即为
因此,根据以上方法可以得到平衡车在经过每一个校正区时其行进方向分别与该校正区内两条磁条间的夹角αAi、αBi以及平衡车在通过两条磁条间行进的里程值ΔLi1。
第二步,平衡车从起始点开始根据里程计记录值按记忆路径行进,到达第i个校正区时,如附图4所示,图中路径1为预定标准路径,根据第一步中的记录结果,路径1与磁条Ai、磁条Bi之间的夹角分别为αAi和αBi,路径1在通过两条磁条间行进的里程值|Mi1Mi2|为ΔLi1。
路径2为当前巡逻路径,按照第一步中相似的计算方法可以得到平衡车行进方向与该校正区内两条磁条间的夹角以及平衡车在通过两条磁条间行进的里程值。记路径2与磁条Ai、磁条Bi之间的夹角分别为βAi和βBi,路径2在通过两条磁条间行进的里程值|Ni1Ni2|为ΔLi2。
第三步,计算路径2与路径1之间的角度偏差和方位向偏差。具体方法如下。
根据附图4中几何关系,路径2与路径1之间的角度偏差θi为
θi=βAi-αAi
在△OiMi1Mi2中,∠Mi1OiMi2=αBi-αAi,由正弦定理
即
在△RiNi1Ni2中,∠Ni1RiNi2=αAi,∠RiNi1Ni2=π-βAi,由正弦定理
即
又有
联立以上式子可得平衡车在行进至磁条Bi时,路径2与路径1在方位向上的偏差Δdi为
需要说明的是,附图4中给出的是βAi>αAi的情况,即θi>0,规定角度逆时针方向为正方向,图中Oy方向为方位向正方向,此时路径2与路径1之间方位向偏差Δdi>0,即路径2与磁条Bi的交点相比路径1与磁条Bi的交点在方位轴上坐标值更大。
如附图5所示,如路径2与路径1之间关系使得βAi<αAi的情况,即θi<0,此时计算原理与公式与上一种情况相同,只是计算得到的路径2与路径1之间方位向偏差Δdi<0,即路径2与磁条Bi的交点相比路径1与磁条Bi的交点在方位轴上坐标值更小。
此外,还存在第三种情况:θi<0,Δdi>0,如图6(a)、6(b)所示;以及第四总情况:θi>0,Δdi<0,如图7(a)、7(b)所示。
因此,根据以上方法可以得到平衡车路径2与路径1之间的角度偏差θi和方位向偏差Δdi。
第四步,根据上步中得到的偏差值判断是否需要路径校正,如不需校正,则继续行进;如需要校正,则根据平衡车当前位置换算出校正参数,校正位置和姿态后继续行进。具体校正参数的计算及路径校正方法如下。
如附图8所示,假设行进至Ei1时平衡车停止行进准备路径校正,此时由里程计记下的|Ni2Ei1|为ΔLmi,则有
联立以上两式可得
Δyi=Δdi-ΔLmisinθi
即校正过程为平衡车逆时针方向旋转φi角度后沿方位向行进Δyi后再顺时针旋转90°,此时即回到预定标准路径1上,且为正确姿态。
假设平衡车行至Ei2时停止行进准备路径校正,校正参数计算如下
Δyi=(|Ni2Ei2|-|Ni2Ti|)sinθi=ΔLmisinθi-Δdi
校正过程为平衡车逆时针方向旋转φi角度后沿方位向负方向行进Δyi后再逆时针旋转90°,此时即回到预定标准路径1上,且为正确姿态。
依据上步中规定的方位向正方向和角度正方向,上述两种情况可概括如下
校正参数为
其中,sgn()表示符号函数,即括号内为正,则函数值为1;括号内为负,则函数值为-1;括号内为0,则函数值为0。校正过程为平衡车方向旋转φi角度后沿方位向行进Δyi后方向再旋转角度,此时即回到预定标准路径1上,且为正确姿态。
针对附图6与附图7中的两种情况上述校正方法仍成立。
第五步,令i=i+1,行进至下一个校正区时重复步骤二~步骤四,直至i=K+1,完成巡逻路径2中的所有路径校正,结束本轮巡逻过程。
Claims (7)
1.一种基于里程计和磁传感器的两轮平衡车路径校正装置,包括相互连接的控制器和两轮平衡车驱动机构,其特征在于,所述的装置还包括两个里程计、两个磁传感器和多个校正区,所述的两个里程计和两个磁传感器分别与控制器连接,两轮平衡车的左轮和右轮各安装一个里程计和一个磁传感器,每个校正区包括两个相互不平行也不相交的磁条,所述的磁条位置固定,并与两轮平衡车的标准路径交叉,
两轮平衡车从起点开始按记忆路径行驶,记忆路径按照标准路径生成,当两轮平衡车行驶至校正区,磁传感器感应到车轮压过磁条时,控制器读取里程计的实时数据,根据实时数据与该校正区的标准数据计算当前的实际路径与标准路径之间的偏差,并根据偏差进行路径校正,使两轮平衡车回到标准路径,然后继续行驶至下一个校正区或结束行驶,其中,标准数据获取方法包括:两轮平衡车从起点严格沿标准路径行驶,经过校正区内磁条时,由控制器记录两个里程计的数据作为该校正区的标准数据。
2.根据权利要求1所述的一种基于里程计和磁传感器的两轮平衡车路径校正装置,其特征在于,所述的装置还包括设置在两轮平衡车路径上的充电桩,所述的充电桩作为两轮平衡车行驶的起点。
3.一种使用权利要求1或2所述的基于里程计和磁传感器的两轮平衡车路径校正装置进行路径校正的方法,其特征在于,包括以下步骤:
S1,两轮平衡车从起点开始启动,按记忆路径行驶,两轮平衡车行驶的实际路径与标准路径之间存在偏差;
S2,车轮压过磁条时,该车轮上的磁传感器向控制器发送信号,控制器读取该车轮上里程计的实时数据,并返回步骤S2,直到控制器读取到四个实时数据,该校正区内的实时数据读取完毕;
S3,控制器根据四个实时数据,计算两轮平衡车当前的实际路径与标准路径之间的偏差,并判断是否进行路径校正,若是,则进入步骤S4,否则继续按记忆路径行驶并返回步骤S2,或者结束行驶;
S4,两轮平衡车暂停行驶,根据偏差计算校正参数并根据校正参数移动至标准路径,然后继续按记忆路径行驶并返回步骤S2。
4.根据权利要求3所述的方法,其特征在于,所述的步骤S2中,当车轮经过磁条时,磁传感器检测到连续变化的磁感应强度,当磁感应强度最大时,磁传感器向控制器发送信号,控制器读取对应里程计数据。
5.根据权利要求3所述的方法,其特征在于,所述的步骤S3中,若偏差小于设定值,则不进行路径校正,两轮平衡车继续朝标准路径行驶并返回步骤S2,若当前校正区为最后一个校正区,则不进行路径校正,两轮平衡车结束行驶,否则进入步骤S4。
6.根据权利要求3所述的方法,其特征在于,所述的步骤S4中,第i个校正区内,当前实际路径与标准路径之间的偏差包括角度偏差θi和方位向偏差Δdi,计算式分别为:
θi=βAi-αAi
其中,βAi为第i个校正区内车轮第一次压过的磁条与当前实际路径之间的夹角,αAi为第i个校正区内车轮第一次压过的磁条与标准路径之间的夹角,αBi为第i个校正区内车轮第二次压过的磁条与标准路径之间的夹角,ΔLi1为第i个校正区内的标准路径与两个磁条交点之间的距离,ΔLi2为第i个校正区内实际路径与两个磁条交点之间的距离;
校正参数Δyi和的计算式分别为:
Δyi=ΔLmisinθi-Δdi
其中,ΔLmi为第i个校正区内,当前实际路径与车轮第二次压过的磁条之间交点到实际路径上的待校正点之间的距离,sgn(*)为符号函数;
两轮平衡车根据校正参数移动至标准路径的具体方法为:两轮平衡车方向逆时针旋转φi角度后,沿方位向所在直线向标准路径行进|Δyi|,再逆时针旋转角度,回到标准路径和正确姿态,所述的方位向与标准路径方向垂直。
7.根据权利要求6所述的方法,其特征在于,所述的第i个校正区内标准路径与两个磁条交点之间的距离ΔLi1计算式为:
其中,LLi为平衡车左轮在经过两磁条之间这段时间内左轮里程计的里程记录值,LRi为平衡车右轮在经过两磁条之间这段时间内右轮里程计的里程记录值;
第i个校正区内实际路径与两个磁条交点之间的距离ΔLi2计算原理与ΔLi1相同。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610635671.4A CN106325269B (zh) | 2016-08-05 | 2016-08-05 | 基于里程计和磁传感器的两轮平衡车路径校正装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610635671.4A CN106325269B (zh) | 2016-08-05 | 2016-08-05 | 基于里程计和磁传感器的两轮平衡车路径校正装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106325269A true CN106325269A (zh) | 2017-01-11 |
CN106325269B CN106325269B (zh) | 2019-06-11 |
Family
ID=57739493
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610635671.4A Active CN106325269B (zh) | 2016-08-05 | 2016-08-05 | 基于里程计和磁传感器的两轮平衡车路径校正装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106325269B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107085430A (zh) * | 2017-05-24 | 2017-08-22 | 深圳优地科技有限公司 | 一种轮式机器人参数调校的优化方法、装置和*** |
CN110210305A (zh) * | 2019-04-30 | 2019-09-06 | 驭势(上海)汽车科技有限公司 | 行驶路径偏差确定方法及装置、存储介质及电子装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997040398A2 (en) * | 1996-04-25 | 1997-10-30 | Sirf Technology, Inc. | Spread spectrum receiver with multi-bit correlator |
CN102269995A (zh) * | 2011-06-22 | 2011-12-07 | 重庆大学 | 轮式移动机器人的变结构控制方法 |
CN104848851A (zh) * | 2015-05-29 | 2015-08-19 | 山东鲁能智能技术有限公司 | 基于多传感器数据融合构图的变电站巡检机器人及其方法 |
CN105511456A (zh) * | 2014-09-23 | 2016-04-20 | 苏州宝时得电动工具有限公司 | 自动行走设备控制方法及自动工作*** |
CN105607635A (zh) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制***及全向自动导引车 |
-
2016
- 2016-08-05 CN CN201610635671.4A patent/CN106325269B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997040398A2 (en) * | 1996-04-25 | 1997-10-30 | Sirf Technology, Inc. | Spread spectrum receiver with multi-bit correlator |
CN102269995A (zh) * | 2011-06-22 | 2011-12-07 | 重庆大学 | 轮式移动机器人的变结构控制方法 |
CN105511456A (zh) * | 2014-09-23 | 2016-04-20 | 苏州宝时得电动工具有限公司 | 自动行走设备控制方法及自动工作*** |
CN104848851A (zh) * | 2015-05-29 | 2015-08-19 | 山东鲁能智能技术有限公司 | 基于多传感器数据融合构图的变电站巡检机器人及其方法 |
CN105607635A (zh) * | 2016-01-05 | 2016-05-25 | 东莞市松迪智能机器人科技有限公司 | 自动导引车全景光学视觉导航控制***及全向自动导引车 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107085430A (zh) * | 2017-05-24 | 2017-08-22 | 深圳优地科技有限公司 | 一种轮式机器人参数调校的优化方法、装置和*** |
CN110210305A (zh) * | 2019-04-30 | 2019-09-06 | 驭势(上海)汽车科技有限公司 | 行驶路径偏差确定方法及装置、存储介质及电子装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106325269B (zh) | 2019-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11679760B2 (en) | Navigation in vehicle crossing scenarios | |
CN101033978B (zh) | 智能汽车辅助导航和自动兼辅助驾驶*** | |
CN109520498B (zh) | 一种用于虚拟轨道车辆的虚拟道岔***及方法 | |
CN103204162B (zh) | 具有有效后转向的车道跟踪*** | |
CN107085938B (zh) | 基于车道线与gps跟随的智能驾驶局部轨迹容错规划方法 | |
Goldbeck et al. | Lane following combining vision and DGPS | |
CN102538781B (zh) | 基于机器视觉和惯导融合的移动机器人运动姿态估计方法 | |
US8190330B2 (en) | Model based predictive control for automated lane centering/changing control systems | |
CN102393744B (zh) | 一种无人驾驶汽车的导航方法 | |
Qin et al. | Curb-intersection feature based monte carlo localization on urban roads | |
CN104537829A (zh) | 一种用于智能交通物理仿真平台的智能小车及定位方法 | |
CN110307850A (zh) | 航迹推算定位方法及自动泊车*** | |
CN109946732A (zh) | 一种基于多传感器数据融合的无人车定位方法 | |
TWI656519B (zh) | 停車導引系統及其方法與自動停車系統 | |
CN110531750A (zh) | 用于自动驾驶车辆的pid嵌入式lqr | |
CN108628324A (zh) | 基于矢量地图的无人车导航方法、装置、设备及存储介质 | |
CN106696961A (zh) | 高速公路自动驾驶上下匝道控制***及方法 | |
CN107272008A (zh) | 一种带惯性补偿的agv激光导航*** | |
CN103777220A (zh) | 基于光纤陀螺、速度传感器和gps的实时精确位姿估计方法 | |
CN103592944A (zh) | 一种超市购物机器人及其行进路径规划方法 | |
CN108919802A (zh) | 无人驾驶的车辆行驶和装置 | |
CN108036792A (zh) | 一种用于移动机器人的里程计与测量位姿的数据融合方法 | |
US20230127230A1 (en) | Control loop for navigating a vehicle | |
CN108398951A (zh) | 一种多传感器信息融合的机器人姿态测量方法与装置 | |
CN109927721A (zh) | 车道维持追随*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |