CN106248103B - 一种agv行驶路程测量方法 - Google Patents
一种agv行驶路程测量方法 Download PDFInfo
- Publication number
- CN106248103B CN106248103B CN201610784925.9A CN201610784925A CN106248103B CN 106248103 B CN106248103 B CN 106248103B CN 201610784925 A CN201610784925 A CN 201610784925A CN 106248103 B CN106248103 B CN 106248103B
- Authority
- CN
- China
- Prior art keywords
- measurement
- agv
- distance
- wheel
- wheels
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C22/00—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Measurement Of Distances Traversed On The Ground (AREA)
Abstract
本发明属于AGV行驶路程测量领域,具体为一种AGV行驶路程测量方法,包括以下步骤:(1)应用测量装置测量出AGV两个车轮的测量运行路程Sa和Sb;(2)测量小车实际运行路程与测量运行路程的校正系数K;(3)根据两个车轮的测量运行路程Sa和Sb和校正系数K求出AGV的实际运行路程S。本发明通过确定校正系数K,使小车实际运行路程与测量运行路程得出准确的对应关系。求算AGV实际运行路程时,只需测量车轮的测量运行路程,方法简单,而且可忽略变化负载对车轮结构、形态的影响。因此,与现有技术相比,本发明具有测量简单、准确的优点。
Description
技术领域
本发明属于AGV行使路程路程测量领域,具体为一种AGV行驶路程测量方法。
背景技术
现有技术中,为了测量AGV行进路程,通常采用以下方法:将转数测量装置与AGV的轮子相连,通过转数测量装置的轮子转动圈数,结合轮子半径或者周长,计算出轮子行进的路程。但是,当AGV负载出现变化时,车轮的结构会出现一定程度的变化,简单的利用单个轮子转数和轮子原半径或周长数据计算轮子行进路程,求出AGV的行走路程,误差会比较大,尤其在导航过程中,该种误差不断积累,将很大程度低降低导航的准确性。
为了克服这一误差,本领域技术人员通常使用两种方式处理。其一是将需要测距的轮子设计成带弹簧或板簧等弹性机构的组合体,AGV的额外负载重量由其他非测量轮承受,而测量轮因弹性机构的形变程度基本不变,因此测量轮受力基本稳定。但是该种方法容易受到安装空间限制、整车多轮运动学约束限制,等等,因此实际可使用的场合有限。另一种方法是,通过预先测量出负载重量与车轮形变的关系,运行时再根据实际测量所得的当前负载重量对转数测量装置采集得的数据进行修正,最后计算出车轮的行进路程。但是该种方法需要额外添加测量装置,而且AGV行驶过程中的上下震动会对负载重量的测量造成较大影响。因此,如何能忽略负载重量变化的影响,通过简单的方法实现准确测量AGV行进路程是本领域的研发难题。
发明内容
本发明的目的在于克服现有技术的不足,提供一种测量简单、准确的确定AGV行驶路程测量方法。
为了解决上述技术问题,本发明提供以下技术方案:一种AGV行驶路程测量方法,包括以下步骤:
(1)应用测量装置测量出AGV两个车轮的测量运行路程Sa和Sb;
(2)测量小车实际运行路程与测量运行路程的校正系数K;
(3)根据两个车轮的测量运行路程Sa和Sb和校正系数K求出AGV的实际运行路程S。
本发明通过确定校正系数K,使小车实际运行路程与测量运行路程得出准确的对应关系。求算AGV实际运行路程时,只需测量车轮的测量运行路程,方法简单,而且可忽略变化负载对车轮结构、形态的影响。因此,与现有技术相比,本发明具有测量简单、准确的优点。
测量运行路程Sa和Sb的获取有以下两种方式:
第一种获取方式:采用转数测量装置作为测量装置,测量两个车轮的转数M和N,以及两个车轮的半径R1和R2;根据M、N、R1和R2,求出两个车轮测量运行路程Sa和Sb;
第二种获取方式:采用转速测量装置和计时器作为测量装置,测量两个车轮的转速P和Q,转动时间T,以及两个车轮的半径R1和R2;根据P、Q、T、R1和R2,求出两个车轮测量运行路程Sa和Sb。
对于校正系数K本发明提供两种测量方式:
第一种校正系数K的测量方法为:
所述校正系数K的测量方法为:控制AGV行走固定路程S′,分别测量出AGV两个车轮的测量运行路程Sa和Sb,根据公式:求出校正系数K。
第二种校正系数K的测量方法为:所述校正系数K的测量方法包括以下步骤:
a、测量车体无负载下的状态下:AGV两个车轮的水平距离Lc,AGV两个车轮所受地面的支持力Fa0和Fb0;
b、测量车体被放置负载的状态下:和负载较接近的车轮与负载重心的水平距离Lx;AGV两个车轮所受地面的支持力Fa和Fb;
c、控制AGV行走固定路程S′,分别测量两个车轮的测量运行路程Sa和Sb;
d、根据公式:S′-Sa=Ka×(Fa-Fa0);S′-Sb=Kb×(Fb-Fb0);分别求出两个车轮的受力测量偏差Ka和Kb;
e、根据公式:求出校正系数K。
为了提高校正系数K的测量,可以采用多次重复测量,求取有效数据平均值的方法,得出准确程度更高的校正系数K。或者,采用两种方法混合使用的方法,求取有效数据平均值的方法,得出准确程度更高的校正系数K。
进一步的,得出校正系数K后,采用公式:求出AGV实际运行路程S。
进一步的,控制AGV行走固定路程S′时,AGV行走的轨迹为直线,提高Sa和Sb测量的准确程度。
进一步的,所述负载重心与两个测量车轮之间的连线的中点不在同一竖直方向上。使负载对两个车轮的受力变形影响不相同。
进一步的,所述负载中心与测量的车轮中心不在同一竖直方向上,使Lx≠0,Lx≠-Lc。
进一步的,AGV的两个车轮相同,则校正系数由于两个车轮相同,两者的受力测量偏差Ka和Kb相同,因此得出上述校正系数K的求算公式,由公式可知,测量方法可简化为测量Lc和Lx,使测量、运算更方便。
进一步的,所述测量的两个车轮为纵向设置的两个车轮或横向设置的两个车轮,可根据AGV实际的车轮设置方式,选取测量的对象。
优选的,所述测量的车轮为多个;
对于通过测量转数确定测量运行路程Sa和Sb的方法:分别选取两排的车轮进行测量,根据各个车轮的测量转数,及车轮的半径,推算每排车轮的等效车轮的测量运行路程Sa和Sb;
对于通过测量转速和时间确定测量运行路程Sa和Sb的方法:分别选取两排的车轮进行测量,根据各个车轮的测量转速、运行时间T,及车轮的半径,推算每排车轮的等效车轮的测量运行路程Sa和Sb。
附图说明
图1为实施例一中应用本发明的AGV示意图;
图2为实施例二中应用本发明的AGV示意图。
具体实施方式
以下结合附图说明本发明的两种优选的实施方式。
实施例一:
一种AGV行驶路程测量方法,包括以下步骤:
(1)预处理步骤:
a、测量车体无负载下的状态下:AGV前车轮和后车轮的水平距离Lc,AGV前车轮和后车轮所受地面的支持力Fa0和Fb0,以及两个车轮的半径R1和R2;
b、测量车体被放置负载的状态下:负载重心与无负载时车体重心的水平距离Lx;AGV前车轮和后车轮所受地面的支持力Fa和Fb;所述负载重心与两个测量车轮之间的连线的中点不在同一竖直方向上,使负载对两个车轮的受力变形影响不相同;所述负载中心与测量的车轮中心不在同一竖直方向上,使Lx≠0,Lx≠-Lc。
c、在行进AGV前后两侧的车轮上分别设有转数测量装置,控制AGV行走固定路程S′,根据转数测量装置记录数据M和N以及R1和R2,分别求出两个车轮的测量运行路程Sa和Sb。控制AGV行走固定路程S′时,AGV行走的轨迹为直线,确保Sa和Sb测量值的准确性。根据公式:S′-Sa=Ka×(Fa-Fa0);S′-Sb=Kb×(Fb-Fb0);分别求出两个车轮的受力测量偏差Ka和Kb;
d、根据公式:求出校正系数K。
对于本步骤中,前车轮和后车轮的水平距离Lc,负载重心与无负载时车体重心的水平距离Lx,两个车轮的半径R1和R2等数据在设计AGV时即已确定,可无需测量,直接获取。
(2)测量步骤:
驱动AGV按所需运行轨迹行走,根据编转数测量装置记录数据M和N以及R1和R2,分别求出两轮的行走路程Sa和Sb,根据公式:求出AGV实际运行路程S,其中K为预处理步骤中的校正系数K。
本实施例通过控制变量法,验证本发明提供的测距方法,具体结构如下表1及表2,其中表1固定设置AGV运行路程S′,进行不同负载的测试;表2固定设置AGV负载,进行不同运行路程S′的测试:
表1
表2
由上表可以看出,利用Sa、Sb和修正系数K,推算的实际运行路程S,与测验实际限定的固定路程S′,虽然存在一定的误差,但与单个车轮的测量值(Sa或Sb)相比,误差极小。大大提高了AGV导航推算的精度。而且通过实验,AGV的负载变化并不影响本实施的测量准确度,行驶距离的增大也未明显降低测量精度。。
以下提供本实施方式中,具体公式的推算过程:
当存在额外负载时(Gx≠0),转数测量装置测得的数据有如下关系:
Sa=S×ksa (1)
Sb=S×ksb (2)
ksa和ksb为前车轮和后车轮在承载负载下的各自的变化比例。
通过简单的测试即可验证,转数测量装置的测量值Sb和Sb的偏差大小,与车轮所受压力的变化大小,呈比例关系,因此有如下关系:
S-Sa=Ka×(Fa-Fa0) (3)
S-Sb=Kb×(Fb-Fb0) (4)
其中,Fa0和Fb0是当Gx=0时两个轮子各自受到的地面的支撑力。Ka和Kb代表轮子各自的“受力-测量偏差”关系,对确定的某款车轮而言,为常量。
为了简化上述关系式,定义Fa和Fa0、Fb0和Fb之间的关系:
联立上述关系式(1)—(6),则有:
参见附图1所示,空载时车体重心为O,重力为Gc,前车轮和后车轮与车体重心O的距离分别为La和Lb。负载为X,负载X重心O’与前车轮的水平距离Lx。
当Gx=0时,由附图1的力矩平衡有:
Fa0×(La+Lb)=Gc×Lb (8)
Fb0×(La+Lb)=Gc×La (9)
当Gx≠0时,由附图1的力矩平衡有:
Fa×(La+Lb)=Gc×Lb+Gx×(Lx+La+Lb) (10)
Fb×(La+Lb)+Gx×Lx=Gc×La (11)
联立等式(8)(9)(10)(11),有:
Gx×(Lx+La+Lb)=Fa0×(kFa-1)×(La+Lb) (12)
Gx×Lx=Fb0×(1-kFb)×(La+Lb) (13)(
联立等式(7)(12)(13),有:
因等式(14)右侧均为常量,令Lc=La+Lb,则右侧可简记为常量同时由此可知,等式左侧的数值大小也恒定为K,有
联解等式(1)(2)(14)(15),得:
其中常量或
实施例二:
参见图2,本实施例公开另一种测量方法,与实施例的区别在于:所述测量的车轮为多个;
对于通过测量转数确定测量运行路程Sa和Sb的方法:分别选取两排的车轮进行测量,根据各个车轮的测量转数,及车轮的半径,推算每排车轮的等效车轮的测量运行路程Sa和Sb;
对于通过测量转速和时间确定测量运行路程Sa和Sb的方法:分别选取两排的车轮进行测量,根据各个车轮的测量转速、运行时间T,及车轮的半径,推算每排车轮的等效车轮的测量运行路程Sa和Sb。
参见图2,所述等效车轮的测量运行路程推算方法可以为(但不限于):分别有两排车轮,分别为A和B,其中A为定向轮,负载X的重心O’与B排车轮的轴线的垂直连线为q。当A排的车轮对称设置在q的两侧,A排的车轮滚动方向平行于q,则可以将A排各车轮测得的运行路程的平均值作为该排车轮的等效车轮测量运行路程。当两排车轮并非相对q对称设置,则可按照一定的比例调节,推算出该排车轮的等效车轮测量运行路程。
其余测量方法与实施例一公开的方式相同,在此不再叙述。
根据上述说明书的揭示和教导,本发明所属领域的技术人员还可以对上述实施方式进行变更和修改。因此,本发明并不局限于上面揭示和描述的具体实施方式,对本发明的一些修改和变更也应当落入本发明的权利要求的保护范围内。此外,尽管本说明书中使用了一些特定的术语,但这些术语只是为了方便说明,并不对本发明构成任何限制。
Claims (9)
1.一种AGV行驶路程测量方法,其特征在于:包括以下步骤:
(1)应用测量装置测量出AGV两个车轮的测量运行路程Sa和Sb;
(2)测量小车实际运行路程与测量运行路程的校正系数K;
其中,所述校正系数K的测量方法包括以下步骤:
a、测量车体无负载下的状态下:AGV两个车轮的水平距离Lc,AGV两个车轮所受地面的支持力Fa0和Fb0;
b、测量车体被放置负载的状态下:和负载较接近的车轮与负载重心的水平距离Lx;AGV两个车轮所受地面的支持力Fa和Fb;
c、控制AGV行走固定路程S′,分别测量两个车轮的测量运行路程Sa和Sb;
d、根据公式:S′-Sa=Ka×(Fa-Fa0);S′-Sb=Kb×(Fa-Fb0);分别求出两个车轮的受力测量偏差Ka和Kb;
e、根据公式:求出校正系数K;
(3)根据两个车轮的测量运行路程Sa和Sb和校正系数K求出AGV的实际运行路程S。
2.根据权利要求1所述的一种AGV行驶路程测量方法,其特征在于:所述步骤(1)的测量装置为转数测量装置,测量两个车轮的转数M和N以及两个车轮的半径R1和R2;根据M、N、R1和R2,求出两个车轮测量运行路程Sa和Sb;
或者,所述步骤(1)的测量装置包括转速测量装置和计时器,测量两个车轮的转速P和Q、转动时间T以及两个车轮的半径R1和R2;根据P、Q、T、R1和R2,求出两个车轮测量运行路程Sa和Sb。
3.根据权利要求2所述的一种AGV行驶路程测量方法,其特征在于:
得出校正系数K后,采用公式:求出AGV实际运行路程S。
4.根据权利要求3所述的一种AGV行驶路程测量方法,其特征在于:控制AGV行走固定路程S′时,AGV行走的轨迹为直线。
5.根据权利要求3所述的一种AGV行驶路程测量方法,其特征在于:所述负载重心与两个测量车轮之间的连线的中点不在同一竖直方向上。
6.根据权利要求3所述的一种AGV行驶路程测量方法,其特征在于:所述负载重心与测量的车轮中心不在同一竖直方向上。
7.根据权利要求1所述的一种AGV行驶路程测量方法,其特征在于:AGV的两个车轮相同,则校正系数
8.根据权利要求3所述的一种AGV行驶路程测量方法,其特征在于:所述测量的两个车轮为纵向设置的两个车轮或横向设置的两个车轮。
9.根据权利要求8所述的一种AGV行驶路程测量方法,其特征在于:所述测量的车轮为多个;
对于通过测量转数确定测量运行路程Sa和Sb的方法:分别选取两排的车轮进行测量,根据各个车轮的测量转数,及车轮的半径,推算每排车轮的等效车轮的测量运行路程Sa和Sb;
对于通过测量转速和时间确定测量运行路程Sa和Sb的方法:分别选取两排的车轮进行测量,根据各个车轮的测量转速、运行时间T,及车轮的半径,推算每排车轮的等效车轮的测量运行路程Sa和Sb。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610784925.9A CN106248103B (zh) | 2016-08-31 | 2016-08-31 | 一种agv行驶路程测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610784925.9A CN106248103B (zh) | 2016-08-31 | 2016-08-31 | 一种agv行驶路程测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106248103A CN106248103A (zh) | 2016-12-21 |
CN106248103B true CN106248103B (zh) | 2019-09-20 |
Family
ID=58080318
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610784925.9A Active CN106248103B (zh) | 2016-08-31 | 2016-08-31 | 一种agv行驶路程测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106248103B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109655031A (zh) * | 2019-02-11 | 2019-04-19 | 芯球(上海)智能科技有限责任公司 | Agv车的车轮半径检测系统及检测方法 |
CN114353822B (zh) * | 2022-01-11 | 2024-05-24 | 深圳市几米物联有限公司 | 一种挂车里程的记录方法、挂车及记录系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003067052A (ja) * | 2001-08-30 | 2003-03-07 | Komatsu Forklift Co Ltd | 無人搬送車の実姿勢角検出方法 |
CN103161121A (zh) * | 2013-03-19 | 2013-06-19 | 南京道润交通科技有限公司 | 里程桩号自动校正方法、系统及装置 |
CN103688226A (zh) * | 2011-06-06 | 2014-03-26 | 克朗设备有限公司 | 用于自动校准车辆参数的方法和装置 |
CN104678128A (zh) * | 2013-11-29 | 2015-06-03 | 北汽福田汽车股份有限公司 | 汽车车速表、里程表检验校正试验系统和方法 |
-
2016
- 2016-08-31 CN CN201610784925.9A patent/CN106248103B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003067052A (ja) * | 2001-08-30 | 2003-03-07 | Komatsu Forklift Co Ltd | 無人搬送車の実姿勢角検出方法 |
CN103688226A (zh) * | 2011-06-06 | 2014-03-26 | 克朗设备有限公司 | 用于自动校准车辆参数的方法和装置 |
CN103161121A (zh) * | 2013-03-19 | 2013-06-19 | 南京道润交通科技有限公司 | 里程桩号自动校正方法、系统及装置 |
CN104678128A (zh) * | 2013-11-29 | 2015-06-03 | 北汽福田汽车股份有限公司 | 汽车车速表、里程表检验校正试验系统和方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106248103A (zh) | 2016-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103632062B (zh) | 一种车辆行驶上下坡状态判定的方法和装置 | |
CN104590414B (zh) | 一种具有相对位姿检测功能的全方位轮式移动机器人 | |
CN106289327B (zh) | 一种差分移动机器人里程计标定方法 | |
Du et al. | Measurement of international roughness index by using-axis accelerometers and GPS | |
CN106843214B (zh) | 一种基于自抗扰控制的磁带导引agv循迹控制方法 | |
CN109870173A (zh) | 一种基于校验点的海底管道惯性导航系统的轨迹修正方法 | |
CN109297486B (zh) | 惯性与多里程计信息辅助的车体运动状态判定方法及系统 | |
CN106248103B (zh) | 一种agv行驶路程测量方法 | |
CN103217157A (zh) | 一种惯导/里程计自主组合导航方法 | |
CN103093088A (zh) | 陡坡和弯曲道路的安全评估方法 | |
CN105445040B (zh) | 一种用于测试多轴车辆转向性能的实验台架 | |
CN101105503A (zh) | 捷联式惯导测量组合中加速度计装配误差标量修正方法 | |
CN102261033A (zh) | 一种基于惯性测量单元的车载路面检测系统的运补算法 | |
JP7344895B2 (ja) | 車両に装備されたジャイロメータの較正方法 | |
CN103363989B (zh) | 一种捷联惯导系统内杆臂的估计与误差补偿方法 | |
CN109552417A (zh) | 一种驱动轮角度零偏的校准方法及系统 | |
CN108413946A (zh) | 一种车载全站仪位置参数的测量方法 | |
CN106052568A (zh) | 丝杠型面检测装置位移传感器系统安装误差的补偿方法 | |
CN104132664A (zh) | 一种农用履带机器人滑动量的估计方法 | |
CN103454607B (zh) | 磁场传感器信号的校正方法和基于该方法的车辆导航系统 | |
KR20110109606A (ko) | 차량의 경사각 측정방법 및 그 측정장치 | |
CN103940443B (zh) | 一种陀螺仪误差标定的方法 | |
CN204479306U (zh) | 直驱机械臂式单轮主销内倾角和主销后倾角校准装置 | |
CN114162170B (zh) | 一种轨道测量系统及测量方法 | |
CN204854706U (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |