CN111930126A - 一种基于差速轮组agv的导航纠偏方法 - Google Patents
一种基于差速轮组agv的导航纠偏方法 Download PDFInfo
- Publication number
- CN111930126A CN111930126A CN202010842964.6A CN202010842964A CN111930126A CN 111930126 A CN111930126 A CN 111930126A CN 202010842964 A CN202010842964 A CN 202010842964A CN 111930126 A CN111930126 A CN 111930126A
- Authority
- CN
- China
- Prior art keywords
- speed
- wheel set
- agv
- differential
- target
- 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 37
- 238000001514 detection method Methods 0.000 claims description 9
- 238000000354 decomposition reaction Methods 0.000 claims description 5
- 238000012937 correction Methods 0.000 abstract description 11
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012827 research and development 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
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
- G05D1/0263—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种基于差速轮组AGV的导航纠偏方法,包括以下步骤:给定AGV的Y方向速度Vy;通过前磁导航传感器和后磁导航传感器实时采集导航磁条信息,通过绝对值编码器实时检测各差速轮组的当前航向角;根据前磁导航传感器和后磁导航传感器的位置,计算AGV中心相对导航磁条的偏移量DP和航向偏角AP;根据DP和AP计算纠偏速度Vx和纠偏转速w;根据Vy、Vx和w计算各差速轮组的目标速度及目标航向角;根据各自的目标速度、目标航向角和当前航向角计算各差速轮组左驱动轮和右驱动轮的目标角速度;根据各差速轮组左驱动轮和右驱动轮的目标角速度控制对应驱动电机的转速。其具有流程简单、执行速度快、纠偏精度高、稳定可靠的优点。
Description
技术领域
本发明涉及一种AGV导航***,具体涉及一种基于差速轮组AGV的导航纠偏方法。
背景技术
随着科技和社会的发展,AGV(自动引导运输车)得到了快速发展和广泛应用。采用麦克纳姆轮的AGV具有全向移动、控制方便的优点,但也存在着载荷小的缺陷。而差速轮组AGV具有载荷大的特点,通常应用在航空、航天等重载运输领域,但传统的遥控操作方式影响了差速轮组AGV的效能,基于麦克纳姆轮AGV的导航***或纠偏方法也不适用不能连续全向运动的差速轮组AGV,因此,亟需研发一种适用差速轮组AGV的导航纠偏***或方法,以提高其自动化程度和适用范围。
发明内容
本发明的目的是提供一种基于差速轮组AGV的导航纠偏方法,其具有流程简单、执行速度快、纠偏精度高、稳定可靠的优点。
为解决现有技术中存在的上述问题,本发明提供了一种基于差速轮组AGV的导航纠偏方法,所述AGV安装有四个呈中心对称分布的差速轮组,差速轮组设有对称分布的左驱动轮和右驱动轮,AGV还安装有前后对称分布的前磁导航传感器和后磁导航传感器,其特征在于,所述导航纠偏方法包括以下步骤:
S1、以AGV自身坐标系为车身坐标系,车中心为原点,正前方为Y方向,正右方为X方向;给定AGV的Y方向速度Vy;
S2、通过前磁导航传感器和后磁导航传感器实时采集导航磁条信息,通过绝对值编码器实时检测各差速轮组的当前航向角;
S3、根据前磁导航传感器和后磁导航传感器的位置,计算AGV中心相对导航磁条的偏移量DP和航向偏角AP,航向偏角AP是指Vy方向与导航磁条之间形成的夹角;
S4、根据偏移量DP和航向偏角AP计算纠偏速度Vx和纠偏转速w,Vx方向与Vy方向垂直,w是指AGV绕中心的旋转速度;
S5、采用速度分解法将Vy、Vx和w分解到各差速轮组,以得到各差速轮组的目标速度和目标航向角;
S6、根据各自的目标速度、目标航向角和当前航向角计算各差速轮组左驱动轮和右驱动轮的目标角速度;
S7、根据各差速轮组左驱动轮和右驱动轮的目标角速度控制对应驱动电机的转速。
进一步的,本发明一种基于差速轮组AGV的导航纠偏方法,其中,在上述步骤S4中,所述纠偏速度Vx和纠偏转速w按以下公式计算获得,
Vx=DP/DP_MAX×Max_Vx (1)
w=AP/AP_MAX×Max_w (2)
公式(1)、(2)中,DP_MAX为最大偏移量,AP_MAX为最大航向偏角,Max_Vx和Max_w为根据Vy设立的可变比例因子。
进一步的,本发明一种基于差速轮组AGV的导航纠偏方法,其中,所述Max_Vx和Max_w按以下公式计算获得,
Max_Vx=tan(AP_MAX/180×π)×Vy (3)
Max_w=tan(AP_MAX/180×π)×Vy/(y-X×(AP_MAX/180×π)) (4)
公式(4)中,x和y为各差速轮组中心坐标的绝对值。
进一步的,本发明一种基于差速轮组AGV的导航纠偏方法,其中,所述DP_MAX为L/2,L为磁导航传感器的长度,所述AP_MAX为3~5°。
进一步的,本发明一种基于差速轮组AGV的导航纠偏方法,其中,在上述步骤S5中,所述各差速轮组的目标速度和目标航向角按以下公式计算获得,
Vx_m=Vx+y_m×w (5)
Vy_m=Vy+x_m×w (6)
α_m=atan(Vx_m/Vy_m) (7)
公式(5)、(6)、(7)中,Vx_m和Vy_m为各差速轮组的目标速度,α_m为各差速轮组的目标航向角,x_m和y_m为各差速轮组中心的坐标。
进一步的,本发明一种基于差速轮组AGV的导航纠偏方法,其中,在上述步骤S6中,所述各差速轮组左驱动轮和右驱动轮的目标角速度按以下公式计算获得,
Speed_m=Vy_m/r (8)
dspeed_m=Speed_m×Scale_m (9)
Speed_m_1=Speed_m+dspeed_m (10)
Speed_m_2=Speed_m-dspeed_m (11)
公式(8)、(9)、(10)、(11)中,Speed_m为基准角速度,dspeed_m为差速值,Scale_m为差速比例因子,Speed_m_1和Speed_m_2为目标角速度,当AGV头部偏左时,左驱动轮的目标角速度为Speed_m_1,右驱动轮的目标角速度为Speed_m_2,当AGV头部偏右时,左驱动轮的目标角速度为Speed_m_2,右驱动轮的目标角速度为Speed_m_1。
进一步的,本发明一种基于差速轮组AGV的导航纠偏方法,其中,所述Scale_m按以下方式获得,
当Δαt_m=0时,Scale_m=0 (12)
当0<|Δα_m|≤K1时,Scale_m=0.15~0.2 (13)
当K1<|Δα_m|<K2时,Scale_m=0.2~0.25 (14)
公式(12)、(13)、(14)中,Δα_m为各差速轮组目标航向角与当前航向角的差值,K1=3.6~4.5,K2=9.6~11。
进一步的,本发明一种基于差速轮组AGV的导航纠偏方法,其中,在上述步骤S3中,所述偏移量DP和航向偏角AP按以下公式计算获得,
DP=FCenter_Value-BCenter_value (15)
AP=FCenter_Value+BCenter_value-n-1 (16)
公式(15)、(16)中,FCenter_Value为前磁导航传感器相对导航磁条的位置,BCenter_value为后磁导航传感器相对导航磁条的位置,n为前磁导航传感器和后磁导航传感器的探测点位数。
本发明一种基于差速轮组AGV的导航纠偏方法与现有技术相比,具有以下优点:本发明在AGV以给定的速度Vy行进过程中,通过前后磁导航传感器实时采集导航磁条信息,通过绝对值编码器实时检测各差速轮组的当前航向角,并根据前后磁导航传感器的位置依次计算偏移量DP、航向偏角AP、纠偏速度Vx、纠偏转速w、各差速轮组的目标速度和目标航向角以及两驱动轮的目标角速度,让控制***根据各差速轮组两驱动轮的目标角速度控制对应驱动电机的转速,即可使Vy方向与导航磁条保持一致,从而实现导航纠偏目的,具有流程简单、执行速度快、纠偏精度高、稳定可靠的优点。
下面结合附图所示具体实施方式对本发明一种基于差速轮组AGV的导航纠偏方法作进一步详细说明。
附图说明
图1为差速轮组AGV的示意图;
图2为本发明一种基于差速轮组AGV的导航纠偏方法的流程图。
具体实施方式
首先需要说明的,本发明中所述的上、下、左、右、前、后等方位词只是根据附图进行的描述,以便于理解,并非对本发明的技术方案及请求保护范围进行的限制。
如图1和图2所示本发明一种基于差速轮组AGV的导航纠偏方法的具体实施方式,AGV安装有四个呈中心对称分布的差速轮组1,差速轮组1设有对称分布的左驱动轮11和右驱动轮12,AGV还安装有前后对称分布的前磁导航传感器2和后磁导航传感器3,导航纠偏方法包括以下步骤:
S1、以AGV自身坐标系为车身坐标系,车中心为原点,正前方为Y方向,正右方为X方向;给定AGV的Y方向速度Vy。
S2、通过前磁导航传感器和后磁导航传感器实时采集导航磁条信息,通过绝对值编码器实时检测各差速轮组的当前航向角。
S3、根据前磁导航传感器和后磁导航传感器的位置,计算AGV中心相对导航磁条的偏移量DP和航向偏角AP,航向偏角AP是指Vy方向与导航磁条之间形成的夹角。
S4、根据偏移量DP和偏移量AP计算纠偏速度Vx和纠偏转速w,Vx方向与Vy方向垂直,w是指AGV绕中心的旋转速度。
S5、采用速度分解法将Vy、Vx和w分解到各差速轮组,以得到各差速轮组的目标速度和目标航向角。
S6、根据各自的目标速度、目标航向角和当前航向角计算各差速轮组左驱动轮和右驱动轮的目标角速度。
S7、根据各差速轮组左驱动轮和右驱动轮的目标角速度控制对应驱动电机的转速。
本发明在AGV以给定的速度Vy行进过程中,通过前后磁导航传感器实时采集导航磁条信息,通过绝对值编码器实时检测各差速轮组的当前航向角,并根据前后磁导航传感器的位置依次计算偏移量DP、航向偏角AP、纠偏速度Vx、纠偏转速w、各差速轮组的目标速度和目标航向角以及两驱动轮的目标角速度,让控制***根据各差速轮组两驱动轮的目标角速度控制对应驱动电机的转速,即可使Vy方向与导航磁条保持一致,从而实现导航纠偏目的,具有流程简单、执行速度快、纠偏精度高、稳定可靠的优点。
作为具体实施方式,在上述步骤S4中,本发明使纠偏速度Vx和纠偏转速w采用了以下公式计算获得,
Vx=DP/DP_MAX×Max_Vx (1)
w=AP/AP_MAX×Max_w (2)
在公式(1)、(2)中,DP_MAX为最大偏移量,AP_MAX为最大航向偏角,Max_Vx和Max_w为根据Vy设立的可变比例因子。
本发明通过设立最大偏移量,并采用DP/DP_MAX作为计算纠偏速度Vx的主要参数,可保证AGV不会脱离导航磁条,通过乘以随Vy变化的可变比例因子Max_Vx,提高了导航纠编的率效和稳定性;同理,本发明通过设立最大航向偏角,并采用AP/AP_MAX作为计算纠偏转速w的主要参数,通过乘以随Vy变化的可变比例因子Max_w,进一步提高了导航纠编的率效和稳定性。
作为具体实施方式,根据速度与夹角的关系,本发明使Max_Vx和Max_w采用了以下公式计算获得,
Max_Vx=tan(AP_MAX/180×π)×Vy (3)
Max_w=tan(AP_MAX/180×π)×Vy/(y-x×(AP_MAX/180×π)) (4)
在公式(4)中,x和y为各差速轮组中心坐标的绝对值。在实际应用中,DP_MAX通常采用L/2,L为磁导航传感器的长度;根据前后磁导航传感器之间的距离,AP_MAX通常取值3~5°。通过采用公式(3)和公式(4)计算的可变比例因子,可避免AGV因差速轮组连续摆动出现晃动,提高了导航纠偏的平顺性。
作为具体实施方式,本发明通过采用速度分解法将AGV中心的Vy,Vx,w分解到各差速轮组,得到了各差速轮组的目标速度及目标航向角,具体分解公式如下,
Vx_m=Vx+y_m×w (5)
Vy_m=Vy+x_m×w (6)
α_m=atan(Vx_m/Vy_m) (7)
在公式(5)、(6)、(7)中,Vx_m和Vy_m为各差速轮组的目标速度,α_m为各差速轮组的目标航向角,x_m和y_m为各差速轮组中心的坐标。
需要说明的是,目标速度是指各差速轮组中心的速度。公式(5)、(6)、(7)是计算各差速轮组的总体公式,具体到差速轮组个体,应根据其自身的坐标进行计算。在实际应用中,本发明通常将右前方的差速轮组规定为1号轮组,其余的按逆时针依次为2号轮组、3号轮组和4号轮组。
1号轮组的目标速度和目标航向角的具体计算公式如下:
Vx_1=Vx+y_1×w (5-1)
Vy_1=Vy+x_1×w (6-1)
α_1=atan(Vx_1/Vy_1) (7-1)
在公式(5-1)、(6-1)、(7-1)中,Vx_1和Vy_1表示1号轮组中心的目标速度,α_1表示1号轮组的目标航向角,x_1和y_1表示1号轮组中心的坐标。
2号轮组的目标速度和目标航向角的具体计算公式如下:
Vx_2=Vx+y_2×w (5-2)
Vy_2=Vy+x_2×w (6-2)
α_2=atan(Vx_2/Vy_2) (7-2)
在公式(5-2)、(6-2)、(7-2)中,Vx_2和Vy_2表示2号轮组中心的目标速度,α_2表示2号轮组的目标航向角,x_2和y_2表示2号轮组中心的坐标。
3号轮组的目标速度和目标航向角的具体计算公式如下:
Vx_3=Vx+y_3×w (5-3)
Vy_3=Vy+x_3×w (6-3)
α_3=atan(Vx_3/Vy_3) (7-3)
在公式(5-3)、(6-3)、(7-3)中,Vx_3和Vy_3表示3号轮组中心的目标速度,α_3表示3号轮组的目标航向角,x_3和y_3表示3号轮组中心的坐标。
4号轮组的目标速度和目标航向角的具体计算公式如下:
Vx_4=Vx+y_4×w (5-4)
Vy_4=Vy+x_4×w (6-4)
α_4=atan(Vx_4/Vy_4) (7-4)
在公式(5-4)、(6-4)、(7-4)中,Vx_4和Vy_4表示4号轮组中心的目标速度,α_4表示4号轮组的目标航向角,x_4和y_4表示4号轮组中心的坐标。
作为具体实施方式,在上述步骤S6中,本发明使各差速轮组左驱动轮和右驱动轮的目标角速度采用了以下公式计算获得,
Speed_m=Vy_m/r (8)
dspeed_m=Speed_m×Scale_m (9)
Speed_m_1=Speed_m+dspeed_m (10)
Speed_m_2=Speed_m-dspeed_m (11)
在公式(8)、(9)、(10)、(11)中,Speed_m为基准角速度,dspeed_m为差速值,Scale_m为差速比例因子,Speed_m_1和Speed_m_2为两个目标角速度,AGV头部偏左时,左驱动轮的目标角速度为Speed_m_1,右驱动轮的目标角速度为Speed_m_2,AGV头部偏右时,左驱动轮的目标角速度为Speed_m_2,右驱动轮的目标角速度为Speed_m_1。
需要指出的是,公式(8)、(9)、(10)、(11)是计算各差速轮组左驱动轮和右驱动轮目标角速度的总体公式,具体到差速轮组个体,应根据其自身的目标速度、目标航向角和当前航向角进行计算。
1号轮组左驱动轮和右驱动轮的目标角速度的具体计算公式如下:
Speed_1=Vy_1/r (8-1)
dspeed_1=Speed_1×Scale_1 (9-1)
Speed_1_1=Speed_1+dspeed_1 (10-1)
Speed_1_2=Speed_1-dspeed_1 (11-1)
在公式(8-1)、(9-1)、(10-1)、(11-1)中,Speed_1为基准角速度,dspeed_1为差速值,Scale_1为差速比例因子,Speed_1_1和Speed_1_2为两个目标角速度,AGV头部偏左时,左驱动轮的目标角速度为Speed_1_1,右驱动轮的目标角速度为Speed_1_2,AGV头部偏右时,左驱动轮的目标角速度为Speed_1_2,右驱动轮的目标角速度为Speed_1_1。
2号轮组左驱动轮和右驱动轮的目标角速度的具体计算公式如下:
Speed_2=Vy_2/r (8-2)
dspeed_2=Speed_2×Scale_2 (9-2)
Speed_2_1=Speed_2+dspeed_2 (10-2)
Speed_2_2=Speed_2-dspeed_2 (11-2)
在公式(8-2)、(9-2)、(10-2)、(11-2)中,Speed_2为基准角速度,dspeed_2为差速值,Scale_2为差速比例因子,Speed_2_1和Speed_2_2为两个目标角速度,AGV头部偏左时,左驱动轮的目标角速度为Speed_2_1,右驱动轮的目标角速度为Speed_2_2,AGV头部偏右时,左驱动轮的目标角速度为Speed_2_2,右驱动轮的目标角速度为Speed_2_1。
3号轮组左驱动轮和右驱动轮的目标角速度的具体计算公式如下:
Speed_3=Vy_3/r (8-3)
dspeed_3=Speed_3×Scale_3 (9-3)
Speed_3_1=Speed_3+dspeed_3 (10-3)
Speed_3_2=Speed_3-dspeed_3 (11-3)
在公式(8-3)、(9-3)、(10-3)、(11-3)中,Speed_3为基准角速度,dspeed_3为差速值,Scale_3为差速比例因子,Speed_3_1和Speed_3_2为两个目标角速度,AGV头部偏左时,左驱动轮的目标角速度为Speed_3_1,右驱动轮的目标角速度为Speed_3_2,AGV头部偏右时,左驱动轮的目标角速度为Speed_3_2,右驱动轮的目标角速度为Speed_3_1。
4号轮组左驱动轮和右驱动轮的目标角速度的具体计算公式如下:
Speed_4=Vy_4/r (8-4)
dspeed_4=Speed_4×Scale_4 (9-4)
Speed_4_1=Speed_4+dspeed_4 (10-4)
Speed_4_2=Speed_4-dspeed_4 (11-4)
在公式(8-4)、(9-4)、(10-4)、(11-4)中,Speed_4为基准角速度,dspeed_4为差速值,Scale_4为差速比例因子,Speed_4_1和Speed_4_2为两个目标角速度,AGV头部偏左时,左驱动轮的目标角速度为Speed_4_1,右驱动轮的目标角速度为Speed_4_2,AGV头部偏右时,左驱动轮的目标角速度为Speed_4_2,右驱动轮的目标角速度为Speed_4_1。
本发明通过设立差速比例因子计算各差速轮组左驱动轮和右驱动轮的差速值及目标角速度,进一步增强了导航纠偏的稳定性和可靠性。
作为具体实施方式,本发明使Scale_m采用了以下方式获得,
当Δα_m=0时,Scale_m=0 (12)
当0<|Δα_m|≤K1时,Scale_m=0.15~0.2 (13)
当K1<|Δα_m|<K2时,Scale_m=0.2~0.25 (14)
在公式(12)、(13)、(14)中,Δα_m为各差速轮组的目标航向角与当前航向角的差值,K1=3.6~4.5,K2=9.6~11。
1号轮组的差速比例因子的具体计算公式如下:
当Δα_1=0时,Scale_1=0 (12-1)
当0<|Δα_1|≤K1时,Scale_1=0.15~0.2 (13-1)
当K1<|Δα_1|<K2时,Scale_1=0.2~0.25 (14-1)
Δα_1表示1号轮组的目标航向角与当前航向角的差值。
2号轮组的差速比例因子的具体计算公式如下:
当Δα_2=0时,Scale_2=0 (12-2)
当0<|Δα_2|≤K1时,Scale_2=0.15~0.2 (13-2)
当K1<|Δα_2|<K2时,Scale_2=0.2~0.25 (14-2)
Δα_2表示2号轮组的目标航向角与当前航向角的差值。
3号轮组的差速比例因子的具体计算公式如下:
当Δα_3=0时,Scale_3=0 (12-3)
当0<|Δα_3|≤K1时,Scale_3=0.15~0.2 (13-3)
当K1<|Δα_3|<K2时,Scale_3=0.2~0.25 (14-3)
Δα_3表示3号轮组的目标航向角与当前航向角的差值。
4号轮组的差速比例因子的具体计算公式如下:
当Δα_4=0时,Scale_4=0 (12-4)
当0<|Δα_4|≤K1时,Scale_4=0.15~0.2 (13-4)
当K1<|Δα_4|<K2时,Scale_4=0.2~0.25 (14-4)
Δα_4表示4号轮组的目标航向角与当前航向角的差值。
各差速轮组的目标航向角及当前航向角是指其中轴线与Y方向之间形成的夹角。
作为具体实施方式,在上述步骤S3中,本发明使偏移量DP和航向偏角AP采用了以下公式计算获得,
DP=FCenter_Value-BCenter_value (15)
AP=FCenter_Value+BCenter_value-n-1 (16)
在公式(15)、(16)中,FCenter_Value为前磁导航传感器相对导航磁条的位置,BCenter_value为后磁导航传感器相对导航磁条的位置,n为前磁导航传感器和后磁导航传感器的探测点位数。
本发明通过采用FCenter_Value、BCenter_value和n作为计算DP和AP的参数,具有方法简单、效率高的特点。在实际应用中,本发明通常采用16个探测点位的磁导航传感器,并使前磁导航传感器的探测点位由右至左依次排列,使后磁导航传感器的探测点位由左至右依次排列,此时,FCenter_Value表示前磁导航传感器检测到导航路径的探测点位数,BCenter_value表示后磁导航传感器检测到导航路径的探测点位数,n取值16。需要说明的是,前磁导航传感器和后磁导航传感器不限于选用16个探测点位的磁导航传感器。
在实际应用中,当DP<0时,表示AGV中心偏左,当DP>0时,表示AGV中心偏右,设顺时针角度为正,当AP<0时,表示Vy方向与导航磁条之间的夹角为负角,当AP<0时,表示Vy方向与导航磁条之间的夹角为正角。
以上实施例仅是对本发明的优选实施方式进行的描述,并非对本发明请求保护范围进行限定,在不脱离本发明设计构思的前提下,本领域技术人员依据本发明的技术方案做出的各种变形,均应落入本发明的权利要求书确定的保护范围内。
Claims (8)
1.一种基于差速轮组AGV的导航纠偏方法,所述AGV安装有四个呈中心对称分布的差速轮组,差速轮组设有对称分布的左驱动轮和右驱动轮,AGV还安装有前后对称分布的前磁导航传感器和后磁导航传感器,其特征在于,所述导航纠偏方法包括以下步骤:
S1、以AGV自身坐标系为车身坐标系,车中心为原点,正前方为Y方向,正右方为X方向;给定AGV的Y方向速度Vy;
S2、通过前磁导航传感器和后磁导航传感器实时采集导航磁条信息,通过绝对值编码器实时检测各差速轮组的当前航向角;
S3、根据前磁导航传感器和后磁导航传感器的位置,计算AGV中心相对导航磁条的偏移量DP和航向偏角AP,航向偏角AP是指Vy方向与导航磁条之间形成的夹角;
S4、根据偏移量DP和航向偏角AP计算纠偏速度Vx和纠偏转速w,Vx方向与Vy方向垂直,w是指AGV绕中心的旋转速度;
S5、采用速度分解法将Vy、Vx和w分解到各差速轮组,以得到各差速轮组的目标速度和目标航向角;
S6、根据各自的目标速度、目标航向角和当前航向角计算各差速轮组左驱动轮和右驱动轮的目标角速度;
S7、根据各差速轮组左驱动轮和右驱动轮的目标角速度控制对应驱动电机的转速。
2.根据权利要求1所述的一种基于差速轮组AGV的导航纠偏方法,其特征在于,在上述步骤S4中,所述纠偏速度Vx和纠偏转速w按以下公式计算获得,
Vx=DP/DP_MAX×Max_Vx (1)
w=AP/AP_MAX×Max_w (2)
公式(1)、(2)中,DP_MAX为最大偏移量,AP_MAX为最大航向偏角,Max_Vx和Max_w为根据Vy设立的可变比例因子。
3.根据权利要求2所述的一种基于差速轮组AGV的导航纠偏方法,其特征在于,所述Max_Vx和Max_w按以下公式计算获得,
Max_Vx=tan(AP_MAX/180×π)×Vy (3)
Max_w=tan(AP_MAX/180×π)×Vy/(y-x×(AP_MAX/180×π)) (4)
公式(4)中,x和y为各差速轮组中心坐标的绝对值。
4.根据权利要求3所述的一种基于差速轮组AGV的导航纠偏方法,其特征在于,所述DP_MAX为L/2,L为磁导航传感器的长度,所述AP_MAX为3~5°。
5.根据权利要求2所述的一种基于差速轮组AGV的导航纠偏方法,其特征在于,在上述步骤S5中,所述各差速轮组的目标速度和目标航向角按以下公式计算获得,
Vx_m=Vx+y_m×w (5)
Vy_m=Vy+x_m×w (6)
α_m=atan(Vx_m/Vy_m) (7)
公式(5)、(6)、(7)中,Vx_m和Vy_m为各差速轮组的目标速度,α_m为各差速轮组的目标航向角,x_m和y_m为各差速轮组中心的坐标。
6.根据权利要求5所述的一种基于差速轮组AGV的导航纠偏方法,其特征在于,在上述步骤S6中,所述各差速轮组左驱动轮和右驱动轮的目标角速度按以下公式计算获得,
Speed_m=Vy_m/r (8)
dspeed_m=Speed_m×Scale_m (9)
Speed_m_1=Speed_m+dspeed_m (10)
Speed_m_2=Speed_m-dspeed_m (11)
公式(8)、(9)、(10)、(11)中,Speed_m为基准角速度,dspeed_m为差速值,Scale_m为差速比例因子,Speed_m_1和Speed_m_2为目标角速度,当AGV头部偏左时,左驱动轮的目标角速度为Speed_m_1,右驱动轮的目标角速度为Speed_m_2,当AGV头偏右时,左驱动轮的目标角速度为Speed_m_2,右驱动轮的目标角速度为Speed_m_1。
7.根据权利要求6所述的一种基于差速轮组AGV的导航纠偏方法,其特征在于,所述Scale_m按以下方式获得,
当Δα_m=0时,Scale_m=0 (12)
当0<|Δα_m|≤K1时,Scale_m=0.15~0.2 (13)
当K1<|Δα_m|<K2时,Scale_m=0.2~0.25 (14)
公式(12)、(13)、(14)中,Δα_m为各差速轮组目标航向角与当前航向角的差值,K1=3.6~4.5,K2=9.6~11。
8.根据权利要求1所述的一种基于差速轮组AGV的导航纠偏方法,其特征在于,在上述步骤S3中,所述偏移量DP和航向偏角AP按以下公式计算获得,
DP=FCenter_Value-BCenter_value (15)
AP=FCenter_Value+BCenter_value-n-1 (16)
公式(15)、(16)中,FCenter_Value为前磁导航传感器相对导航磁条的位置,BCenter_value为后磁导航传感器相对导航磁条的位置,n为前磁导航传感器和后磁导航传感器的探测点位数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010842964.6A CN111930126B (zh) | 2020-08-20 | 2020-08-20 | 一种基于差速轮组agv的导航纠偏方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010842964.6A CN111930126B (zh) | 2020-08-20 | 2020-08-20 | 一种基于差速轮组agv的导航纠偏方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111930126A true CN111930126A (zh) | 2020-11-13 |
CN111930126B CN111930126B (zh) | 2021-06-01 |
Family
ID=73305920
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010842964.6A Active CN111930126B (zh) | 2020-08-20 | 2020-08-20 | 一种基于差速轮组agv的导航纠偏方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111930126B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848940A (zh) * | 2021-10-18 | 2021-12-28 | 陕西晟思智能测控有限公司 | 一种agv自主导航控制方法及*** |
CN115042188A (zh) * | 2022-07-19 | 2022-09-13 | 无锡军工智能电气股份有限公司 | 一种井下巡检机器人双修正磁导航控制方法 |
CN115202371A (zh) * | 2022-09-19 | 2022-10-18 | 深圳市凯之成智能装备有限公司 | 平板清扫机器人的运动控制方法及相关装置 |
CN117093001A (zh) * | 2023-08-25 | 2023-11-21 | 杭州士腾科技有限公司 | 自动导向车的纠偏方法及*** |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020165648A1 (en) * | 2001-05-07 | 2002-11-07 | Zeitler David W. | AGV position and heading controller |
US20160057921A1 (en) * | 2014-08-29 | 2016-03-03 | Deere & Company | System and method for steering of an implement on sloped ground |
CN106020200A (zh) * | 2016-07-07 | 2016-10-12 | 江苏上骐集团有限公司 | 采用轮毂电机驱动的agv小车及路径规划方法 |
CN205880660U (zh) * | 2016-07-07 | 2017-01-11 | 江苏上骐集团有限公司 | 一种采用轮毂电机驱动的agv小车 |
CN206107393U (zh) * | 2016-10-10 | 2017-04-19 | 深圳市共进电子股份有限公司 | 一种agv移动设备 |
CN107015565A (zh) * | 2017-06-05 | 2017-08-04 | 福州大学 | 一种agv磁组合导航方法 |
CN109531595A (zh) * | 2018-12-28 | 2019-03-29 | 石家庄铁道大学 | 一种基于双磁导航纠偏的全向移动送餐机器人及导航方法 |
CN209281249U (zh) * | 2019-03-07 | 2019-08-20 | 齐鲁工业大学 | 一种带有障碍物避障装置的agv小车及*** |
CN110764502A (zh) * | 2019-10-16 | 2020-02-07 | 广东嘉腾机器人自动化有限公司 | 一种控制磁导引多舵轮平台移动的方法 |
CN110763224A (zh) * | 2019-11-13 | 2020-02-07 | 内蒙古工业大学 | 一种自动导引运输车导航方法及导航*** |
CN111123931A (zh) * | 2019-12-23 | 2020-05-08 | 广东嘉腾机器人自动化有限公司 | 一种agv双驱动磁导航的拐弯方法及存储装置 |
CN111474933A (zh) * | 2020-04-24 | 2020-07-31 | 合肥工业大学 | 一种磁导引agv的自动纠偏控制方法 |
CN111474938A (zh) * | 2020-04-30 | 2020-07-31 | 内蒙古工业大学 | 一种惯性导航自动导引小车及其航迹确定方法 |
CN111522337A (zh) * | 2020-04-03 | 2020-08-11 | 浙江工业大学 | 一种基于模糊控制的多驱动轮agv导航方法 |
-
2020
- 2020-08-20 CN CN202010842964.6A patent/CN111930126B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020165648A1 (en) * | 2001-05-07 | 2002-11-07 | Zeitler David W. | AGV position and heading controller |
US20160057921A1 (en) * | 2014-08-29 | 2016-03-03 | Deere & Company | System and method for steering of an implement on sloped ground |
CN106020200A (zh) * | 2016-07-07 | 2016-10-12 | 江苏上骐集团有限公司 | 采用轮毂电机驱动的agv小车及路径规划方法 |
CN205880660U (zh) * | 2016-07-07 | 2017-01-11 | 江苏上骐集团有限公司 | 一种采用轮毂电机驱动的agv小车 |
CN206107393U (zh) * | 2016-10-10 | 2017-04-19 | 深圳市共进电子股份有限公司 | 一种agv移动设备 |
CN107015565A (zh) * | 2017-06-05 | 2017-08-04 | 福州大学 | 一种agv磁组合导航方法 |
CN109531595A (zh) * | 2018-12-28 | 2019-03-29 | 石家庄铁道大学 | 一种基于双磁导航纠偏的全向移动送餐机器人及导航方法 |
CN209281249U (zh) * | 2019-03-07 | 2019-08-20 | 齐鲁工业大学 | 一种带有障碍物避障装置的agv小车及*** |
CN110764502A (zh) * | 2019-10-16 | 2020-02-07 | 广东嘉腾机器人自动化有限公司 | 一种控制磁导引多舵轮平台移动的方法 |
CN110763224A (zh) * | 2019-11-13 | 2020-02-07 | 内蒙古工业大学 | 一种自动导引运输车导航方法及导航*** |
CN111123931A (zh) * | 2019-12-23 | 2020-05-08 | 广东嘉腾机器人自动化有限公司 | 一种agv双驱动磁导航的拐弯方法及存储装置 |
CN111522337A (zh) * | 2020-04-03 | 2020-08-11 | 浙江工业大学 | 一种基于模糊控制的多驱动轮agv导航方法 |
CN111474933A (zh) * | 2020-04-24 | 2020-07-31 | 合肥工业大学 | 一种磁导引agv的自动纠偏控制方法 |
CN111474938A (zh) * | 2020-04-30 | 2020-07-31 | 内蒙古工业大学 | 一种惯性导航自动导引小车及其航迹确定方法 |
Non-Patent Citations (2)
Title |
---|
XIAOYAN WANG: "Research on an Omni-directional AGV with Differential Wheel", 《PROCEEDINGS OF 2016 IEEE INTERNATIONAL CONFERENCE ON MECHATRONICS AND AUTOMATION》 * |
林新英: "磁导航AGV结构设计与控制策略", 《吉林化工学院学报》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848940A (zh) * | 2021-10-18 | 2021-12-28 | 陕西晟思智能测控有限公司 | 一种agv自主导航控制方法及*** |
CN115042188A (zh) * | 2022-07-19 | 2022-09-13 | 无锡军工智能电气股份有限公司 | 一种井下巡检机器人双修正磁导航控制方法 |
CN115042188B (zh) * | 2022-07-19 | 2024-04-30 | 无锡军工智能电气股份有限公司 | 一种井下巡检机器人双修正磁导航控制方法 |
CN115202371A (zh) * | 2022-09-19 | 2022-10-18 | 深圳市凯之成智能装备有限公司 | 平板清扫机器人的运动控制方法及相关装置 |
CN117093001A (zh) * | 2023-08-25 | 2023-11-21 | 杭州士腾科技有限公司 | 自动导向车的纠偏方法及*** |
CN117093001B (zh) * | 2023-08-25 | 2024-05-07 | 杭州士腾科技有限公司 | 自动导向车的纠偏方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN111930126B (zh) | 2021-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111930126B (zh) | 一种基于差速轮组agv的导航纠偏方法 | |
CN103121451B (zh) | 一种弯路换道轨迹的跟踪控制方法 | |
CN107943020B (zh) | 一种轮胎吊大车自动纠偏方法 | |
CN109141410B (zh) | Agv组合导航的多传感器融合定位方法 | |
CN110502009A (zh) | 基于航向预估的无人驾驶车辆路径跟踪控制方法 | |
CN110989571A (zh) | 一种用于舵轮驱动型agv的循迹控制方法 | |
CN107065873B (zh) | 一种基于磁带导引agv的多曲率圆周路径循迹控制方法 | |
CN107783540A (zh) | 一种四轮驱动转向的控制方法及装置 | |
CN112462760B (zh) | 一种双舵轮agv路径跟踪方法 | |
CN106886215B (zh) | 一种基于多轴无轨电车循迹跟踪***及具有其的电车 | |
CN211956223U (zh) | 一种车道变更轨迹规划*** | |
CN112097792B (zh) | 一种阿克曼模型移动机器人里程计标定方法 | |
CN109292018A (zh) | 基于同轴式轮腿结构的四轮转向轨迹跟踪控制方法 | |
CN112130558B (zh) | 一种基于差速轮组agv的导航***及控制方法 | |
CN114604249A (zh) | 基于Dubins曲线的车辆转向路径规划方法 | |
CN113887060A (zh) | 一种新型的自动泊车***车辆定位算法 | |
CN110362088B (zh) | 一种适用于无人驾驶跨运车的循迹控制***和方法 | |
Zhang et al. | Learning end-to-end inertial-wheel odometry for vehicle ego-motion estimation | |
CN114475581B (zh) | 基于轮速脉冲和imu卡尔曼滤波融合的自动泊车定位方法 | |
CN111661048B (zh) | 多铰接式车辆及其轨迹跟随控制方法与*** | |
CN115993089A (zh) | 基于pl-icp的在线四舵轮agv内外参标定方法 | |
CN114896694A (zh) | 一种基于两点预瞄的路径跟踪控制方法 | |
CN114291117A (zh) | 一种四轮转向无人车辆轨迹跟踪控制方法 | |
CN111880530A (zh) | 车辆低速行驶时的路径记录方法 | |
CN111469855A (zh) | 一种车辆运动参数的计算方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |